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 6a810a3a0a58db8fb43e660cc4366ea4bca356c7..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>
 
@@ -130,9 +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)
 {
-       ramips_eth_data.sys_freq = rt305x_sys_freq;
+       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);
+}