ramips: implement clock API for RT305X

[openwrt/svn-archive/archive.git] / target / linux / ramips / files / arch / mips / ralink / rt305x / devices.c

diff --git a/target/linux/ramips/files/arch/mips/ralink/rt305x/devices.c b/target/linux/ramips/files/arch/mips/ralink/rt305x/devices.c
index 4ad93b580d7c910524a2e1e372ef56f985d08acf..3936ee7a45aaa86285e68d0545fb9a57b6139a66 100644 (file)
--- a/target/linux/ramips/files/arch/mips/ralink/rt305x/devices.c
+++ b/target/linux/ramips/files/arch/mips/ralink/rt305x/devices.c
@@ -1,7 +1,7 @@
 /*
  *  Ralink RT305x SoC platform device registration
  *
- *  Copyright (C) 2009 Gabor Juhos <juhosg@openwrt.org>
+ *  Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>
  *
  *  This program is free software; you can redistribute it and/or modify it
  *  under the terms of the GNU General Public License version 2 as published
@@ -10,6 +10,8 @@
 
 #include <linux/kernel.h>
 #include <linux/platform_device.h>
+#include <linux/err.h>
+#include <linux/clk.h>
 #include <linux/mtd/mtd.h>
 #include <linux/mtd/physmap.h>
 
@@ -118,7 +120,7 @@ static struct resource rt305x_eth_resources[] = {
 static struct ramips_eth_platform_data ramips_eth_data = {
        .mac = { 0x00, 0x11, 0x22, 0x33, 0x44, 0x55 },
        .reset_fe = rt305x_fe_reset,
-       .min_pkt_len = 64
+       .min_pkt_len = 64,
 };
 
 static struct platform_device rt305x_eth_device = {
@@ -130,7 +132,60 @@ static struct platform_device rt305x_eth_device = {
        }
 };
 
+static struct resource rt305x_esw_resources[] = {
+       {
+               .start  = RT305X_SWITCH_BASE,
+               .end    = RT305X_SWITCH_BASE + PAGE_SIZE - 1,
+               .flags  = IORESOURCE_MEM,
+       },
+};
+
+struct rt305x_esw_platform_data rt305x_esw_data;
+static struct platform_device rt305x_esw_device = {
+       .name           = "rt305x-esw",
+       .resource       = rt305x_esw_resources,
+       .num_resources  = ARRAY_SIZE(rt305x_esw_resources),
+       .dev = {
+               .platform_data = &rt305x_esw_data,
+       }
+};
+
 void __init rt305x_register_ethernet(void)
 {
+       struct clk *clk;
+
+       clk = clk_get(NULL, "sys");
+       if (IS_ERR(clk))
+               panic("unable to get SYS clock, err=%ld", PTR_ERR(clk));
+
+       ramips_eth_data.sys_freq = clk_get_rate(clk);
+
+       platform_device_register(&rt305x_esw_device);
        platform_device_register(&rt305x_eth_device);
 }
+
+static struct resource rt305x_wifi_resources[] = {
+       {
+               .start  = RT305X_WMAC_BASE,
+               .end    = RT305X_WMAC_BASE + 0x3FFFF,
+               .flags  = IORESOURCE_MEM,
+       }, {
+               .start  = RT305X_CPU_IRQ_WNIC,
+               .end    = RT305X_CPU_IRQ_WNIC,
+               .flags  = IORESOURCE_IRQ,
+       },
+};
+
+static struct platform_device rt305x_wifi_device = {
+       .name                   = "rt2800_wmac",
+       .resource               = rt305x_wifi_resources,
+       .num_resources  = ARRAY_SIZE(rt305x_wifi_resources),
+       .dev = {
+               .platform_data = NULL,
+       }
+};
+
+void __init rt305x_register_wifi(void)
+{
+       platform_device_register(&rt305x_wifi_device);
+}