ARM: OMAP3: LDP: Add Ethernet device support to make ldp boot succeess

Add Ethernet device support in board-ldp.c to make ldp can boot and mount
nfs successfully.

Signed-off-by: Stanley.Miao <stanley.miao@windriver.com>

1 files changed, 57 insertions, 0 deletions

diff --git a/arch/arm/mach-omap2/board-ldp.c b/arch/arm/mach-omap2/board-ldp.c
index 1ea59986aa7a..43c7ac4b7f8f 100644
--- a/arch/arm/mach-omap2/board-ldp.c
+++ b/arch/arm/mach-omap2/board-ldp.c
@@ -38,11 +38,67 @@
 #include <asm/delay.h>
 #include <mach/control.h>
 
+#define SDP3430_SMC91X_CS       3
+
+static struct resource ldp_smc911x_resources[] = {
+        [0] = {
+                .start  = OMAP34XX_ETHR_START,
+                .end    = OMAP34XX_ETHR_START + SZ_4K,
+                .flags  = IORESOURCE_MEM,
+        },
+        [1] = {
+                .start  = 0,
+                .end    = 0,
+                .flags  = IORESOURCE_IRQ | IORESOURCE_IRQ_LOWLEVEL,
+        },
+};
+
+static struct platform_device ldp_smc911x_device = {
+        .name           = "smc911x",
+        .id             = -1,
+        .num_resources  = ARRAY_SIZE(ldp_smc911x_resources),
+        .resource       = ldp_smc911x_resources,
+};
+
+static struct platform_device *ldp_devices[] __initdata = {
+        &ldp_smc911x_device,
+};
+
+static inline void __init ldp_init_smc911x(void)
+{
+        int eth_cs;
+        unsigned long cs_mem_base;
+        int eth_gpio = 0;
+
+        eth_cs = LDP_SMC911X_CS;
+
+        if (gpmc_cs_request(eth_cs, SZ_16M, &cs_mem_base) < 0) {
+                printk(KERN_ERR "Failed to request GPMC mem for smc911x\n");
+                return;
+        }
+
+        ldp_smc911x_resources[0].start = cs_mem_base + 0x0;
+        ldp_smc911x_resources[0].end   = cs_mem_base + 0xf;
+        udelay(100);
+
+        eth_gpio = LDP_SMC911X_GPIO;
+
+        ldp_smc911x_resources[1].start = OMAP_GPIO_IRQ(eth_gpio);
+
+        if (omap_request_gpio(eth_gpio) < 0) {
+                printk(KERN_ERR "Failed to request GPIO%d for smc911x IRQ\n",
+                                eth_gpio);
+                return;
+        }
+        gpio_direction_input(eth_gpio);
+}
+
 static void __init omap_ldp_init_irq(void)
 {
         omap2_init_common_hw();
         omap_init_irq();
         omap_gpio_init();
+        ldp_init_smc911x();
 }
 
 static struct omap_uart_config ldp_uart_config __initdata = {
@@ -64,6 +120,7 @@ static int __init omap_i2c_init(void)
 static void __init omap_ldp_init(void)
 {
         omap_i2c_init();
+        platform_add_devices(ldp_devices, ARRAY_SIZE(ldp_devices));
         omap_board_config = ldp_config;
         omap_board_config_size = ARRAY_SIZE(ldp_config);
         omap_serial_init();