make ethernet a platform device

SVN-Revision: 18135

4 files changed, 92 insertions, 29 deletions

diff --git a/target/linux/ramips/files/arch/mips/include/asm/mach-ralink/eth.h b/target/linux/ramips/files/arch/mips/include/asm/mach-ralink/eth.h
index d468967..27cf6df 100644
--- a/target/linux/ramips/files/arch/mips/include/asm/mach-ralink/eth.h
+++ b/target/linux/ramips/files/arch/mips/include/asm/mach-ralink/eth.h
@@ -21,6 +21,8 @@
 #define RAMIPS_ETH_H
 
 #include <linux/mii.h>
+#include <linux/interrupt.h>
+#include <linux/netdevice.h>
 
 #define NUM_RX_DESC     256
 #define NUM_TX_DESC     256
@@ -35,7 +37,6 @@
 #define RAMIPS_FE_RESET					0x34
 #define RAMIPS_FE_RESET_BIT				BIT(21)
 
-
 /* interrupt bitd */
 #define RAMIPS_CNT_PPE_AF				BIT(31)
 #define RAMIPS_CNT_GDM_AF				BIT(29)
@@ -161,7 +162,6 @@
 #define RAMIPS_US_CYC_CNT_SHIFT			0x8
 #define RAMIPS_US_CYC_CNT_DIVISOR		1000000
 
-
 #define RX_DMA_PLEN0(x)					((x >> 16) & 0x3fff)
 #define RX_DMA_LSO						BIT(30)
 #define RX_DMA_DONE						BIT(31)
@@ -187,6 +187,15 @@ struct ramips_tx_dma {
 	unsigned int txd4;
 };
 
+struct ramips_eth_platform_data
+{
+	unsigned char mac[6];
+	unsigned int base_addr;
+	void (*reset_fe)(void);
+	int min_pkt_len;
+	int irq;
+};
+
 struct raeth_priv
 {
 	unsigned int			phy_rx;
@@ -199,6 +208,8 @@ struct raeth_priv
 
     unsigned int			skb_free_idx;
     struct net_device_stats	stat;
+
+	struct ramips_eth_platform_data *plat;
 };
 
 #endif
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 5dd1022..6155b9f 100644
--- a/target/linux/ramips/files/arch/mips/ralink/rt305x/devices.c
+++ b/target/linux/ramips/files/arch/mips/ralink/rt305x/devices.c
@@ -19,6 +19,8 @@
 #include <asm/mach-ralink/rt305x_regs.h>
 #include "devices.h"
 
+#include <eth.h>
+
 static struct resource rt305x_flash0_resources[] = {
 	{
 		.flags	= IORESOURCE_MEM,
@@ -94,3 +96,29 @@ void __init rt305x_register_flash(unsigned int id,
 	platform_device_register(pdev);
 	rt305x_flash_instance++;
 }
+
+static void rt305x_fe_reset(void)
+{
+	rt305x_sysc_wr(RAMIPS_FE_RESET_BIT, RAMIPS_FE_RESET);
+	rt305x_sysc_wr(0, RAMIPS_FE_RESET);
+}
+
+static struct ramips_eth_platform_data ramips_eth_data = {
+	.mac = { 0x00, 0x11, 0x22, 0x33, 0x44, 0x55 },
+	.base_addr = RT305X_FE_BASE,
+	.irq = RT305X_CPU_IRQ_FE,
+	.reset_fe = rt305x_fe_reset,
+	.min_pkt_len = 64
+};
+
+static struct platform_device rt305x_eth_device = {
+	.name = "ramips_eth",
+	.dev = {
+		.platform_data = (void *) &ramips_eth_data,
+	}
+};
+
+void __init rt305x_register_ethernet(void)
+{
+	platform_device_register(&rt305x_eth_device);
+}
diff --git a/target/linux/ramips/files/arch/mips/ralink/rt305x/devices.h b/target/linux/ramips/files/arch/mips/ralink/rt305x/devices.h
index 0a90b3a..3d6210e 100644
--- a/target/linux/ramips/files/arch/mips/ralink/rt305x/devices.h
+++ b/target/linux/ramips/files/arch/mips/ralink/rt305x/devices.h
@@ -15,6 +15,7 @@ struct physmap_flash_data;
 
 extern void rt305x_register_flash(unsigned int id,
 				  struct physmap_flash_data *pdata) __init;
+extern void rt305x_register_ethernet(void);
 
 #endif  /* __RT305X_DEVICES_H */
 
diff --git a/target/linux/ramips/files/drivers/net/ramips.c b/target/linux/ramips/files/drivers/net/ramips.c
index 46def40..42d38cc 100644
--- a/target/linux/ramips/files/drivers/net/ramips.c
+++ b/target/linux/ramips/files/drivers/net/ramips.c
@@ -25,12 +25,11 @@
 #include <linux/skbuff.h>
 #include <linux/if_vlan.h>
 #include <linux/if_ether.h>
+#include <linux/platform_device.h>
 #include <asm/uaccess.h>
 #include <net/sock.h>
 #include <asm/uaccess.h>
 
-#include <rt305x.h>
-#include <rt305x_regs.h>
 #include <eth.h>
 
 #define TX_TIMEOUT (20 * HZ / 100)
@@ -112,19 +111,19 @@ ramips_eth_hard_start_xmit(struct sk_buff* skb, struct net_device *dev)
 	unsigned long tx;
 	unsigned int tx_next;
 
-#ifdef CONFIG_RALINK_RT305X
-#define MIN_PKT_LEN  64
-	 if(skb->len < MIN_PKT_LEN)
-	 {
-	     if(skb_padto(skb, MIN_PKT_LEN))
+	if(priv->plat->min_pkt_len)
+	{
+		if(skb->len < priv->plat->min_pkt_len)
 		 {
-			 printk(KERN_ERR "ramips_eth: skb_padto failed\n");
-			 kfree_skb(skb);
-			 return 0;
-	     }
-	     skb_put(skb, MIN_PKT_LEN - skb->len);
-	 }
-#endif
+		     if(skb_padto(skb, priv->plat->min_pkt_len))
+			 {
+				 printk(KERN_ERR "ramips_eth: skb_padto failed\n");
+				 kfree_skb(skb);
+				 return 0;
+			 }
+		     skb_put(skb, priv->plat->min_pkt_len - skb->len);
+		 }
+	}
 	dev->trans_start = jiffies;
 	dma_cache_wback_inv((unsigned long)skb->data, skb->len);
 	tx = ramips_fe_rr(RAMIPS_TX_CTX_IDX0);
@@ -321,16 +320,13 @@ ramips_eth_stop(struct net_device *dev)
 int __init
 ramips_eth_probe(struct net_device *dev)
 {
+	struct raeth_priv *priv = (struct raeth_priv*)netdev_priv(dev);
 	struct sockaddr addr;
-	unsigned char mac_addr01234[5] = {0x00, 0x0C, 0x43, 0x28, 0x80};
-
-	/* reset frame engine */
-	rt305x_sysc_wr(RAMIPS_FE_RESET_BIT, RAMIPS_FE_RESET);
-	rt305x_sysc_wr(0, RAMIPS_FE_RESET);
 
+	BUG(!priv->plat->reset_fe);
+	priv->plat->reset_fe();
 	net_srandom(jiffies);
-	memcpy(addr.sa_data, mac_addr01234, 5);
-	addr.sa_data[5] = net_random()&0xFF;
+	memcpy(addr.sa_data, priv->plat->mac, 6);
 	ramips_eth_set_mac_addr(dev, &addr);
 
 	ether_setup(dev);
@@ -345,20 +341,24 @@ ramips_eth_probe(struct net_device *dev)
 	return 0;
 }
 
-int __init
-ramips_eth_init(void)
+static int
+ramips_eth_plat_probe(struct platform_device *plat)
 {
-	ramips_fe_base = ioremap_nocache(RT305X_FE_BASE, PAGE_SIZE);
+	struct raeth_priv *priv;
+
+	ramips_fe_base = ioremap_nocache(plat->base_addr, PAGE_SIZE);
 	if(!ramips_fe_base)
 		return -ENOMEM;
 	ramips_dev = alloc_etherdev(sizeof(struct raeth_priv));
 	if(!ramips_dev)
 		return -ENOMEM;
 	strcpy(ramips_dev->name, "eth%d");
-	ramips_dev->irq = RT305X_CPU_IRQ_FE;
+	ramips_dev->irq = plat->irq;
 	ramips_dev->addr_len = ETH_ALEN;
 	ramips_dev->base_addr = (unsigned long)ramips_fe_base;
 	ramips_dev->init = ramips_eth_probe;
+	priv = (struct raeth_priv*)netdev_priv(ramips_dev);
+	priv->plat = (struct ramips_eth_platform_data*)plat->dev.platform_data;
 	if(register_netdev(ramips_dev))
 	{
 		printk(KERN_ERR "ramips_eth: error bringing up device\n");
@@ -371,12 +371,35 @@ ramips_eth_init(void)
 	return 0;
 }
 
-void
-ramips_eth_cleanup(void)
+static int
+ramips_eth_plat_remove(struct platform_device *plat)
 {
 	unregister_netdev(ramips_dev);
 	free_netdev(ramips_dev);
 	printk(KERN_INFO "ramips_eth: unloaded");
+	return 0;
+}
+
+static struct platform_driver ramips_eth_driver = {
+	.probe = ramips_eth_plat_probe,
+	.remove = ramips_eth_plat_remove,
+	.driver = {
+		.name = "ramips_eth",
+		.owner = THIS_MODULE,
+	},
+};
+
+int __init ramips_eth_init(void)
+{
+	int ret = platform_driver_register(&ramips_eth_driver);
+	if (ret)
+		printk(KERN_INFO "ramips_eth: Error registering platfom driver!");
+	return ret;
+}
+
+static void __exit ramips_eth_cleanup(void)
+{
+	platform_driver_unregister(&ramips_eth_driver);
 }
 
 module_init(ramips_eth_init);