• 嵌入式Linux驱动学习之路(二十六)DM9000C网卡驱动程序


    基于DM9000C的原厂代码修改dm9000c的驱动程序。

    首先确认内存的基地址 iobase.

    确定中断号码。

    打开模块的初始化函数定义。

    配置内存控制器的相应时序(结合DM9000C.C的手册).

    程序代码:

    /*
    
      dm9ks.c: Version 2.08 2007/02/12 
      
            A Davicom DM9000/DM9010 ISA NIC fast Ethernet driver for Linux.
    
        This program is free software; you can redistribute it and/or
        modify it under the terms of the GNU General Public License
        as published by the Free Software Foundation; either version 2
        of the License, or (at your option) any later version.
    
        This program is distributed in the hope that it will be useful,
        but WITHOUT ANY WARRANTY; without even the implied warranty of
        MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
        GNU General Public License for more details.
    
    
      (C)Copyright 1997-2007 DAVICOM Semiconductor,Inc. All Rights Reserved.
    
    V2.00 Spenser - 01/10/2005
                - Modification for PXA270 MAINSTONE.
                - Modified dmfe_tx_done().
                - Add dmfe_timeout().
    V2.01    10/07/2005    -Modified dmfe_timer()
                -Dected network speed 10/100M
    V2.02    10/12/2005    -Use link change to chage db->Speed
                -dmfe_open() wait for Link OK  
    V2.03    11/22/2005    -Power-off and Power-on PHY in dmfe_init_dm9000()
                -support IOL
    V2.04    12/13/2005    -delay 1.6s between power-on and power-off in 
                 dmfe_init_dm9000()
                -set LED mode 1 in dmfe_init_dm9000()
                -add data bus driving capability in dmfe_init_dm9000()
                 (optional)
    10/3/2006    -Add DM8606 read/write function by MDC and MDIO
    V2.06    01/03/2007    -CONT_RX_PKT_CNT=0xFFFF
                -modify dmfe_tx_done function
                -check RX FIFO pointer
                -if using physical address, re-define I/O function
                -add db->cont_rx_pkt_cnt=0 at the front of dmfe_packet_receive()
    V2.08    02/12/2007    -module parameter macro
                2.4  MODULE_PARM
                2.6  module_param
                -remove #include <linux/config>
                  -fix dmfe_interrupt for kernel 2.6.20                  
    V2.09 05/24/2007    -support ethtool and mii-tool
    05/30/2007    -fix the driver bug when ifconfig eth0 (-)promisc and (-)allmulti.
    06/05/2007    -fix dm9000b issue(ex. 10M TX idle=65mA, 10M harmonic)
                -add flow control function (option)
    10/01/2007  -Add #include <asm/uaccess.h>
                -Modyfy dmfe_do_ioctl for kernel 2.6.7
    11/23/2007    -Add TDBUG to check TX FIFO pointer shift
                - Remove check_rx_ready() 
              - Add #define CHECKSUM to modify CHECKSUM function    
    12/20/2007  -Modify TX timeout routine(+)check TCR&0x01 
    
    */
    
    //#define CHECKSUM
    //#define TDBUG        /* check TX FIFO pointer */
    //#define RDBUG   /* check RX FIFO pointer */
    //#define DM8606
    
    #define DRV_NAME    "dm9KS"
    #define DRV_VERSION    "2.09"
    #define DRV_RELDATE    "2007-11-22"
    
    #ifdef MODVERSIONS
    #include <linux/modversions.h>
    #endif
    
    //#include <linux/config.h>
    #include <linux/init.h>                
    #include <linux/delay.h>
    #include <linux/module.h>
    #include <linux/ioport.h>
    #include <linux/netdevice.h>
    #include <linux/etherdevice.h>
    #include <linux/skbuff.h>
    #include <linux/version.h>
    #include <asm/dma.h>
    #include <linux/spinlock.h>
    #include <linux/crc32.h>
    #include <linux/mii.h>
    #include <linux/ethtool.h>
    #include <asm/uaccess.h>
    
    //#ifdef CONFIG_ARCH_MAINSTONE
    #include <asm/io.h>
    #include <asm/hardware.h>
    #include <asm/irq.h>
    //#endif
    
    
    
    /* Board/System/Debug information/definition ---------------- */
    
    #define DM9KS_ID        0x90000A46
    #define DM9010_ID        0x90100A46
    /*-------register name-----------------------*/
    #define DM9KS_NCR        0x00    /* Network control Reg.*/
    #define DM9KS_NSR        0x01    /* Network Status Reg.*/
    #define DM9KS_TCR        0x02    /* TX control Reg.*/
    #define DM9KS_RXCR        0x05    /* RX control Reg.*/
    #define DM9KS_BPTR        0x08
    #define DM9KS_FCTR        0x09
    #define DM9KS_FCR            0x0a
    #define DM9KS_EPCR        0x0b
    #define DM9KS_EPAR        0x0c
    #define DM9KS_EPDRL        0x0d
    #define DM9KS_EPDRH        0x0e
    #define DM9KS_GPR            0x1f    /* General purpose register */
    #define DM9KS_CHIPR        0x2c
    #define DM9KS_TCR2        0x2d
    #define DM9KS_SMCR        0x2f     /* Special Mode Control Reg.*/
    #define DM9KS_ETXCSR    0x30    /* Early Transmit control/status Reg.*/
    #define    DM9KS_TCCR        0x31    /* Checksum cntrol Reg. */
    #define DM9KS_RCSR        0x32    /* Receive Checksum status Reg.*/
    #define DM9KS_BUSCR        0x38
    #define DM9KS_MRCMDX    0xf0
    #define DM9KS_MRCMD        0xf2
    #define DM9KS_MDRAL        0xf4
    #define DM9KS_MDRAH        0xf5
    #define DM9KS_MWCMD        0xf8
    #define DM9KS_MDWAL        0xfa
    #define DM9KS_MDWAH        0xfb
    #define DM9KS_TXPLL        0xfc
    #define DM9KS_TXPLH        0xfd
    #define DM9KS_ISR            0xfe
    #define DM9KS_IMR            0xff
    /*---------------------------------------------*/
    #define DM9KS_REG05        0x30    /* SKIP_CRC/SKIP_LONG */ 
    #define DM9KS_REGFF        0xA3    /* IMR */
    #define DM9KS_DISINTR    0x80
    
    #define DM9KS_PHY            0x40    /* PHY address 0x01 */
    #define DM9KS_PKT_RDY        0x01    /* Packet ready to receive */
    
    /* Added for PXA of MAINSTONE */
    #ifdef CONFIG_ARCH_MAINSTONE
    #include <asm/arch/mainstone.h>
    #define DM9KS_MIN_IO        (MST_ETH_PHYS + 0x300)
    #define DM9KS_MAX_IO            (MST_ETH_PHYS + 0x370)
    #define DM9K_IRQ        MAINSTONE_IRQ(3)
    #else
    #define DM9KS_MIN_IO        0x300
    #define DM9KS_MAX_IO        0x370
    #define DM9KS_IRQ        3
    #endif
    
    #define DM9KS_VID_L        0x28
    #define DM9KS_VID_H        0x29
    #define DM9KS_PID_L        0x2A
    #define DM9KS_PID_H        0x2B
    
    #define DM9KS_RX_INTR        0x01
    #define DM9KS_TX_INTR        0x02
    #define DM9KS_LINK_INTR        0x20
    
    #define DM9KS_DWORD_MODE    1
    #define DM9KS_BYTE_MODE        2
    #define DM9KS_WORD_MODE        0
    
    #define TRUE            1
    #define FALSE            0
    /* Number of continuous Rx packets */
    #define CONT_RX_PKT_CNT        0xFFFF
    
    #define DMFE_TIMER_WUT  jiffies+(HZ*5)    /* timer wakeup time : 5 second */
    
    #ifdef DM9KS_DEBUG
    #define DMFE_DBUG(dbug_now, msg, vaule)
    if (dmfe_debug||dbug_now) printk(KERN_ERR "dmfe: %s %x
    ", msg, vaule)
    #else
    #define DMFE_DBUG(dbug_now, msg, vaule)
    if (dbug_now) printk(KERN_ERR "dmfe: %s %x
    ", msg, vaule)
    #endif
    
    #ifndef CONFIG_ARCH_MAINSTONE
    #pragma pack(push, 1)
    #endif
    
    typedef struct _RX_DESC
    {
        u8 rxbyte;
        u8 status;
        u16 length;
    }RX_DESC;
    
    typedef union{
        u8 buf[4];
        RX_DESC desc;
    } rx_t;
    #ifndef CONFIG_ARCH_MAINSTONE
    #pragma pack(pop)
    #endif
    
    enum DM9KS_PHY_mode {
        DM9KS_10MHD   = 0, 
        DM9KS_100MHD  = 1, 
        DM9KS_10MFD   = 4,
        DM9KS_100MFD  = 5, 
        DM9KS_AUTO    = 8, 
    };
    
    /* Structure/enum declaration ------------------------------- */
    typedef struct board_info { 
        u32 io_addr;/* Register I/O base address */
        u32 io_data;/* Data I/O address */
        u8 op_mode;/* PHY operation mode */
        u8 io_mode;/* 0:word, 2:byte */
        u8 Speed;    /* current speed */
        u8 chip_revision;
        int rx_csum;/* 0:disable, 1:enable */
        
        u32 reset_counter;/* counter: RESET */ 
        u32 reset_tx_timeout;/* RESET caused by TX Timeout */
        int tx_pkt_cnt;
        int cont_rx_pkt_cnt;/* current number of continuos rx packets  */
        struct net_device_stats stats;
        
        struct timer_list timer;
        unsigned char srom[128];
        spinlock_t lock;
        struct mii_if_info mii;
    } board_info_t;
    /* Global variable declaration ----------------------------- */
    /*static int dmfe_debug = 0;*/
    static struct net_device * dmfe_dev = NULL;
    static struct ethtool_ops dmfe_ethtool_ops;
    /* For module input parameter */
    static int mode       = DM9KS_AUTO;  
    static int media_mode = DM9KS_AUTO;
    static int  irq        = DM9KS_IRQ;
    static int iobase     = DM9KS_MIN_IO;
    
    #if 0  // use physical address; Not virtual address
    #ifdef outb
        #undef outb
    #endif
    #ifdef outw
        #undef outw
    #endif
    #ifdef outl
        #undef outl
    #endif
    #ifdef inb
        #undef inb
    #endif
    #ifdef inw
        #undef inw
    #endif
    #ifdef inl
        #undef inl
    #endif
    void outb(u8 reg, u32 ioaddr)
    {
        (*(volatile u8 *)(ioaddr)) = reg;
    }
    void outw(u16 reg, u32 ioaddr)
    {
        (*(volatile u16 *)(ioaddr)) = reg;
    }
    void outl(u32 reg, u32 ioaddr)
    {
        (*(volatile u32 *)(ioaddr)) = reg;
    }
    u8 inb(u32 ioaddr)
    {
        return (*(volatile u8 *)(ioaddr));
    }
    u16 inw(u32 ioaddr)
    {
        return (*(volatile u16 *)(ioaddr));
    }
    u32 inl(u32 ioaddr)
    {
        return (*(volatile u32 *)(ioaddr));
    }
    #endif
    
    /* function declaration ------------------------------------- */
    int dmfe_probe1(struct net_device *);
    static int dmfe_open(struct net_device *);
    static int dmfe_start_xmit(struct sk_buff *, struct net_device *);
    static void dmfe_tx_done(unsigned long);
    static void dmfe_packet_receive(struct net_device *);
    static int dmfe_stop(struct net_device *);
    static struct net_device_stats * dmfe_get_stats(struct net_device *); 
    static int dmfe_do_ioctl(struct net_device *, struct ifreq *, int);
    #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
    static void dmfe_interrupt(int , void *, struct pt_regs *); 
    #else
        #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,19)
        static irqreturn_t dmfe_interrupt(int , void *, struct pt_regs *);
        #else
        static irqreturn_t dmfe_interrupt(int , void *);/* for kernel 2.6.20 */
        #endif
    #endif
    static void dmfe_timer(unsigned long);
    static void dmfe_init_dm9000(struct net_device *);
    static unsigned long cal_CRC(unsigned char *, unsigned int, u8);
    u8 ior(board_info_t *, int);
    void iow(board_info_t *, int, u8);
    static u16 phy_read(board_info_t *, int);
    static void phy_write(board_info_t *, int, u16);
    static u16 read_srom_word(board_info_t *, int);
    static void dm9000_hash_table(struct net_device *);
    static void dmfe_timeout(struct net_device *);
    static void dmfe_reset(struct net_device *);
    static int mdio_read(struct net_device *, int, int);
    static void mdio_write(struct net_device *, int, int, int);
    static void dmfe_get_drvinfo(struct net_device *, struct ethtool_drvinfo *);
    static int dmfe_get_settings(struct net_device *, struct ethtool_cmd *);
    static int dmfe_set_settings(struct net_device *, struct ethtool_cmd *);
    static u32 dmfe_get_link(struct net_device *);
    static int dmfe_nway_reset(struct net_device *);
    static uint32_t dmfe_get_rx_csum(struct net_device *);
    static uint32_t dmfe_get_tx_csum(struct net_device *);
    static int dmfe_set_rx_csum(struct net_device *, uint32_t );
    static int dmfe_set_tx_csum(struct net_device *, uint32_t );
    
    #ifdef DM8606
    #include "dm8606.h"
    #endif
    
    //DECLARE_TASKLET(dmfe_tx_tasklet,dmfe_tx_done,0);
    
    /* DM9000 network baord routine ---------------------------- */
    
    /*
      Search DM9000 board, allocate space and register it
    */
    
    struct net_device * __init dmfe_probe(void)
    {
        struct net_device *dev;
        int err;
        
        DMFE_DBUG(0, "dmfe_probe()",0);
    
    #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
        dev = init_etherdev(NULL, sizeof(struct board_info));
        //ether_setup(dev);        
    #else
        dev= alloc_etherdev(sizeof(struct board_info));
    #endif
    
        if(!dev)
            return ERR_PTR(-ENOMEM);
    
             SET_MODULE_OWNER(dev);
        err = dmfe_probe1(dev);
        if (err)
            goto out;
    #if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0)
        err = register_netdev(dev);
        if (err)
            goto out1;
    #endif
        return dev;
    out1:
        release_region(dev->base_addr,2);
    out:
    #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
        kfree(dev);
    #else
        free_netdev(dev);
    #endif
        return ERR_PTR(err);
    }
    
    int __init dmfe_probe1(struct net_device *dev)
    {
        struct board_info *db;    /* Point a board information structure */
        u32 id_val;
        u16 i, dm9000_found = FALSE;
        u8 MAC_addr[6]={0x00,0x60,0x6E,0x33,0x44,0x55};
        u8 HasEEPROM=0,chip_info;
        DMFE_DBUG(0, "dmfe_probe1()",0);
    
        /* Search All DM9000 serial NIC */
        do {
            outb(DM9KS_VID_L, iobase);
            id_val = inb(iobase + 4);
            outb(DM9KS_VID_H, iobase);
            id_val |= inb(iobase + 4) << 8;
            outb(DM9KS_PID_L, iobase);
            id_val |= inb(iobase + 4) << 16;
            outb(DM9KS_PID_H, iobase);
            id_val |= inb(iobase + 4) << 24;
    
            if (id_val == DM9KS_ID || id_val == DM9010_ID) {
                
                /* Request IO from system */
                if(!request_region(iobase, 2, dev->name))
                    return -ENODEV;
    
                printk(KERN_ERR"<DM9KS> I/O: %x, VID: %x 
    ",iobase, id_val);
                dm9000_found = TRUE;
    
                /* Allocated board information structure */
                memset(dev->priv, 0, sizeof(struct board_info));
                db = (board_info_t *)dev->priv;
                dmfe_dev    = dev;
                db->io_addr  = iobase;
                db->io_data = iobase + 4;   
                db->chip_revision = ior(db, DM9KS_CHIPR);
                
                chip_info = ior(db,0x43);
                //if((db->chip_revision!=0x1A) || ((chip_info&(1<<5))!=0) || ((chip_info&(1<<2))!=1)) return -ENODEV;
                            
                /* driver system function */                
                dev->base_addr         = iobase;
                dev->irq         = irq;
                dev->open         = &dmfe_open;
                dev->hard_start_xmit     = &dmfe_start_xmit;
                dev->watchdog_timeo    = 5*HZ;    
                dev->tx_timeout        = dmfe_timeout;
                dev->stop         = &dmfe_stop;
                dev->get_stats         = &dmfe_get_stats;
                dev->set_multicast_list = &dm9000_hash_table;
                dev->do_ioctl         = &dmfe_do_ioctl;
    #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,28)
                dev->ethtool_ops = &dmfe_ethtool_ops;
    #endif
    #ifdef CHECKSUM
                //dev->features |=  NETIF_F_IP_CSUM;
                dev->features |=  NETIF_F_IP_CSUM|NETIF_F_SG;
    #endif
                db->mii.dev = dev;
                db->mii.mdio_read = mdio_read;
                db->mii.mdio_write = mdio_write;
                db->mii.phy_id = 1;
    #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,20)
                db->mii.phy_id_mask = 0x1F; 
                db->mii.reg_num_mask = 0x1F; 
    #endif
                //db->msg_enable =(debug == 0 ? DMFE_DEF_MSG_ENABLE : ((1 << debug) - 1));
                
                /* Read SROM content */
                for (i=0; i<64; i++)
                    ((u16 *)db->srom)[i] = read_srom_word(db, i);
    
                /* Get the PID and VID from EEPROM to check */
                id_val = (((u16 *)db->srom)[4])|(((u16 *)db->srom)[5]<<16); 
                printk("id_val=%x
    ", id_val);
                if (id_val == DM9KS_ID || id_val == DM9010_ID) 
                    HasEEPROM =1;
                
                /* Set Node Address */
                for (i=0; i<6; i++)
                {
                    if (HasEEPROM) /* use EEPROM */
                        dev->dev_addr[i] = db->srom[i];
                    else    /* No EEPROM */
                        dev->dev_addr[i] = MAC_addr[i];
                }
            }//end of if()
            iobase += 0x10;
        }while(!dm9000_found && iobase <= DM9KS_MAX_IO);
    
        return dm9000_found ? 0:-ENODEV;
    }
    
    
    /*
      Open the interface.
      The interface is opened whenever "ifconfig" actives it.
    */
    static int dmfe_open(struct net_device *dev)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        u8 reg_nsr;
        int i;
        DMFE_DBUG(0, "dmfe_open", 0);
    
        if (request_irq(dev->irq,&dmfe_interrupt,IRQF_TRIGGER_RISING,dev->name,dev)) 
            return -EAGAIN;
    
        /* Initilize DM910X board */
        dmfe_init_dm9000(dev);
    #ifdef DM8606
        // control DM8606
        printk("[8606]reg0=0x%04x
    ",dm8606_read(db,0));
        printk("[8606]reg1=0x%04x
    ",dm8606_read(db,0x1));
    #endif 
        /* Init driver variable */
        db->reset_counter     = 0;
        db->reset_tx_timeout     = 0;
        db->cont_rx_pkt_cnt    = 0;
        
        /* check link state and media speed */
        db->Speed =10;
        i=0;
        do {
            reg_nsr = ior(db,DM9KS_NSR);
            if(reg_nsr & 0x40) /* link OK!! */
            {
                /* wait for detected Speed */
                mdelay(200);
                reg_nsr = ior(db,DM9KS_NSR);
                if(reg_nsr & 0x80)
                    db->Speed =10;
                else
                    db->Speed =100;
                break;
            }
            i++;
            mdelay(1);
        }while(i<3000);    /* wait 3 second  */
        //printk("i=%d  Speed=%d
    ",i,db->Speed);    
        /* set and active a timer process */
        init_timer(&db->timer);
        db->timer.expires     = DMFE_TIMER_WUT;
        db->timer.data         = (unsigned long)dev;
        db->timer.function     = &dmfe_timer;
        add_timer(&db->timer);    //Move to DM9000 initiallization was finished.
         
        netif_start_queue(dev);
    
        return 0;
    }
    
    /* Set PHY operationg mode
    */
    static void set_PHY_mode(board_info_t *db)
    {
    #ifndef DM8606
        u16 phy_reg0 = 0x1000;/* Auto-negotiation*/
        u16 phy_reg4 = 0x01e1;
    
        if ( !(db->op_mode & DM9KS_AUTO) ) // op_mode didn't auto sense */
        { 
            switch(db->op_mode) {
                case DM9KS_10MHD:  phy_reg4 = 0x21; 
                                           phy_reg0 = 0x1000;
                           break;
                case DM9KS_10MFD:  phy_reg4 = 0x41; 
                           phy_reg0 = 0x1100;
                                           break;
                case DM9KS_100MHD: phy_reg4 = 0x81; 
                           phy_reg0 = 0x3000;
                               break;
                case DM9KS_100MFD: phy_reg4 = 0x101; 
                           phy_reg0 = 0x3100;
                              break;
                default: 
                           break;
            } // end of switch
        } // end of if
    #ifdef FLOW_CONTROL
        phy_write(db, 4, phy_reg4|(1<<10));
    #else
        phy_write(db, 4, phy_reg4);
    #endif //end of FLOW_CONTROL
        phy_write(db, 0, phy_reg0|0x200);
    #else
        /* Fiber mode */
        phy_write(db, 16, 0x4014);
        phy_write(db, 0, 0x2100);
    #endif //end of DM8606
    
        if (db->chip_revision == 0x1A)
        {
            //set 10M TX idle =65mA (TX 100% utility is 160mA)
            phy_write(db,20, phy_read(db,20)|(1<<11)|(1<<10));
            
            //:fix harmonic
            //For short code:
            //PHY_REG 27 (1Bh) <- 0000h
            phy_write(db, 27, 0x0000);
            //PHY_REG 27 (1Bh) <- AA00h
            phy_write(db, 27, 0xaa00);
    
            //PHY_REG 27 (1Bh) <- 0017h
            phy_write(db, 27, 0x0017);
            //PHY_REG 27 (1Bh) <- AA17h
            phy_write(db, 27, 0xaa17);
    
            //PHY_REG 27 (1Bh) <- 002Fh
            phy_write(db, 27, 0x002f);
            //PHY_REG 27 (1Bh) <- AA2Fh
            phy_write(db, 27, 0xaa2f);
            
            //PHY_REG 27 (1Bh) <- 0037h
            phy_write(db, 27, 0x0037);
            //PHY_REG 27 (1Bh) <- AA37h
            phy_write(db, 27, 0xaa37);
            
            //PHY_REG 27 (1Bh) <- 0040h
            phy_write(db, 27, 0x0040);
            //PHY_REG 27 (1Bh) <- AA40h
            phy_write(db, 27, 0xaa40);
            
            //For long code:
            //PHY_REG 27 (1Bh) <- 0050h
            phy_write(db, 27, 0x0050);
            //PHY_REG 27 (1Bh) <- AA50h
            phy_write(db, 27, 0xaa50);
            
            //PHY_REG 27 (1Bh) <- 006Bh
            phy_write(db, 27, 0x006b);
            //PHY_REG 27 (1Bh) <- AA6Bh
            phy_write(db, 27, 0xaa6b);
            
            //PHY_REG 27 (1Bh) <- 007Dh
            phy_write(db, 27, 0x007d);
            //PHY_REG 27 (1Bh) <- AA7Dh
            phy_write(db, 27, 0xaa7d);
            
            //PHY_REG 27 (1Bh) <- 008Dh
            phy_write(db, 27, 0x008d);
            //PHY_REG 27 (1Bh) <- AA8Dh
            phy_write(db, 27, 0xaa8d);
            
            //PHY_REG 27 (1Bh) <- 009Ch
            phy_write(db, 27, 0x009c);
            //PHY_REG 27 (1Bh) <- AA9Ch
            phy_write(db, 27, 0xaa9c);
            
            //PHY_REG 27 (1Bh) <- 00A3h
            phy_write(db, 27, 0x00a3);
            //PHY_REG 27 (1Bh) <- AAA3h
            phy_write(db, 27, 0xaaa3);
            
            //PHY_REG 27 (1Bh) <- 00B1h
            phy_write(db, 27, 0x00b1);
            //PHY_REG 27 (1Bh) <- AAB1h
            phy_write(db, 27, 0xaab1);
            
            //PHY_REG 27 (1Bh) <- 00C0h
            phy_write(db, 27, 0x00c0);
            //PHY_REG 27 (1Bh) <- AAC0h
            phy_write(db, 27, 0xaac0);
            
            //PHY_REG 27 (1Bh) <- 00D2h
            phy_write(db, 27, 0x00d2);
            //PHY_REG 27 (1Bh) <- AAD2h
            phy_write(db, 27, 0xaad2);
            
            //PHY_REG 27 (1Bh) <- 00E0h
            phy_write(db, 27, 0x00e0);
            //PHY_REG 27 (1Bh) <- AAE0h
            phy_write(db, 27, 0xaae0);
            //PHY_REG 27 (1Bh) <- 0000h
            phy_write(db, 27, 0x0000);
        }
    }
    
    /* 
        Initilize dm9000 board
    */
    static void dmfe_init_dm9000(struct net_device *dev)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        DMFE_DBUG(0, "dmfe_init_dm9000()", 0);
    
        spin_lock_init(&db->lock);
        
        iow(db, DM9KS_GPR, 0);    /* GPR (reg_1Fh)bit GPIO0=0 pre-activate PHY */
        mdelay(20);        /* wait for PHY power-on ready */
    
        /* do a software reset and wait 20us */
        iow(db, DM9KS_NCR, 3);
        udelay(20);        /* wait 20us at least for software reset ok */
        iow(db, DM9KS_NCR, 3);    /* NCR (reg_00h) bit[0] RST=1 & Loopback=1, reset on */
        udelay(20);        /* wait 20us at least for software reset ok */
    
        /* I/O mode */
        db->io_mode = ior(db, DM9KS_ISR) >> 6; /* ISR bit7:6 keeps I/O mode */
    
        /* Set PHY */
        db->op_mode = media_mode;
        set_PHY_mode(db);
    
        /* Program operating register */
        iow(db, DM9KS_NCR, 0);
        iow(db, DM9KS_TCR, 0);        /* TX Polling clear */
        iow(db, DM9KS_BPTR, 0x3f);    /* Less 3kb, 600us */
        iow(db, DM9KS_SMCR, 0);        /* Special Mode */
        iow(db, DM9KS_NSR, 0x2c);    /* clear TX status */
        iow(db, DM9KS_ISR, 0x0f);     /* Clear interrupt status */
        iow(db, DM9KS_TCR2, 0x80);    /* Set LED mode 1 */
        if (db->chip_revision == 0x1A){ 
            /* Data bus current driving/sinking capability  */
            iow(db, DM9KS_BUSCR, 0x01);    /* default: 2mA */
        }
    #ifdef FLOW_CONTROL
        iow(db, DM9KS_BPTR, 0x37);
        iow(db, DM9KS_FCTR, 0x38);
        iow(db, DM9KS_FCR, 0x29);
    #endif
    
    #ifdef DM8606
        iow(db,0x34,1);
    #endif
    
        if (dev->features & NETIF_F_HW_CSUM){
            printk(KERN_INFO "DM9KS:enable TX checksum
    ");
            iow(db, DM9KS_TCCR, 0x07);    /* TX UDP/TCP/IP checksum enable */
        }
        if (db->rx_csum){
            printk(KERN_INFO "DM9KS:enable RX checksum
    ");
            iow(db, DM9KS_RCSR, 0x02);    /* RX checksum enable */
        }
    
    #ifdef ETRANS
        /*If TX loading is heavy, the driver can try to anbel "early transmit".
        The programmer can tune the "Early Transmit Threshold" to get 
        the optimization. (DM9KS_ETXCSR.[1-0])
        
        Side Effect: It will happen "Transmit under-run". When TX under-run
        always happens, the programmer can increase the value of "Early 
        Transmit Threshold". */
        iow(db, DM9KS_ETXCSR, 0x83);
    #endif
     
        /* Set address filter table */
        dm9000_hash_table(dev);
    
        /* Activate DM9000/DM9010 */
        iow(db, DM9KS_IMR, DM9KS_REGFF); /* Enable TX/RX interrupt mask */
        iow(db, DM9KS_RXCR, DM9KS_REG05 | 1);    /* RX enable */
        
        /* Init Driver variable */
        db->tx_pkt_cnt         = 0;
            
        netif_carrier_on(dev);
    
    }
    
    /*
      Hardware start transmission.
      Send a packet to media from the upper layer.
    */
    static int dmfe_start_xmit(struct sk_buff *skb, struct net_device *dev)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        char * data_ptr;
        int i, tmplen;
        u16 MDWAH, MDWAL;
        
        #ifdef TDBUG /* check TX FIFO pointer */
                u16 MDWAH1, MDWAL1;
                u16 tx_ptr;
        #endif
        
        DMFE_DBUG(0, "dmfe_start_xmit", 0);
        if (db->chip_revision != 0x1A)
        {    
            if(db->Speed == 10)
                {if (db->tx_pkt_cnt >= 1) return 1;}
            else
                {if (db->tx_pkt_cnt >= 2) return 1;}
        }else
            if (db->tx_pkt_cnt >= 2) return 1;
        
        /* packet counting */
        db->tx_pkt_cnt++;
    
        db->stats.tx_packets++;
        db->stats.tx_bytes+=skb->len;
        if (db->chip_revision != 0x1A)
        {
            if (db->Speed == 10)
                {if (db->tx_pkt_cnt >= 1) netif_stop_queue(dev);}
            else
                {if (db->tx_pkt_cnt >= 2) netif_stop_queue(dev);}
        }else
            if (db->tx_pkt_cnt >= 2) netif_stop_queue(dev);        
    
        /* Disable all interrupt */
        iow(db, DM9KS_IMR, DM9KS_DISINTR);
    
        MDWAH = ior(db,DM9KS_MDWAH);
        MDWAL = ior(db,DM9KS_MDWAL);
    
        /* Set TX length to reg. 0xfc & 0xfd */
        iow(db, DM9KS_TXPLL, (skb->len & 0xff));
        iow(db, DM9KS_TXPLH, (skb->len >> 8) & 0xff);
    
        /* Move data to TX SRAM */
        data_ptr = (char *)skb->data;
        
        outb(DM9KS_MWCMD, db->io_addr); // Write data into SRAM trigger
        switch(db->io_mode)
        {
            case DM9KS_BYTE_MODE:
                for (i = 0; i < skb->len; i++)
                    outb((data_ptr[i] & 0xff), db->io_data);
                break;
            case DM9KS_WORD_MODE:
                tmplen = (skb->len + 1) / 2;
                for (i = 0; i < tmplen; i++)
            outw(((u16 *)data_ptr)[i], db->io_data);
          break;
        case DM9KS_DWORD_MODE:
          tmplen = (skb->len + 3) / 4;            
                for (i = 0; i< tmplen; i++)
                    outl(((u32 *)data_ptr)[i], db->io_data);
                break;
        }
        
    #ifndef ETRANS
        /* Issue TX polling command */
        iow(db, DM9KS_TCR, 0x1); /* Cleared after TX complete*/
    #endif
    
        #ifdef TDBUG /* check TX FIFO pointer */
                MDWAH1 = ior(db,DM9KS_MDWAH);
                MDWAL1 = ior(db,DM9KS_MDWAL);
                tx_ptr = (MDWAH<<8)|MDWAL;
                switch (db->io_mode)
                {
                    case DM9KS_BYTE_MODE:
                        tx_ptr += skb->len;
                        break;
                    case DM9KS_WORD_MODE:
                        tx_ptr += ((skb->len + 1) / 2)*2;
                        break;
                    case DM9KS_DWORD_MODE:
                        tx_ptr += ((skb->len+3)/4)*4;
                        break;
                }
                if (tx_ptr > 0x0bff)
                        tx_ptr -= 0x0c00;
                if (tx_ptr != ((MDWAH1<<8)|MDWAL1))
                        printk("[dm9ks:TX FIFO ERROR
    ");
        #endif
        /* Saved the time stamp */
        dev->trans_start = jiffies;
        db->cont_rx_pkt_cnt =0;
    
        /* Free this SKB */
        dev_kfree_skb(skb);
    
        /* Re-enable interrupt */
        iow(db, DM9KS_IMR, DM9KS_REGFF);
    
        return 0;
    }
    
    /*
      Stop the interface.
      The interface is stopped when it is brought.
    */
    static int dmfe_stop(struct net_device *dev)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        DMFE_DBUG(0, "dmfe_stop", 0);
    
        /* deleted timer */
        del_timer(&db->timer);
    
        netif_stop_queue(dev); 
    
        /* free interrupt */
        free_irq(dev->irq, dev);
    
        /* RESET devie */
        phy_write(db, 0x00, 0x8000);    /* PHY RESET */
        //iow(db, DM9KS_GPR, 0x01);     /* Power-Down PHY */
        iow(db, DM9KS_IMR, DM9KS_DISINTR);    /* Disable all interrupt */
        iow(db, DM9KS_RXCR, 0x00);    /* Disable RX */
    
        /* Dump Statistic counter */
    #if FALSE
        printk("
    RX FIFO OVERFLOW %lx
    ", db->stats.rx_fifo_errors);
        printk("RX CRC %lx
    ", db->stats.rx_crc_errors);
        printk("RX LEN Err %lx
    ", db->stats.rx_length_errors);
        printk("RESET %x
    ", db->reset_counter);
        printk("RESET: TX Timeout %x
    ", db->reset_tx_timeout);
        printk("g_TX_nsr %x
    ", g_TX_nsr);
    #endif
    
        return 0;
    }
    
    static void dmfe_tx_done(unsigned long unused)
    {
        struct net_device *dev = dmfe_dev;
        board_info_t *db = (board_info_t *)dev->priv;
        int  nsr;
    
        DMFE_DBUG(0, "dmfe_tx_done()", 0);
        
        nsr = ior(db, DM9KS_NSR);
        if (nsr & 0x0c)
        {
            if(nsr & 0x04) db->tx_pkt_cnt--;
            if(nsr & 0x08) db->tx_pkt_cnt--;
            if(db->tx_pkt_cnt < 0)
            {
                printk(KERN_DEBUG "DM9KS:tx_pkt_cnt ERROR!!
    ");
                while(ior(db,DM9KS_TCR) & 0x1){}
                db->tx_pkt_cnt = 0;
            }
                
        }else{
            while(ior(db,DM9KS_TCR) & 0x1){}
            db->tx_pkt_cnt = 0;
        }
            
        netif_wake_queue(dev);
        
        return;
    }
    
    /*
      DM9000 insterrupt handler
      receive the packet to upper layer, free the transmitted packet
    */
    #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
    static void dmfe_interrupt(int irq, void *dev_id, struct pt_regs *regs)
    #else
        #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,19)
        static irqreturn_t dmfe_interrupt(int irq, void *dev_id, struct pt_regs *regs)
        #else
        static irqreturn_t dmfe_interrupt(int irq, void *dev_id) /* for kernel 2.6.20*/
        #endif
    #endif
    {
        struct net_device *dev = dev_id;
        board_info_t *db;
        int int_status,i;
        u8 reg_save;
    
        DMFE_DBUG(0, "dmfe_interrupt()", 0);
    
        /* A real interrupt coming */
        db = (board_info_t *)dev->priv;
        spin_lock(&db->lock);
    
        /* Save previous register address */
        reg_save = inb(db->io_addr);
    
        /* Disable all interrupt */
        iow(db, DM9KS_IMR, DM9KS_DISINTR); 
    
        /* Got DM9000/DM9010 interrupt status */
        int_status = ior(db, DM9KS_ISR);        /* Got ISR */
        iow(db, DM9KS_ISR, int_status);        /* Clear ISR status */ 
    
        /* Link status change */
        if (int_status & DM9KS_LINK_INTR) 
        {
            netif_stop_queue(dev);
            for(i=0; i<500; i++) /*wait link OK, waiting time =0.5s */
            {
                phy_read(db,0x1);
                if(phy_read(db,0x1) & 0x4) /*Link OK*/
                {
                    /* wait for detected Speed */
                    for(i=0; i<200;i++)
                        udelay(1000);
                    /* set media speed */
                    if(phy_read(db,0)&0x2000) db->Speed =100;
                    else db->Speed =10;
                    break;
                }
                udelay(1000);
            }
            netif_wake_queue(dev);
            //printk("[INTR]i=%d speed=%d
    ",i, (int)(db->Speed));    
        }
        /* Received the coming packet */
        if (int_status & DM9KS_RX_INTR) 
            dmfe_packet_receive(dev);
    
        /* Trnasmit Interrupt check */
        if (int_status & DM9KS_TX_INTR)
            dmfe_tx_done(0);
        
        if (db->cont_rx_pkt_cnt>=CONT_RX_PKT_CNT)
        {
            iow(db, DM9KS_IMR, 0xa2);
        }
        else
        {
            /* Re-enable interrupt mask */ 
            iow(db, DM9KS_IMR, DM9KS_REGFF);
        }
        
        /* Restore previous register address */
        outb(reg_save, db->io_addr); 
    
        spin_unlock(&db->lock); 
    #if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0)
        return IRQ_HANDLED;
    #endif
    }
    
    /*
      Get statistics from driver.
    */
    static struct net_device_stats * dmfe_get_stats(struct net_device *dev)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        DMFE_DBUG(0, "dmfe_get_stats", 0);
        return &db->stats;
    }
    /*
     *    Process the ethtool ioctl command
     */
    static int dmfe_ethtool_ioctl(struct net_device *dev, void *useraddr)
    {
        //struct dmfe_board_info *db = dev->priv;
        struct ethtool_drvinfo info = { ETHTOOL_GDRVINFO };
        u32 ethcmd;
    
        if (copy_from_user(&ethcmd, useraddr, sizeof(ethcmd)))
            return -EFAULT;
    
        switch (ethcmd) 
        {
            case ETHTOOL_GDRVINFO:
                strcpy(info.driver, DRV_NAME);
                strcpy(info.version, DRV_VERSION);
    
                sprintf(info.bus_info, "ISA 0x%lx %d",dev->base_addr, dev->irq);
                if (copy_to_user(useraddr, &info, sizeof(info)))
                    return -EFAULT;
                return 0;
        }
    
        return -EOPNOTSUPP;
    }
    /*
      Process the upper socket ioctl command
    */
    static int dmfe_do_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,7) /* for kernel 2.6.7 */
        struct mii_ioctl_data *data=(struct mii_ioctl_data *)&ifr->ifr_data; 
        #endif
      int rc=0;
            
        DMFE_DBUG(0, "dmfe_do_ioctl()", 0);
        
            if (!netif_running(dev))
                return -EINVAL;
    
            if (cmd == SIOCETHTOOL)
            rc = dmfe_ethtool_ioctl(dev, (void *) ifr->ifr_data);
        else {
            spin_lock_irq(&db->lock);
            #if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,7) /* for kernel 2.6.7 */
                rc = generic_mii_ioctl(&db->mii, data, cmd, NULL);
            #else
                rc = generic_mii_ioctl(&db->mii, if_mii(ifr), cmd, NULL);
            #endif
            spin_unlock_irq(&db->lock);
        }
    
        return rc;
    }
    
    /* Our watchdog timed out. Called by the networking layer */
    static void dmfe_timeout(struct net_device *dev)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        int i;
        
        DMFE_DBUG(0, "dmfe_TX_timeout()", 0);
        printk("TX time-out -- dmfe_timeout().
    ");
        db->reset_tx_timeout++;
        db->stats.tx_errors++;
        
    #if FALSE
        printk("TX packet count = %d
    ", db->tx_pkt_cnt);    
        printk("TX timeout = %d
    ", db->reset_tx_timeout);    
        printk("22H=0x%02x  23H=0x%02x
    ",ior(db,0x22),ior(db,0x23));
        printk("faH=0x%02x  fbH=0x%02x
    ",ior(db,0xfa),ior(db,0xfb));
    #endif
    
        i=0;
    
        while((i++<100)&&(ior(db,DM9KS_TCR) & 0x01))
        {
            udelay(30);
        }
            
        if(i<100)
        {
                db->tx_pkt_cnt = 0;
                netif_wake_queue(dev);
        }
        else
        {
                dmfe_reset(dev);
        }
    
    }
    
    static void dmfe_reset(struct net_device * dev)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        u8 reg_save;
        int i;
        /* Save previous register address */
        reg_save = inb(db->io_addr);
    
        netif_stop_queue(dev); 
        db->reset_counter++;
        dmfe_init_dm9000(dev);
        
        db->Speed =10;
        for(i=0; i<1000; i++) /*wait link OK, waiting time=1 second */
        {
            if(phy_read(db,0x1) & 0x4) /*Link OK*/
            {
                if(phy_read(db,0)&0x2000) db->Speed =100;
                else db->Speed =10;
                break;
            }
            udelay(1000);
        }
        
        netif_wake_queue(dev);
        
        /* Restore previous register address */
        outb(reg_save, db->io_addr);
    
    }
    /*
      A periodic timer routine
    */
    static void dmfe_timer(unsigned long data)
    {
        struct net_device * dev = (struct net_device *)data;
        board_info_t *db = (board_info_t *)dev->priv;
        DMFE_DBUG(0, "dmfe_timer()", 0);
        
        if (db->cont_rx_pkt_cnt>=CONT_RX_PKT_CNT)
        {
            db->cont_rx_pkt_cnt=0;
            iow(db, DM9KS_IMR, DM9KS_REGFF);
        }
        /* Set timer again */
        db->timer.expires = DMFE_TIMER_WUT;
        add_timer(&db->timer);
        
        return;
    }
    
    
    /*
      Received a packet and pass to upper layer
    */
    static void dmfe_packet_receive(struct net_device *dev)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        struct sk_buff *skb;
        u8 rxbyte;
        u16 i, GoodPacket, tmplen = 0, MDRAH, MDRAL;
        u32 tmpdata;
    
        rx_t rx;
    
        u16 * ptr = (u16*)&rx;
        u8* rdptr;
    
        DMFE_DBUG(0, "dmfe_packet_receive()", 0);
    
        db->cont_rx_pkt_cnt=0;
        
        do {
            /*store the value of Memory Data Read address register*/
            MDRAH=ior(db, DM9KS_MDRAH);
            MDRAL=ior(db, DM9KS_MDRAL);
            
            ior(db, DM9KS_MRCMDX);        /* Dummy read */
            rxbyte = inb(db->io_data);    /* Got most updated data */
    
    #ifdef CHECKSUM    
            if (rxbyte&0x2)            /* check RX byte */
            {    
          printk("dm9ks: abnormal!
    ");
                dmfe_reset(dev); 
                break;    
        }else { 
          if (!(rxbyte&0x1))
                    break;    
        }        
    #else
            if (rxbyte==0)
                break;
            
            if (rxbyte>1)
            {    
          printk("dm9ks: Rxbyte error!
    ");
              dmfe_reset(dev);
          break;    
        }
    #endif
    
            /* A packet ready now  & Get status/length */
            GoodPacket = TRUE;
            outb(DM9KS_MRCMD, db->io_addr);
    
            /* Read packet status & length */
            switch (db->io_mode) 
                {
                  case DM9KS_BYTE_MODE: 
                         *ptr = inb(db->io_data) + 
                                   (inb(db->io_data) << 8);
                        *(ptr+1) = inb(db->io_data) + 
                            (inb(db->io_data) << 8);
                        break;
                  case DM9KS_WORD_MODE:
                        *ptr = inw(db->io_data);
                        *(ptr+1)    = inw(db->io_data);
                        break;
                  case DM9KS_DWORD_MODE:
                        tmpdata  = inl(db->io_data);
                        *ptr = tmpdata;
                        *(ptr+1)    = tmpdata >> 16;
                        break;
                  default:
                        break;
                }
    
            /* Packet status check */
            if (rx.desc.status & 0xbf)
            {
                GoodPacket = FALSE;
                if (rx.desc.status & 0x01) 
                {
                    db->stats.rx_fifo_errors++;
                    printk(KERN_INFO"<RX FIFO error>
    ");
                }
                if (rx.desc.status & 0x02) 
                {
                    db->stats.rx_crc_errors++;
                    printk(KERN_INFO"<RX CRC error>
    ");
                }
                if (rx.desc.status & 0x80) 
                {
                    db->stats.rx_length_errors++;
                    printk(KERN_INFO"<RX Length error>
    ");
                }
                if (rx.desc.status & 0x08)
                    printk(KERN_INFO"<Physical Layer error>
    ");
            }
    
            if (!GoodPacket)
            {
                // drop this packet!!!
                switch (db->io_mode)
                {
                    case DM9KS_BYTE_MODE:
                         for (i=0; i<rx.desc.length; i++)
                            inb(db->io_data);
                        break;
                    case DM9KS_WORD_MODE:
                        tmplen = (rx.desc.length + 1) / 2;
                        for (i = 0; i < tmplen; i++)
                            inw(db->io_data);
                        break;
                    case DM9KS_DWORD_MODE:
                        tmplen = (rx.desc.length + 3) / 4;
                        for (i = 0; i < tmplen; i++)
                            inl(db->io_data);
                        break;
                }
                continue;/*next the packet*/
            }
            
            skb = dev_alloc_skb(rx.desc.length+4);
            if (skb == NULL )
            {    
                printk(KERN_INFO "%s: Memory squeeze.
    ", dev->name);
                /*re-load the value into Memory data read address register*/
                iow(db,DM9KS_MDRAH,MDRAH);
                iow(db,DM9KS_MDRAL,MDRAL);
                return;
            }
            else
            {
                /* Move data from DM9000 */
                skb->dev = dev;
                skb_reserve(skb, 2);
                rdptr = (u8*)skb_put(skb, rx.desc.length - 4);
                
                /* Read received packet from RX SARM */
                switch (db->io_mode)
                {
                    case DM9KS_BYTE_MODE:
                         for (i=0; i<rx.desc.length; i++)
                            rdptr[i]=inb(db->io_data);
                        break;
                    case DM9KS_WORD_MODE:
                        tmplen = (rx.desc.length + 1) / 2;
                        for (i = 0; i < tmplen; i++)
                            ((u16 *)rdptr)[i] = inw(db->io_data);
                        break;
                    case DM9KS_DWORD_MODE:
                        tmplen = (rx.desc.length + 3) / 4;
                        for (i = 0; i < tmplen; i++)
                            ((u32 *)rdptr)[i] = inl(db->io_data);
                        break;
                }
            
                /* Pass to upper layer */
                skb->protocol = eth_type_trans(skb,dev);
    
    #ifdef CHECKSUM
            if((rxbyte&0xe0)==0)    /* receive packet no checksum fail */
                    skb->ip_summed = CHECKSUM_UNNECESSARY;
    #endif
            
                netif_rx(skb);
                dev->last_rx=jiffies;
                db->stats.rx_packets++;
                db->stats.rx_bytes += rx.desc.length;
                db->cont_rx_pkt_cnt++;
    #ifdef RDBG /* check RX FIFO pointer */
                u16 MDRAH1, MDRAL1;
                u16 tmp_ptr;
                MDRAH1 = ior(db,DM9KS_MDRAH);
                MDRAL1 = ior(db,DM9KS_MDRAL);
                tmp_ptr = (MDRAH<<8)|MDRAL;
                switch (db->io_mode)
                {
                    case DM9KS_BYTE_MODE:
                        tmp_ptr += rx.desc.length+4;
                        break;
                    case DM9KS_WORD_MODE:
                        tmp_ptr += ((rx.desc.length+1)/2)*2+4;
                        break;
                    case DM9KS_DWORD_MODE:
                        tmp_ptr += ((rx.desc.length+3)/4)*4+4;
                        break;
                }
                if (tmp_ptr >=0x4000)
                    tmp_ptr = (tmp_ptr - 0x4000) + 0xc00;
                if (tmp_ptr != ((MDRAH1<<8)|MDRAL1))
                    printk("[dm9ks:RX FIFO ERROR
    ");
    #endif
                    
                if (db->cont_rx_pkt_cnt>=CONT_RX_PKT_CNT)
                {
                    dmfe_tx_done(0);
                    break;
                }
            }
                
        }while((rxbyte & 0x01) == DM9KS_PKT_RDY);
        DMFE_DBUG(0, "[END]dmfe_packet_receive()", 0);
        
    }
    
    /*
      Read a word data from SROM
    */
    static u16 read_srom_word(board_info_t *db, int offset)
    {
        iow(db, DM9KS_EPAR, offset);
        iow(db, DM9KS_EPCR, 0x4);
        while(ior(db, DM9KS_EPCR)&0x1);    /* Wait read complete */
        iow(db, DM9KS_EPCR, 0x0);
        return (ior(db, DM9KS_EPDRL) + (ior(db, DM9KS_EPDRH) << 8) );
    }
    
    /*
      Set DM9000/DM9010 multicast address
    */
    static void dm9000_hash_table(struct net_device *dev)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        struct dev_mc_list *mcptr = dev->mc_list;
        int mc_cnt = dev->mc_count;
        u32 hash_val;
        u16 i, oft, hash_table[4];
    
        DMFE_DBUG(0, "dm9000_hash_table()", 0);
    
        /* enable promiscuous mode */
        if (dev->flags & IFF_PROMISC){
            //printk(KERN_INFO "DM9KS:enable promiscuous mode
    ");
            iow(db, DM9KS_RXCR, ior(db,DM9KS_RXCR)|(1<<1));
            return;
        }else{
            //printk(KERN_INFO "DM9KS:disable promiscuous mode
    ");
            iow(db, DM9KS_RXCR, ior(db,DM9KS_RXCR)&(~(1<<1)));
        }
            
        /* Receive all multicast packets */
        if (dev->flags & IFF_ALLMULTI){
            //printk(KERN_INFO "DM9KS:Pass all multicast
    ");
            iow(db, DM9KS_RXCR, ior(db,DM9KS_RXCR)|(1<<3));
        }else{
            //printk(KERN_INFO "DM9KS:Disable pass all multicast
    ");
            iow(db, DM9KS_RXCR, ior(db,DM9KS_RXCR)&(~(1<<3)));
        }
        
        /* Set Node address */
        for (i = 0, oft = 0x10; i < 6; i++, oft++)
            iow(db, oft, dev->dev_addr[i]);
    
        /* Clear Hash Table */
        for (i = 0; i < 4; i++)
            hash_table[i] = 0x0;
    
        /* broadcast address */
        hash_table[3] = 0x8000;
    
        /* the multicast address in Hash Table : 64 bits */
        for (i = 0; i < mc_cnt; i++, mcptr = mcptr->next) {
            hash_val = cal_CRC((char *)mcptr->dmi_addr, 6, 0) & 0x3f; 
            hash_table[hash_val / 16] |= (u16) 1 << (hash_val % 16);
        }
    
        /* Write the hash table to MAC MD table */
        for (i = 0, oft = 0x16; i < 4; i++) {
            iow(db, oft++, hash_table[i] & 0xff);
            iow(db, oft++, (hash_table[i] >> 8) & 0xff);
        }
    }
    
    /*
      Calculate the CRC valude of the Rx packet
      flag = 1 : return the reverse CRC (for the received packet CRC)
             0 : return the normal CRC (for Hash Table index)
    */
    static unsigned long cal_CRC(unsigned char * Data, unsigned int Len, u8 flag)
    {    
        u32 crc = ether_crc_le(Len, Data);
    
        if (flag) 
            return ~crc;
            
        return crc;     
    }
    
    static int mdio_read(struct net_device *dev, int phy_id, int location)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        return phy_read(db, location);
    }
    
    static void mdio_write(struct net_device *dev, int phy_id, int location, int val)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        phy_write(db, location, val);
    }
    
    /*
       Read a byte from I/O port
    */
    u8 ior(board_info_t *db, int reg)
    {
        outb(reg, db->io_addr);
        return inb(db->io_data);
    }
    
    /*
       Write a byte to I/O port
    */
    void iow(board_info_t *db, int reg, u8 value)
    {
        outb(reg, db->io_addr);
        outb(value, db->io_data);
    }
    
    /*
       Read a word from phyxcer
    */
    static u16 phy_read(board_info_t *db, int reg)
    {
        /* Fill the phyxcer register into REG_0C */
        iow(db, DM9KS_EPAR, DM9KS_PHY | reg);
    
        iow(db, DM9KS_EPCR, 0xc);     /* Issue phyxcer read command */
        while(ior(db, DM9KS_EPCR)&0x1);    /* Wait read complete */
        iow(db, DM9KS_EPCR, 0x0);     /* Clear phyxcer read command */
    
        /* The read data keeps on REG_0D & REG_0E */
        return ( ior(db, DM9KS_EPDRH) << 8 ) | ior(db, DM9KS_EPDRL);
        
    }
    
    /*
       Write a word to phyxcer
    */
    static void phy_write(board_info_t *db, int reg, u16 value)
    {
        /* Fill the phyxcer register into REG_0C */
        iow(db, DM9KS_EPAR, DM9KS_PHY | reg);
    
        /* Fill the written data into REG_0D & REG_0E */
        iow(db, DM9KS_EPDRL, (value & 0xff));
        iow(db, DM9KS_EPDRH, ( (value >> 8) & 0xff));
    
        iow(db, DM9KS_EPCR, 0xa);    /* Issue phyxcer write command */
        while(ior(db, DM9KS_EPCR)&0x1);    /* Wait read complete */
        iow(db, DM9KS_EPCR, 0x0);    /* Clear phyxcer write command */
    }
    //====dmfe_ethtool_ops member functions====
    static void dmfe_get_drvinfo(struct net_device *dev,
                       struct ethtool_drvinfo *info)
    {
        //board_info_t *db = (board_info_t *)dev->priv;
        strcpy(info->driver, DRV_NAME);
        strcpy(info->version, DRV_VERSION);
        sprintf(info->bus_info, "ISA 0x%lx irq=%d",dev->base_addr, dev->irq);
    }
    static int dmfe_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        spin_lock_irq(&db->lock);
        mii_ethtool_gset(&db->mii, cmd);
        spin_unlock_irq(&db->lock);
        return 0;
    }
    static int dmfe_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        int rc;
    
        spin_lock_irq(&db->lock);
        rc = mii_ethtool_sset(&db->mii, cmd);
        spin_unlock_irq(&db->lock);
        return rc;
    }
    /*
    * Check the link state
    */
    static u32 dmfe_get_link(struct net_device *dev)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        return mii_link_ok(&db->mii);
    }
    
    /*
    * Reset Auto-negitiation
    */
    static int dmfe_nway_reset(struct net_device *dev)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        return mii_nway_restart(&db->mii);
    }
    /*
    * Get RX checksum offload state
    */
    static uint32_t dmfe_get_rx_csum(struct net_device *dev)
    {
        board_info_t *db = (board_info_t *)dev->priv;
        return db->rx_csum;
    }
    /*
    * Get TX checksum offload state
    */
    static uint32_t dmfe_get_tx_csum(struct net_device *dev)
    {
        return (dev->features & NETIF_F_HW_CSUM) != 0;
    }
    /* 
    * Enable/Disable RX checksum offload
    */
    static int dmfe_set_rx_csum(struct net_device *dev, uint32_t data)
    {
    #ifdef CHECKSUM
        board_info_t *db = (board_info_t *)dev->priv;
        db->rx_csum = data;
    
        if(netif_running(dev)) {
            dmfe_stop(dev);
            dmfe_open(dev);
        } else
            dmfe_init_dm9000(dev);
    #else
        printk(KERN_ERR "DM9:Don't support checksum
    ");
    #endif
        return 0;
    }
    /* 
    * Enable/Disable TX checksum offload
    */
    static int dmfe_set_tx_csum(struct net_device *dev, uint32_t data)
    {
    #ifdef CHECKSUM
        if (data)
            dev->features |= NETIF_F_HW_CSUM;
        else
            dev->features &= ~NETIF_F_HW_CSUM;
    #else
        printk(KERN_ERR "DM9:Don't support checksum
    ");
    #endif
    
        return 0;
    }
    //=========================================
    #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,28)  /* for kernel 2.4.28 */
    static struct ethtool_ops dmfe_ethtool_ops = {
        .get_drvinfo        = dmfe_get_drvinfo,
        .get_settings        = dmfe_get_settings,
        .set_settings        = dmfe_set_settings,
        .get_link            = dmfe_get_link,
        .nway_reset        = dmfe_nway_reset,
        .get_rx_csum        = dmfe_get_rx_csum,
        .set_rx_csum        = dmfe_set_rx_csum,
        .get_tx_csum        = dmfe_get_tx_csum,
        .set_tx_csum        = dmfe_set_tx_csum,
    };
    #endif
    
    //#ifdef MODULE
    
    MODULE_LICENSE("GPL");
    MODULE_DESCRIPTION("Davicom DM9000/DM9010 ISA/uP Fast Ethernet Driver");
    #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) 
    MODULE_PARM(mode, "i");
    MODULE_PARM(irq, "i");
    MODULE_PARM(iobase, "i");
    #else
    module_param(mode, int, 0);
    module_param(irq, int, 0);
    module_param(iobase, int, 0);
    #endif           
    MODULE_PARM_DESC(mode,"Media Speed, 0:10MHD, 1:10MFD, 4:100MHD, 5:100MFD");
    MODULE_PARM_DESC(irq,"EtherLink IRQ number");
    MODULE_PARM_DESC(iobase, "EtherLink I/O base address");
    
    /* Description: 
       when user used insmod to add module, system invoked init_module()
       to initilize and register.
    */
    int __init dm9000c_init(void)
    {
        volatile unsigned long *bwscon;   //0x48000000
        volatile unsigned long *bankcon4; //0x48000014
        iobase = (int)ioremap(0x20000000,1024);
        irq = IRQ_EINT7;
    
        /* 设置内存控制器 */
        bwscon = ioremap(0x48000000,4);
        bankcon4 = ioremap(0x48000014,4);
        *bwscon &= ~((0xf<<16));
        *bwscon |= (1<<16);
    
        *bankcon4 = (0<<13) | (1<<8) | (1<<6);  
    
        iounmap(bwscon);
        iounmap(bankcon4);
    
        switch(mode) {
            case DM9KS_10MHD:
            case DM9KS_100MHD:
            case DM9KS_10MFD:
            case DM9KS_100MFD:
                media_mode = mode;
                break;
            default:
                media_mode = DM9KS_AUTO;
        }
        dmfe_dev = dmfe_probe();
        if(IS_ERR(dmfe_dev))
            return PTR_ERR(dmfe_dev);
        return 0;
    }
    /* Description: 
       when user used rmmod to delete module, system invoked clean_module()
       to  un-register DEVICE.
    */
    void __exit dm9000c_exit(void)
    {
        struct net_device *dev = dmfe_dev;
        DMFE_DBUG(0, "clean_module()", 0);
        iounmap((void *)iobase);
        unregister_netdev(dmfe_dev);
        release_region(dev->base_addr, 2);
    #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
        kfree(dev);
    #else
        free_netdev(dev);
    #endif
        
        DMFE_DBUG(0, "clean_module() exit", 0);
    }
    
    module_init(dm9000c_init);
    module_exit(dm9000c_exit);
    //#endif

    sd

  • 相关阅读:
    Beyond Compare设置
    lt29配置
    [Windows] 常用的快捷命令
    【C&C++】数组初始化的思考
    【Windows批处理】常用命令解析
    Linux下将网站数据自动备份到Dropbox
    CentOS下iRedMail安装配置
    Python 大数据思维导图
    libxml2编程基础
    xml文件的解析
  • 原文地址:https://www.cnblogs.com/ynxf/p/6049245.html
Copyright © 2020-2023  润新知