#define VERSION_STRING "Cirrus Logic CS8900A driver for Linux (Modified for ZL2440)" #include <linux/kernel.h> #include <linux/module.h> #include <linux/types.h> #include <linux/version.h> #include <linux/errno.h> #include <linux/init.h> #include <linux/delay.h> #include <linux/ioport.h> #include <linux/pm.h> #include <linux/irq.h> //#include <asm/hardware.h> #include <asm/io.h> #include <asm/uaccess.h> #include <linux/netdevice.h> #include <linux/etherdevice.h> #include <linux/skbuff.h> // Added BSt #include <asm/mach-types.h> //#ifdef CONFIG_ARCH_SMDK2410 #if 1 //#include "asm/arch-s3c2410/regs-irq.h" #include "mach/regs-mem.h" //#include "asm/arch/smdk2410.h" #include "net/smdk2410.h" #endif #include "cs8900.h" //#define FULL_DUPLEX //#define DEBUG typedef struct { struct net_device_stats stats; u16 txlen; int char_devnum; spinlock_t lock; } cs8900_t; int cs8900_probe (struct net_device *dev); static struct net_device *cs8900_dev ; #define MAX_EEPROM_SIZE 256 static inline u16 cs8900_read (struct net_device *dev,u16 reg) { outw (reg,dev->base_addr + PP_Address); return (inw (dev->base_addr + PP_Data)); } static inline void cs8900_write (struct net_device *dev,u16 reg,u16 value) { outw (reg,dev->base_addr + PP_Address); outw (value,dev->base_addr + PP_Data); } static inline void cs8900_set (struct net_device *dev,u16 reg,u16 value) { cs8900_write (dev,reg,cs8900_read (dev,reg) | value); } static inline void cs8900_clear (struct net_device *dev,u16 reg,u16 value) { cs8900_write (dev,reg,cs8900_read (dev,reg) & ~value); } static inline void cs8900_frame_read (struct net_device *dev,struct sk_buff *skb,u16 length) { insw (dev->base_addr,skb_put (skb,length),(length + 1) / 2); } static inline void cs8900_frame_write (struct net_device *dev,struct sk_buff *skb) { outsw (dev->base_addr,skb->data,(skb->len + 1) / 2); } #ifdef DEBUG static inline int printable (int c) { return ((c >= 32 && c <= 126) || (c >= 174 && c <= 223) || (c >= 242 && c <= 243) || (c >= 252 && c <= 253)); } static void dump16 (struct net_device *dev,const u8 *s,size_t len) { int i; char str[128]; if (!len) return; *str = '\0'; for (i = 0; i < len; i++) { if (i && !(i % 4)) strcat (str," "); sprintf (str,"%s%.2x ",str,s[i]); } for ( ; i < 16; i++) { if (i && !(i % 4)) strcat (str," "); strcat (str," "); } strcat (str," "); for (i = 0; i < len; i++) sprintf (str,"%s%c",str,printable (s[i]) ? s[i] : '.'); printk (KERN_DEBUG "%s: %s\n",dev->name,str); } static void hexdump (struct net_device *dev,const void *ptr,size_t size) { const u8 *s = (u8 *) ptr; int i; for (i = 0; i < size / 16; i++, s += 16) dump16 (dev,s,16); dump16 (dev,s,size % 16); } static void dump_packet (struct net_device *dev,struct sk_buff *skb,const char *type) { printk (KERN_INFO "%s: %s %d byte frame %.2x:%.2x:%.2x:%.2x:%.2x:%.2x to %.2x:%.2x:%.2x:%.2x:%.2x:%.2x type %.4x\n", dev->name, type, skb->len, skb->data[0],skb->data[1],skb->data[2],skb->data[3],skb->data[4],skb->data[5], skb->data[6],skb->data[7],skb->data[8],skb->data[9],skb->data[10],skb->data[11], (skb->data[12] << 8) | skb->data[13]); if (skb->len < 0x100) hexdump (dev,skb->data,skb->len); } #endif static void cs8900_receive (struct net_device *dev) { //cs8900_t *priv = (cs8900_t *) dev->priv; cs8900_t *priv = (cs8900_t *)netdev_priv(dev); struct sk_buff *skb; u16 status,length; status = cs8900_read (dev,PP_RxStatus); length = cs8900_read (dev,PP_RxLength); if (!(status & RxOK)) { priv->stats.rx_errors++; if ((status & (Runt | Extradata))) priv->stats.rx_length_errors++; if ((status & CRCerror)) priv->stats.rx_crc_errors++; return; } if ((skb = dev_alloc_skb (length + 4)) == NULL) { priv->stats.rx_dropped++; return; } skb->dev = dev; skb_reserve (skb,2); cs8900_frame_read (dev,skb,length); #ifdef FULL_DUPLEX dump_packet (dev,skb,"recv"); #endif skb->protocol = eth_type_trans (skb,dev); netif_rx (skb); dev->last_rx = jiffies; priv->stats.rx_packets++; priv->stats.rx_bytes += length; } static int cs8900_send_start (struct sk_buff *skb,struct net_device *dev) { //cs8900_t *priv = (cs8900_t *) dev->priv; cs8900_t *priv = (cs8900_t *)netdev_priv(dev); u16 status; spin_lock_irq(&priv->lock); netif_stop_queue (dev); cs8900_write (dev,PP_TxCMD,TxStart (After5)); cs8900_write (dev,PP_TxLength,skb->len); status = cs8900_read (dev,PP_BusST); if ((status & TxBidErr)) { spin_unlock_irq(&priv->lock); printk (KERN_WARNING "%s: Invalid frame size %d!\n",dev->name,skb->len); priv->stats.tx_errors++; priv->stats.tx_aborted_errors++; priv->txlen = 0; return (1); } if (!(status & Rdy4TxNOW)) { spin_unlock_irq(&priv->lock); printk (KERN_WARNING "%s: Transmit buffer not free!\n",dev->name); priv->stats.tx_errors++; priv->txlen = 0; return (1); } cs8900_frame_write (dev,skb); spin_unlock_irq(&priv->lock); #ifdef DEBUG dump_packet (dev,skb,"send"); #endif dev->trans_start = jiffies; dev_kfree_skb (skb); priv->txlen = skb->len; return (0); } static irqreturn_t cs8900_interrupt (int irq,void *id) { struct net_device *dev = (struct net_device *) id; cs8900_t *priv; volatile u16 status; irqreturn_t handled = 0; #if 0 if (dev->priv == NULL) { printk (KERN_WARNING "%s: irq %d for unknown device.\n",dev->name,irq); return 0; } #endif //priv = (cs8900_t *) dev->priv; priv = (cs8900_t *)netdev_priv(dev); while ((status = cs8900_read (dev, PP_ISQ))) { handled = 1; switch (RegNum (status)) { case RxEvent: cs8900_receive (dev); break; case TxEvent: priv->stats.collisions += ColCount (cs8900_read (dev,PP_TxCOL)); if (!(RegContent (status) & TxOK)) { priv->stats.tx_errors++; if ((RegContent (status) & Out_of_window)) priv->stats.tx_window_errors++; if ((RegContent (status) & Jabber)) priv->stats.tx_aborted_errors++; break; } else if (priv->txlen) { priv->stats.tx_packets++; priv->stats.tx_bytes += priv->txlen; } priv->txlen = 0; netif_wake_queue (dev); break; case BufEvent: if ((RegContent (status) & RxMiss)) { u16 missed = MissCount (cs8900_read (dev,PP_RxMISS)); priv->stats.rx_errors += missed; priv->stats.rx_missed_errors += missed; } if ((RegContent (status) & TxUnderrun)) { priv->stats.tx_errors++; priv->stats.tx_fifo_errors++; priv->txlen = 0; netif_wake_queue (dev); } break; case TxCOL: priv->stats.collisions += ColCount (cs8900_read (dev,PP_TxCOL)); break; case RxMISS: status = MissCount (cs8900_read (dev,PP_RxMISS)); priv->stats.rx_errors += status; priv->stats.rx_missed_errors += status; break; } } return IRQ_RETVAL(handled); } static void cs8900_transmit_timeout (struct net_device *dev) { //cs8900_t *priv = (cs8900_t *) dev->priv; cs8900_t *priv = (cs8900_t *)netdev_priv(dev); priv->stats.tx_errors++; priv->stats.tx_heartbeat_errors++; priv->txlen = 0; netif_wake_queue (dev); } static int cs8900_start (struct net_device *dev) { int result; //set_irq_type(dev->irq, IRQT_RISING); set_irq_type(dev->irq, IRQ_TYPE_EDGE_RISING); cs8900_set (dev,PP_RxCFG,RxOKiE | BufferCRC | CRCerroriE | RuntiE | ExtradataiE); cs8900_set (dev,PP_RxCTL,RxOKA | IndividualA | BroadcastA); cs8900_set (dev,PP_TxCFG,TxOKiE | Out_of_windowiE | JabberiE); cs8900_set (dev,PP_BufCFG,Rdy4TxiE | RxMissiE | TxUnderruniE | TxColOvfiE | MissOvfloiE); cs8900_set (dev,PP_LineCTL,SerRxON | SerTxON); cs8900_set (dev,PP_BusCTL,EnableRQ); #ifdef FULL_DUPLEX cs8900_set (dev,PP_TestCTL,FDX); #endif udelay(200); if ((result = request_irq (dev->irq, &cs8900_interrupt, 0, dev->name, dev)) <0) { printk (KERN_ERR "%s: could not register interrupt %d\n",dev->name, dev->irq); return (result); } netif_start_queue (dev); return (0); } static int cs8900_stop (struct net_device *dev) { cs8900_write (dev,PP_BusCTL,0); cs8900_write (dev,PP_TestCTL,0); cs8900_write (dev,PP_SelfCTL,0); cs8900_write (dev,PP_LineCTL,0); cs8900_write (dev,PP_BufCFG,0); cs8900_write (dev,PP_TxCFG,0); cs8900_write (dev,PP_RxCTL,0); cs8900_write (dev,PP_RxCFG,0); free_irq (dev->irq,dev); netif_stop_queue (dev); return (0); } static struct net_device_stats *cs8900_get_stats (struct net_device *dev) { //cs8900_t *priv = (cs8900_t *) dev->priv; cs8900_t *priv = (cs8900_t *)netdev_priv(dev); return (&priv->stats); } static void cs8900_set_receive_mode (struct net_device *dev) { if ((dev->flags & IFF_PROMISC)) cs8900_set (dev,PP_RxCTL,PromiscuousA); else cs8900_clear (dev,PP_RxCTL,PromiscuousA); //if ((dev->flags & IFF_ALLMULTI) && dev->mc_list) if ((dev->flags & IFF_ALLMULTI) && !netdev_mc_empty(dev)) cs8900_set (dev,PP_RxCTL,MulticastA); else cs8900_clear (dev,PP_RxCTL,MulticastA); } int __init cs8900_probe (struct net_device *dev) { static cs8900_t *priv; int i,result; u16 value; printk (VERSION_STRING"\n"); memset (&priv,0,sizeof (cs8900_t)); //+kevin __raw_writel(0x2211d110,S3C2410_BWSCON); __raw_writel(0x1f7c,S3C2410_BANKCON3); //#if defined(CONFIG_ARCH_SMDK2410) #if 1 dev->dev_addr[0] = 0x00; dev->dev_addr[1] = 0x00; dev->dev_addr[2] = 0x3e; dev->dev_addr[3] = 0x26; dev->dev_addr[4] = 0x0a; dev->dev_addr[5] = 0x00; #endif dev->if_port = IF_PORT_10BASET; //dev->priv = (void *) &priv; priv = (cs8900_t *)netdev_priv(dev); spin_lock_init(&priv->lock); //hejiasheng SET_MODULE_OWNER (dev); //#if defined(CONFIG_ARCH_SMDK2410) #if 1 dev->base_addr = vSMDK2410_ETH_IO + 0x300; dev->irq = IRQ_EINT9; printk("debug:[%s-%d]\n", __func__, __LINE__); #endif if ((result = check_mem_region (dev->base_addr, 16))) { printk (KERN_ERR "%s: can't get I/O port address 0x%lx\n",dev->name,dev->base_addr); return (result); } request_mem_region (dev->base_addr, 16, dev->name); printk("debug:[%s-%d]\n", __func__, __LINE__); if ((value = cs8900_read (dev,PP_ProductID)) != EISA_REG_CODE) { printk (KERN_ERR "%s: incorrect signature 0x%.4x\n",dev->name,value); return (-ENXIO); } printk("debug:[%s-%d]\n", __func__, __LINE__); value = cs8900_read (dev,PP_ProductID + 2); if (VERSION (value) != CS8900A) { printk (KERN_ERR "%s: unknown chip version 0x%.8x\n",dev->name,VERSION (value)); return (-ENXIO); } cs8900_write (dev,PP_IntNum,0); printk (KERN_INFO "%s: CS8900A rev %c at %#lx irq=%d", dev->name,'B' + REVISION (value) - REV_B, dev->base_addr, dev->irq); for (i = 0; i < ETH_ALEN; i += 2) cs8900_write (dev,PP_IA + i,dev->dev_addr[i] | (dev->dev_addr[i + 1] << 8)); printk (", addr:"); for (i = 0; i < ETH_ALEN; i += 2) { u16 mac = cs8900_read (dev,PP_IA + i); printk ("%cX:%2X", (i==0)?' ':':', mac & 0xff, (mac >> 8)); } printk ("\n"); return (0); } static const struct net_device_ops net_ops = { .ndo_init = cs8900_probe, .ndo_open = cs8900_start, .ndo_stop = cs8900_stop, .ndo_tx_timeout = cs8900_transmit_timeout, .ndo_start_xmit = cs8900_send_start, .ndo_get_stats = cs8900_get_stats, .ndo_set_multicast_list = cs8900_set_receive_mode, #if 0 .ndo_set_mac_address = set_mac_address, .ndo_poll_controller = net_poll_controller, .ndo_change_mtu = eth_change_mtu, .ndo_validate_addr = eth_validate_addr, #endif }; static int __init cs8900_init (void) { struct net_device *ndev; ndev = alloc_etherdev(sizeof (cs8900_t)); if (!ndev) { printk("%s: could not allocate device.\n", "cs8900"); return -ENOMEM; } printk("allocate cs8900 device ok.\n"); cs8900_dev = ndev; //cs8900_dev->init = cs8900_probe; ether_setup (ndev); #if 0 ndev->open = cs8900_start; ndev->stop = cs8900_stop; ndev->hard_start_xmit = cs8900_send_start; ndev->get_stats = cs8900_get_stats; ndev->set_multicast_list = cs8900_set_receive_mode; ndev->tx_timeout = cs8900_transmit_timeout; #endif ndev->netdev_ops = &net_ops; ndev->watchdog_timeo = HZ; return (register_netdev (cs8900_dev)); } static void __exit cs8900_cleanup (void) { // cs8900_t *priv = (cs8900_t *) cs8900_dev->priv; cs8900_t *priv = (cs8900_t *)netdev_priv(cs8900_dev); if( priv->char_devnum) { unregister_chrdev(priv->char_devnum,"cs8900_eeprom"); } release_mem_region (cs8900_dev->base_addr,16); unregister_netdev (cs8900_dev); } MODULE_AUTHOR ("Abraham van der Merwe <abraham at 2d3d.co.za>"); MODULE_DESCRIPTION (VERSION_STRING); MODULE_LICENSE ("GPL"); module_init (cs8900_init); module_exit (cs8900_cleanup);
|