ramips: initial board support for MOFI3500-3GN

[openwrt.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 4ee0d4f..7d41b07 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,10 +132,35 @@ 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);
 }
 
@@ -162,3 +189,31 @@ void __init rt305x_register_wifi(void)
 {
        platform_device_register(&rt305x_wifi_device);
 }
+
+static struct resource rt305x_wdt_resources[] = {
+       {
+               .start  = RT305X_TIMER_BASE,
+               .end    = RT305X_TIMER_BASE + RT305X_TIMER_SIZE - 1,
+               .flags  = IORESOURCE_MEM,
+       },
+};
+
+static struct platform_device rt305x_wdt_device = {
+       .name           = "ramips-wdt",
+       .id             = -1,
+       .resource       = rt305x_wdt_resources,
+       .num_resources  = ARRAY_SIZE(rt305x_wdt_resources),
+};
+
+void __init rt305x_register_wdt(void)
+{
+       u32 t;
+
+       /* enable WDT reset output on pin SRAM_CS_N */
+       t = rt305x_sysc_rr(SYSC_REG_SYSTEM_CONFIG);
+       t |= SYSTEM_CONFIG_SRAM_CS0_MODE_WDT <<
+            SYSTEM_CONFIG_SRAM_CS0_MODE_SHIFT;
+       rt305x_sysc_wr(t, SYSC_REG_SYSTEM_CONFIG);
+
+       platform_device_register(&rt305x_wdt_device);
+}