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 d468967884..27cf6dffff 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 +#include +#include #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 5dd1022b97..6155b9fb60 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 #include "devices.h" +#include + 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 0a90b3a4e1..3d6210e0ed 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 46def4051a..42d38ccda2 100644 --- a/target/linux/ramips/files/drivers/net/ramips.c +++ b/target/linux/ramips/files/drivers/net/ramips.c @@ -25,12 +25,11 @@ #include #include #include +#include #include #include #include -#include -#include #include #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);