Merge branch 'davem-next' of master.kernel.org:/pub/scm/linux/kernel/git/jgarzik/netdev-2.6

1 files changed, 600 insertions, 559 deletions

diff --git a/drivers/net/dm9000.c b/drivers/net/dm9000.c
index 08a7365a7d10..952e10d686ec 100644
--- a/drivers/net/dm9000.c
+++ b/drivers/net/dm9000.c
@@ -44,9 +44,8 @@
 
 #define DM9000_PHY              0x40    /* PHY address 0x01 */
 
-#define CARDNAME "dm9000"
-#define PFX CARDNAME ": "
-#define DRV_VERSION     "1.30"
+#define CARDNAME        "dm9000"
+#define DRV_VERSION     "1.31"
 
 #ifdef CONFIG_BLACKFIN
 #define readsb  insb
@@ -55,9 +54,6 @@
 #define writesb outsb
 #define writesw outsw
 #define writesl outsl
-#define DEFAULT_TRIGGER IRQF_TRIGGER_HIGH
-#else
-#define DEFAULT_TRIGGER (0)
 #endif
 
 /*
@@ -85,23 +81,36 @@ MODULE_PARM_DESC(watchdog, "transmit timeout in milliseconds");
  * these two devices.
  */
 
+/* The driver supports the original DM9000E, and now the two newer
+ * devices, DM9000A and DM9000B.
+ */
+
+enum dm9000_type {
+        TYPE_DM9000E,   /* original DM9000 */
+        TYPE_DM9000A,
+        TYPE_DM9000B
+};
+
 /* Structure/enum declaration ------------------------------- */
 typedef struct board_info {
 
-        void __iomem *io_addr;  /* Register I/O base address */
-        void __iomem *io_data;  /* Data I/O address */
-        u16 irq;                /* IRQ */
+        void __iomem    *io_addr;       /* Register I/O base address */
+        void __iomem    *io_data;       /* Data I/O address */
+        u16              irq;           /* IRQ */
 
-        u16 tx_pkt_cnt;
-        u16 queue_pkt_len;
-        u16 queue_start_addr;
-        u16 dbug_cnt;
-        u8 io_mode;             /* 0:word, 2:byte */
-        u8 phy_addr;
-        unsigned int flags;
-        unsigned int in_suspend :1;
+        u16             tx_pkt_cnt;
+        u16             queue_pkt_len;
+        u16             queue_start_addr;
+        u16             dbug_cnt;
+        u8              io_mode;                /* 0:word, 2:byte */
+        u8              phy_addr;
+        u8              imr_all;
 
-        int debug_level;
+        unsigned int    flags;
+        unsigned int    in_suspend :1;
+        int             debug_level;
+
+        enum dm9000_type type;
 
         void (*inblk)(void __iomem *port, void *data, int length);
         void (*outblk)(void __iomem *port, void *data, int length);
@@ -120,10 +129,10 @@ typedef struct board_info {
         struct delayed_work phy_poll;
         struct net_device  *ndev;
 
-        spinlock_t lock;
+        spinlock_t      lock;
 
         struct mii_if_info mii;
-        u32 msg_enable;
+        u32             msg_enable;
 } board_info_t;
 
 /* debug code */
@@ -140,26 +149,6 @@ static inline board_info_t *to_dm9000_board(struct net_device *dev)
         return dev->priv;
 }
 
-/* function declaration ------------------------------------- */
-static int dm9000_probe(struct platform_device *);
-static int dm9000_open(struct net_device *);
-static int dm9000_start_xmit(struct sk_buff *, struct net_device *);
-static int dm9000_stop(struct net_device *);
-static int dm9000_ioctl(struct net_device *dev, struct ifreq *req, int cmd);
-
-static void dm9000_init_dm9000(struct net_device *);
-
-static irqreturn_t dm9000_interrupt(int, void *);
-
-static int dm9000_phy_read(struct net_device *dev, int phyaddr_unsused, int reg);
-static void dm9000_phy_write(struct net_device *dev, int phyaddr_unused, int reg,
-                           int value);
-
-static void dm9000_read_eeprom(board_info_t *, int addr, u8 *to);
-static void dm9000_write_eeprom(board_info_t *, int addr, u8 *dp);
-static void dm9000_rx(struct net_device *);
-static void dm9000_hash_table(struct net_device *);
-
 /* DM9000 network board routine ---------------------------- */
 
 static void
@@ -302,52 +291,135 @@ static void dm9000_set_io(struct board_info *db, int byte_width)
 
 static void dm9000_schedule_poll(board_info_t *db)
 {
-        schedule_delayed_work(&db->phy_poll, HZ * 2);
+        if (db->type == TYPE_DM9000E)
+                schedule_delayed_work(&db->phy_poll, HZ * 2);
 }
 
-/* Our watchdog timed out. Called by the networking layer */
-static void dm9000_timeout(struct net_device *dev)
+static int dm9000_ioctl(struct net_device *dev, struct ifreq *req, int cmd)
+{
+        board_info_t *dm = to_dm9000_board(dev);
+
+        if (!netif_running(dev))
+                return -EINVAL;
+
+        return generic_mii_ioctl(&dm->mii, if_mii(req), cmd, NULL);
+}
+
+static unsigned int
+dm9000_read_locked(board_info_t *db, int reg)
 {
-        board_info_t *db = (board_info_t *) dev->priv;
-        u8 reg_save;
         unsigned long flags;
+        unsigned int ret;
 
-        /* Save previous register address */
-        reg_save = readb(db->io_addr);
-        spin_lock_irqsave(&db->lock,flags);
+        spin_lock_irqsave(&db->lock, flags);
+        ret = ior(db, reg);
+        spin_unlock_irqrestore(&db->lock, flags);
 
-        netif_stop_queue(dev);
-        dm9000_reset(db);
-        dm9000_init_dm9000(dev);
-        /* We can accept TX packets again */
-        dev->trans_start = jiffies;
-        netif_wake_queue(dev);
+        return ret;
+}
 
-        /* Restore previous register address */
-        writeb(reg_save, db->io_addr);
-        spin_unlock_irqrestore(&db->lock,flags);
+static int dm9000_wait_eeprom(board_info_t *db)
+{
+        unsigned int status;
+        int timeout = 8;        /* wait max 8msec */
+
+        /* The DM9000 data sheets say we should be able to
+         * poll the ERRE bit in EPCR to wait for the EEPROM
+         * operation. From testing several chips, this bit
+         * does not seem to work.
+         *
+         * We attempt to use the bit, but fall back to the
+         * timeout (which is why we do not return an error
+         * on expiry) to say that the EEPROM operation has
+         * completed.
+         */
+
+        while (1) {
+                status = dm9000_read_locked(db, DM9000_EPCR);
+
+                if ((status & EPCR_ERRE) == 0)
+                        break;
+
+                msleep(1);
+
+                if (timeout-- < 0) {
+                        dev_dbg(db->dev, "timeout waiting EEPROM\n");
+                        break;
+                }
+        }
+
+        return 0;
 }
 
-#ifdef CONFIG_NET_POLL_CONTROLLER
 /*
- *Used by netconsole
+ *  Read a word data from EEPROM
  */
-static void dm9000_poll_controller(struct net_device *dev)
+static void
+dm9000_read_eeprom(board_info_t *db, int offset, u8 *to)
 {
-        disable_irq(dev->irq);
-        dm9000_interrupt(dev->irq,dev);
-        enable_irq(dev->irq);
+        unsigned long flags;
+
+        if (db->flags & DM9000_PLATF_NO_EEPROM) {
+                to[0] = 0xff;
+                to[1] = 0xff;
+                return;
+        }
+
+        mutex_lock(&db->addr_lock);
+
+        spin_lock_irqsave(&db->lock, flags);
+
+        iow(db, DM9000_EPAR, offset);
+        iow(db, DM9000_EPCR, EPCR_ERPRR);
+
+        spin_unlock_irqrestore(&db->lock, flags);
+
+        dm9000_wait_eeprom(db);
+
+        /* delay for at-least 150uS */
+        msleep(1);
+
+        spin_lock_irqsave(&db->lock, flags);
+
+        iow(db, DM9000_EPCR, 0x0);
+
+        to[0] = ior(db, DM9000_EPDRL);
+        to[1] = ior(db, DM9000_EPDRH);
+
+        spin_unlock_irqrestore(&db->lock, flags);
+
+        mutex_unlock(&db->addr_lock);
 }
-#endif
 
-static int dm9000_ioctl(struct net_device *dev, struct ifreq *req, int cmd)
+/*
+ * Write a word data to SROM
+ */
+static void
+dm9000_write_eeprom(board_info_t *db, int offset, u8 *data)
 {
-        board_info_t *dm = to_dm9000_board(dev);
+        unsigned long flags;
 
-        if (!netif_running(dev))
-                return -EINVAL;
+        if (db->flags & DM9000_PLATF_NO_EEPROM)
+                return;
 
-        return generic_mii_ioctl(&dm->mii, if_mii(req), cmd, NULL);
+        mutex_lock(&db->addr_lock);
+
+        spin_lock_irqsave(&db->lock, flags);
+        iow(db, DM9000_EPAR, offset);
+        iow(db, DM9000_EPDRH, data[1]);
+        iow(db, DM9000_EPDRL, data[0]);
+        iow(db, DM9000_EPCR, EPCR_WEP | EPCR_ERPRW);
+        spin_unlock_irqrestore(&db->lock, flags);
+
+        dm9000_wait_eeprom(db);
+
+        mdelay(1);      /* wait at least 150uS to clear */
+
+        spin_lock_irqsave(&db->lock, flags);
+        iow(db, DM9000_EPCR, 0);
+        spin_unlock_irqrestore(&db->lock, flags);
+
+        mutex_unlock(&db->addr_lock);
 }
 
 /* ethtool ops */
@@ -400,7 +472,14 @@ static int dm9000_nway_reset(struct net_device *dev)
 static u32 dm9000_get_link(struct net_device *dev)
 {
         board_info_t *dm = to_dm9000_board(dev);
-        return mii_link_ok(&dm->mii);
+        u32 ret;
+
+        if (dm->flags & DM9000_PLATF_EXT_PHY)
+                ret = mii_link_ok(&dm->mii);
+        else
+                ret = dm9000_read_locked(dm, DM9000_NSR) & NSR_LINKST ? 1 : 0;
+
+        return ret;
 }
 
 #define DM_EEPROM_MAGIC         (0x444D394B)
@@ -472,15 +551,48 @@ static const struct ethtool_ops dm9000_ethtool_ops = {
         .set_eeprom             = dm9000_set_eeprom,
 };
 
+static void dm9000_show_carrier(board_info_t *db,
+                                unsigned carrier, unsigned nsr)
+{
+        struct net_device *ndev = db->ndev;
+        unsigned ncr = dm9000_read_locked(db, DM9000_NCR);
+
+        if (carrier)
+                dev_info(db->dev, "%s: link up, %dMbps, %s-duplex, no LPA\n",
+                         ndev->name, (nsr & NSR_SPEED) ? 10 : 100,
+                         (ncr & NCR_FDX) ? "full" : "half");
+        else
+                dev_info(db->dev, "%s: link down\n", ndev->name);
+}
+
 static void
 dm9000_poll_work(struct work_struct *w)
 {
         struct delayed_work *dw = container_of(w, struct delayed_work, work);
         board_info_t *db = container_of(dw, board_info_t, phy_poll);
+        struct net_device *ndev = db->ndev;
+
+        if (db->flags & DM9000_PLATF_SIMPLE_PHY &&
+            !(db->flags & DM9000_PLATF_EXT_PHY)) {
+                unsigned nsr = dm9000_read_locked(db, DM9000_NSR);
+                unsigned old_carrier = netif_carrier_ok(ndev) ? 1 : 0;
+                unsigned new_carrier;
 
-        mii_check_media(&db->mii, netif_msg_link(db), 0);
+                new_carrier = (nsr & NSR_LINKST) ? 1 : 0;
+
+                if (old_carrier != new_carrier) {
+                        if (netif_msg_link(db))
+                                dm9000_show_carrier(db, new_carrier, nsr);
+
+                        if (!new_carrier)
+                                netif_carrier_off(ndev);
+                        else
+                                netif_carrier_on(ndev);
+                }
+        } else
+                mii_check_media(&db->mii, netif_msg_link(db), 0);
         
-        if (netif_running(db->ndev))
+        if (netif_running(ndev))
                 dm9000_schedule_poll(db);
 }
 
@@ -492,12 +604,6 @@ dm9000_poll_work(struct work_struct *w)
 static void
 dm9000_release_board(struct platform_device *pdev, struct board_info *db)
 {
-        if (db->data_res == NULL) {
-                if (db->addr_res != NULL)
-                        release_mem_region((unsigned long)db->io_addr, 4);
-                return;
-        }
-
         /* unmap our resources */
 
         iounmap(db->io_addr);
@@ -505,288 +611,73 @@ dm9000_release_board(struct platform_device *pdev, struct board_info *db)
 
         /* release the resources */
 
-        if (db->data_req != NULL) {
-                release_resource(db->data_req);
-                kfree(db->data_req);
-        }
+        release_resource(db->data_req);
+        kfree(db->data_req);
 
-        if (db->addr_req != NULL) {
-                release_resource(db->addr_req);
-                kfree(db->addr_req);
-        }
+        release_resource(db->addr_req);
+        kfree(db->addr_req);
 }
 
-#define res_size(_r) (((_r)->end - (_r)->start) + 1)
-
-/*
- * Search DM9000 board, allocate space and register it
- */
-static int __devinit
-dm9000_probe(struct platform_device *pdev)
+static unsigned char dm9000_type_to_char(enum dm9000_type type)
 {
-        struct dm9000_plat_data *pdata = pdev->dev.platform_data;
-        struct board_info *db;  /* Point a board information structure */
-        struct net_device *ndev;
-        const unsigned char *mac_src;
-        unsigned long base;
-        int ret = 0;
-        int iosize;
-        int i;
-        u32 id_val;
-
-        /* Init network device */
-        ndev = alloc_etherdev(sizeof (struct board_info));
-        if (!ndev) {
-                dev_err(&pdev->dev, "could not allocate device.\n");
-                return -ENOMEM;
-        }
-
-        SET_NETDEV_DEV(ndev, &pdev->dev);
-
-        dev_dbg(&pdev->dev, "dm9000_probe()\n");
-
-        /* setup board info structure */
-        db = (struct board_info *) ndev->priv;
-        memset(db, 0, sizeof (*db));
-
-        db->dev = &pdev->dev;
-        db->ndev = ndev;
-
-        spin_lock_init(&db->lock);
-        mutex_init(&db->addr_lock);
-
-        INIT_DELAYED_WORK(&db->phy_poll, dm9000_poll_work);
-
-
-        if (pdev->num_resources < 2) {
-                ret = -ENODEV;
-                goto out;
-        } else if (pdev->num_resources == 2) {
-                base = pdev->resource[0].start;
-
-                if (!request_mem_region(base, 4, ndev->name)) {
-                        ret = -EBUSY;
-                        goto out;
-                }
-
-                ndev->base_addr = base;
-                ndev->irq = pdev->resource[1].start;
-                db->io_addr = (void __iomem *)base;
-                db->io_data = (void __iomem *)(base + 4);
-
-                /* ensure at least we have a default set of IO routines */
-                dm9000_set_io(db, 2);
-
-        } else {
-                db->addr_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
-                db->data_res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
-                db->irq_res  = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
-
-                if (db->addr_res == NULL || db->data_res == NULL ||
-                    db->irq_res == NULL) {
-                        dev_err(db->dev, "insufficient resources\n");
-                        ret = -ENOENT;
-                        goto out;
-                }
-
-                i = res_size(db->addr_res);
-                db->addr_req = request_mem_region(db->addr_res->start, i,
-                                                  pdev->name);
-
-                if (db->addr_req == NULL) {
-                        dev_err(db->dev, "cannot claim address reg area\n");
-                        ret = -EIO;
-                        goto out;
-                }
-
-                db->io_addr = ioremap(db->addr_res->start, i);
-
-                if (db->io_addr == NULL) {
-                        dev_err(db->dev, "failed to ioremap address reg\n");
-                        ret = -EINVAL;
-                        goto out;
-                }
-
-                iosize = res_size(db->data_res);
-                db->data_req = request_mem_region(db->data_res->start, iosize,
-                                                  pdev->name);
-
-                if (db->data_req == NULL) {
-                        dev_err(db->dev, "cannot claim data reg area\n");
-                        ret = -EIO;
-                        goto out;
-                }
-
-                db->io_data = ioremap(db->data_res->start, iosize);
-
-                if (db->io_data == NULL) {
-                        dev_err(db->dev,"failed to ioremap data reg\n");
-                        ret = -EINVAL;
-                        goto out;
-                }
-
-                /* fill in parameters for net-dev structure */
-
-                ndev->base_addr = (unsigned long)db->io_addr;
-                ndev->irq       = db->irq_res->start;
-
-                /* ensure at least we have a default set of IO routines */
-                dm9000_set_io(db, iosize);
+        switch (type) {
+        case TYPE_DM9000E: return 'e';
+        case TYPE_DM9000A: return 'a';
+        case TYPE_DM9000B: return 'b';
         }
 
-        /* check to see if anything is being over-ridden */
-        if (pdata != NULL) {
-                /* check to see if the driver wants to over-ride the
-                 * default IO width */
-
-                if (pdata->flags & DM9000_PLATF_8BITONLY)
-                        dm9000_set_io(db, 1);
-
-                if (pdata->flags & DM9000_PLATF_16BITONLY)
-                        dm9000_set_io(db, 2);
-
-                if (pdata->flags & DM9000_PLATF_32BITONLY)
-                        dm9000_set_io(db, 4);
-
-                /* check to see if there are any IO routine
-                 * over-rides */
-
-                if (pdata->inblk != NULL)
-                        db->inblk = pdata->inblk;
-
-                if (pdata->outblk != NULL)
-                        db->outblk = pdata->outblk;
-
-                if (pdata->dumpblk != NULL)
-                        db->dumpblk = pdata->dumpblk;
-
-                db->flags = pdata->flags;
-        }
-
-        dm9000_reset(db);
-
-        /* try two times, DM9000 sometimes gets the first read wrong */
-        for (i = 0; i < 8; i++) {
-                id_val  = ior(db, DM9000_VIDL);
-                id_val |= (u32)ior(db, DM9000_VIDH) << 8;
-                id_val |= (u32)ior(db, DM9000_PIDL) << 16;
-                id_val |= (u32)ior(db, DM9000_PIDH) << 24;
-
-                if (id_val == DM9000_ID)
-                        break;
-                dev_err(db->dev, "read wrong id 0x%08x\n", id_val);
-        }
-
-        if (id_val != DM9000_ID) {
-                dev_err(db->dev, "wrong id: 0x%08x\n", id_val);
-                ret = -ENODEV;
-                goto out;
-        }
-
-        /* from this point we assume that we have found a DM9000 */
-
-        /* driver system function */
-        ether_setup(ndev);
-
-        ndev->open               = &dm9000_open;
-        ndev->hard_start_xmit    = &dm9000_start_xmit;
-        ndev->tx_timeout         = &dm9000_timeout;
-        ndev->watchdog_timeo = msecs_to_jiffies(watchdog);
-        ndev->stop               = &dm9000_stop;
-        ndev->set_multicast_list = &dm9000_hash_table;
-        ndev->ethtool_ops        = &dm9000_ethtool_ops;
-        ndev->do_ioctl           = &dm9000_ioctl;
-
-#ifdef CONFIG_NET_POLL_CONTROLLER
-        ndev->poll_controller    = &dm9000_poll_controller;
-#endif
-
-        db->msg_enable       = NETIF_MSG_LINK;
-        db->mii.phy_id_mask  = 0x1f;
-        db->mii.reg_num_mask = 0x1f;
-        db->mii.force_media  = 0;
-        db->mii.full_duplex  = 0;
-        db->mii.dev          = ndev;
-        db->mii.mdio_read    = dm9000_phy_read;
-        db->mii.mdio_write   = dm9000_phy_write;
-
-        mac_src = "eeprom";
-
-        /* try reading the node address from the attached EEPROM */
-        for (i = 0; i < 6; i += 2)
-                dm9000_read_eeprom(db, i / 2, ndev->dev_addr+i);
-
-        if (!is_valid_ether_addr(ndev->dev_addr)) {
-                /* try reading from mac */
-
-                mac_src = "chip";
-                for (i = 0; i < 6; i++)
-                        ndev->dev_addr[i] = ior(db, i+DM9000_PAR);
-        }
-
-        if (!is_valid_ether_addr(ndev->dev_addr))
-                dev_warn(db->dev, "%s: Invalid ethernet MAC address. Please "
-                         "set using ifconfig\n", ndev->name);
-
-        platform_set_drvdata(pdev, ndev);
-        ret = register_netdev(ndev);
-
-        if (ret == 0) {
-                DECLARE_MAC_BUF(mac);
-                printk("%s: dm9000 at %p,%p IRQ %d MAC: %s (%s)\n",
-                       ndev->name,  db->io_addr, db->io_data, ndev->irq,
-                       print_mac(mac, ndev->dev_addr), mac_src);
-        }
-        return 0;
-
-out:
-        dev_err(db->dev, "not found (%d).\n", ret);
-
-        dm9000_release_board(pdev, db);
-        free_netdev(ndev);
-
-        return ret;
+        return '?';
 }
 
 /*
- *  Open the interface.
- *  The interface is opened whenever "ifconfig" actives it.
+ *  Set DM9000 multicast address
  */
-static int
-dm9000_open(struct net_device *dev)
+static void
+dm9000_hash_table(struct net_device *dev)
 {
         board_info_t *db = (board_info_t *) dev->priv;
-        unsigned long irqflags = db->irq_res->flags & IRQF_TRIGGER_MASK;
+        struct dev_mc_list *mcptr = dev->mc_list;
+        int mc_cnt = dev->mc_count;
+        int i, oft;
+        u32 hash_val;
+        u16 hash_table[4];
+        u8 rcr = RCR_DIS_LONG | RCR_DIS_CRC | RCR_RXEN;
+        unsigned long flags;
 
-        if (netif_msg_ifup(db))
-                dev_dbg(db->dev, "enabling %s\n", dev->name);
+        dm9000_dbg(db, 1, "entering %s\n", __func__);
 
-        /* If there is no IRQ type specified, default to something that
-         * may work, and tell the user that this is a problem */
+        spin_lock_irqsave(&db->lock, flags);
 
-        if (irqflags == IRQF_TRIGGER_NONE) {
-                dev_warn(db->dev, "WARNING: no IRQ resource flags set.\n");
-                irqflags = DEFAULT_TRIGGER;
-        }
+        for (i = 0, oft = DM9000_PAR; i < 6; i++, oft++)
+                iow(db, oft, dev->dev_addr[i]);
 
-        irqflags |= IRQF_SHARED;
+        /* Clear Hash Table */
+        for (i = 0; i < 4; i++)
+                hash_table[i] = 0x0;
 
-        if (request_irq(dev->irq, &dm9000_interrupt, irqflags, dev->name, dev))
-                return -EAGAIN;
+        /* broadcast address */
+        hash_table[3] = 0x8000;
 
-        /* Initialize DM9000 board */
-        dm9000_reset(db);
-        dm9000_init_dm9000(dev);
+        if (dev->flags & IFF_PROMISC)
+                rcr |= RCR_PRMSC;
 
-        /* Init driver variable */
-        db->dbug_cnt = 0;
+        if (dev->flags & IFF_ALLMULTI)
+                rcr |= RCR_ALL;
 
-        mii_check_media(&db->mii, netif_msg_link(db), 1);
-        netif_start_queue(dev);
-        
-        dm9000_schedule_poll(db);
+        /* the multicast address in Hash Table : 64 bits */
+        for (i = 0; i < mc_cnt; i++, mcptr = mcptr->next) {
+                hash_val = ether_crc_le(6, mcptr->dmi_addr) & 0x3f;
+                hash_table[hash_val / 16] |= (u16) 1 << (hash_val % 16);
+        }
 
-        return 0;
+        /* Write the hash table to MAC MD table */
+        for (i = 0, oft = DM9000_MAR; i < 4; i++) {
+                iow(db, oft++, hash_table[i]);
+                iow(db, oft++, hash_table[i] >> 8);
+        }
+
+        iow(db, DM9000_RCR, rcr);
+        spin_unlock_irqrestore(&db->lock, flags);
 }
 
 /*
@@ -795,7 +686,8 @@ dm9000_open(struct net_device *dev)
 static void
 dm9000_init_dm9000(struct net_device *dev)
 {
-        board_info_t *db = (board_info_t *) dev->priv;
+        board_info_t *db = dev->priv;
+        unsigned int imr;
 
         dm9000_dbg(db, 1, "entering %s\n", __func__);
 
@@ -822,8 +714,14 @@ dm9000_init_dm9000(struct net_device *dev)
         /* Set address filter table */
         dm9000_hash_table(dev);
 
+        imr = IMR_PAR | IMR_PTM | IMR_PRM;
+        if (db->type != TYPE_DM9000E)
+                imr |= IMR_LNKCHNG;
+
+        db->imr_all = imr;
+
         /* Enable TX/RX interrupt mask */
-        iow(db, DM9000_IMR, IMR_PAR | IMR_PTM | IMR_PRM);
+        iow(db, DM9000_IMR, imr);
 
         /* Init Driver variable */
         db->tx_pkt_cnt = 0;
@@ -831,6 +729,29 @@ dm9000_init_dm9000(struct net_device *dev)
         dev->trans_start = 0;
 }
 
+/* Our watchdog timed out. Called by the networking layer */
+static void dm9000_timeout(struct net_device *dev)
+{
+        board_info_t *db = (board_info_t *) dev->priv;
+        u8 reg_save;
+        unsigned long flags;
+
+        /* Save previous register address */
+        reg_save = readb(db->io_addr);
+        spin_lock_irqsave(&db->lock, flags);
+
+        netif_stop_queue(dev);
+        dm9000_reset(db);
+        dm9000_init_dm9000(dev);
+        /* We can accept TX packets again */
+        dev->trans_start = jiffies;
+        netif_wake_queue(dev);
+
+        /* Restore previous register address */
+        writeb(reg_save, db->io_addr);
+        spin_unlock_irqrestore(&db->lock, flags);
+}
+
 /*
  *  Hardware start transmission.
  *  Send a packet to media from the upper layer.
@@ -839,7 +760,7 @@ static int
 dm9000_start_xmit(struct sk_buff *skb, struct net_device *dev)
 {
         unsigned long flags;
-        board_info_t *db = (board_info_t *) dev->priv;
+        board_info_t *db = dev->priv;
 
         dm9000_dbg(db, 3, "%s:\n", __func__);
 
@@ -879,50 +800,12 @@ dm9000_start_xmit(struct sk_buff *skb, struct net_device *dev)
         return 0;
 }
 
-static void
-dm9000_shutdown(struct net_device *dev)
-{
-        board_info_t *db = (board_info_t *) dev->priv;
-
-        /* RESET device */
-        dm9000_phy_write(dev, 0, MII_BMCR, BMCR_RESET); /* PHY RESET */
-        iow(db, DM9000_GPR, 0x01);      /* Power-Down PHY */
-        iow(db, DM9000_IMR, IMR_PAR);   /* Disable all interrupt */
-        iow(db, DM9000_RCR, 0x00);      /* Disable RX */
-}
-
-/*
- * Stop the interface.
- * The interface is stopped when it is brought.
- */
-static int
-dm9000_stop(struct net_device *ndev)
-{
-        board_info_t *db = (board_info_t *) ndev->priv;
-
-        if (netif_msg_ifdown(db))
-                dev_dbg(db->dev, "shutting down %s\n", ndev->name);
-
-        cancel_delayed_work_sync(&db->phy_poll);
-
-        netif_stop_queue(ndev);
-        netif_carrier_off(ndev);
-
-        /* free interrupt */
-        free_irq(ndev->irq, ndev);
-
-        dm9000_shutdown(ndev);
-
-        return 0;
-}
-
 /*
  * DM9000 interrupt handler
  * receive the packet to upper layer, free the transmitted packet
  */
 
-static void
-dm9000_tx_done(struct net_device *dev, board_info_t * db)
+static void dm9000_tx_done(struct net_device *dev, board_info_t *db)
 {
         int tx_status = ior(db, DM9000_NSR);    /* Got TX status */
 
@@ -945,52 +828,6 @@ dm9000_tx_done(struct net_device *dev, board_info_t * db)
         }
 }
 
-static irqreturn_t
-dm9000_interrupt(int irq, void *dev_id)
-{
-        struct net_device *dev = dev_id;
-        board_info_t *db = (board_info_t *) dev->priv;
-        int int_status;
-        u8 reg_save;
-
-        dm9000_dbg(db, 3, "entering %s\n", __func__);
-
-        /* A real interrupt coming */
-
-        spin_lock(&db->lock);
-
-        /* Save previous register address */
-        reg_save = readb(db->io_addr);
-
-        /* Disable all interrupts */
-        iow(db, DM9000_IMR, IMR_PAR);
-
-        /* Got DM9000 interrupt status */
-        int_status = ior(db, DM9000_ISR);       /* Got ISR */
-        iow(db, DM9000_ISR, int_status);        /* Clear ISR status */
-
-        if (netif_msg_intr(db))
-                dev_dbg(db->dev, "interrupt status %02x\n", int_status);
-
-        /* Received the coming packet */
-        if (int_status & ISR_PRS)
-                dm9000_rx(dev);
-
-        /* Trnasmit Interrupt check */
-        if (int_status & ISR_PTS)
-                dm9000_tx_done(dev, db);
-
-        /* Re-enable interrupt mask */
-        iow(db, DM9000_IMR, IMR_PAR | IMR_PTM | IMR_PRM);
-
-        /* Restore previous register address */
-        writeb(reg_save, db->io_addr);
-
-        spin_unlock(&db->lock);
-
-        return IRQ_HANDLED;
-}
-
 struct dm9000_rxhdr {
         u8      RxPktReady;
         u8      RxStatus;
@@ -1094,173 +931,109 @@ dm9000_rx(struct net_device *dev)
         } while (rxbyte == DM9000_PKT_RDY);
 }
 
-static unsigned int
-dm9000_read_locked(board_info_t *db, int reg)
+static irqreturn_t dm9000_interrupt(int irq, void *dev_id)
 {
-        unsigned long flags;
-        unsigned int ret;
+        struct net_device *dev = dev_id;
+        board_info_t *db = dev->priv;
+        int int_status;
+        u8 reg_save;
 
-        spin_lock_irqsave(&db->lock, flags);
-        ret = ior(db, reg);
-        spin_unlock_irqrestore(&db->lock, flags);
+        dm9000_dbg(db, 3, "entering %s\n", __func__);
 
-        return ret;
-}
+        /* A real interrupt coming */
 
-static int dm9000_wait_eeprom(board_info_t *db)
-{
-        unsigned int status;
-        int timeout = 8;        /* wait max 8msec */
+        spin_lock(&db->lock);
 
-        /* The DM9000 data sheets say we should be able to
-         * poll the ERRE bit in EPCR to wait for the EEPROM
-         * operation. From testing several chips, this bit
-         * does not seem to work.
-         *
-         * We attempt to use the bit, but fall back to the
-         * timeout (which is why we do not return an error
-         * on expiry) to say that the EEPROM operation has
-         * completed.
-         */
+        /* Save previous register address */
+        reg_save = readb(db->io_addr);
 
-        while (1) {
-                status = dm9000_read_locked(db, DM9000_EPCR);
+        /* Disable all interrupts */
+        iow(db, DM9000_IMR, IMR_PAR);
 
-                if ((status & EPCR_ERRE) == 0)
-                        break;
+        /* Got DM9000 interrupt status */
+        int_status = ior(db, DM9000_ISR);       /* Got ISR */
+        iow(db, DM9000_ISR, int_status);        /* Clear ISR status */
 
-                if (timeout-- < 0) {
-                        dev_dbg(db->dev, "timeout waiting EEPROM\n");
-                        break;
-                }
-        }
+        if (netif_msg_intr(db))
+                dev_dbg(db->dev, "interrupt status %02x\n", int_status);
 
-        return 0;
-}
+        /* Received the coming packet */
+        if (int_status & ISR_PRS)
+                dm9000_rx(dev);
 
-/*
- *  Read a word data from EEPROM
- */
-static void
-dm9000_read_eeprom(board_info_t *db, int offset, u8 *to)
-{
-        unsigned long flags;
+        /* Trnasmit Interrupt check */
+        if (int_status & ISR_PTS)
+                dm9000_tx_done(dev, db);
 
-        if (db->flags & DM9000_PLATF_NO_EEPROM) {
-                to[0] = 0xff;
-                to[1] = 0xff;
-                return;
+        if (db->type != TYPE_DM9000E) {
+                if (int_status & ISR_LNKCHNG) {
+                        /* fire a link-change request */
+                        schedule_delayed_work(&db->phy_poll, 1);
+                }
         }
 
-        mutex_lock(&db->addr_lock);
-
-        spin_lock_irqsave(&db->lock, flags);
-
-        iow(db, DM9000_EPAR, offset);
-        iow(db, DM9000_EPCR, EPCR_ERPRR);
-
-        spin_unlock_irqrestore(&db->lock, flags);
-
-        dm9000_wait_eeprom(db);
-
-        /* delay for at-least 150uS */
-        msleep(1);
-
-        spin_lock_irqsave(&db->lock, flags);
-
-        iow(db, DM9000_EPCR, 0x0);
+        /* Re-enable interrupt mask */
+        iow(db, DM9000_IMR, db->imr_all);
 
-        to[0] = ior(db, DM9000_EPDRL);
-        to[1] = ior(db, DM9000_EPDRH);
+        /* Restore previous register address */
+        writeb(reg_save, db->io_addr);
 
-        spin_unlock_irqrestore(&db->lock, flags);
+        spin_unlock(&db->lock);
 
-        mutex_unlock(&db->addr_lock);
+        return IRQ_HANDLED;
 }
 
+#ifdef CONFIG_NET_POLL_CONTROLLER
 /*
- * Write a word data to SROM
+ *Used by netconsole
  */
-static void
-dm9000_write_eeprom(board_info_t *db, int offset, u8 *data)
+static void dm9000_poll_controller(struct net_device *dev)
 {
-        unsigned long flags;
-
-        if (db->flags & DM9000_PLATF_NO_EEPROM)
-                return;
-
-        mutex_lock(&db->addr_lock);
-
-        spin_lock_irqsave(&db->lock, flags);
-        iow(db, DM9000_EPAR, offset);
-        iow(db, DM9000_EPDRH, data[1]);
-        iow(db, DM9000_EPDRL, data[0]);
-        iow(db, DM9000_EPCR, EPCR_WEP | EPCR_ERPRW);
-        spin_unlock_irqrestore(&db->lock, flags);
-
-        dm9000_wait_eeprom(db);
-
-        mdelay(1);      /* wait at least 150uS to clear */
-
-        spin_lock_irqsave(&db->lock, flags);
-        iow(db, DM9000_EPCR, 0);
-        spin_unlock_irqrestore(&db->lock, flags);
-
-        mutex_unlock(&db->addr_lock);
+        disable_irq(dev->irq);
+        dm9000_interrupt(dev->irq, dev);
+        enable_irq(dev->irq);
 }
+#endif
 
 /*
- *  Set DM9000 multicast address
+ *  Open the interface.
+ *  The interface is opened whenever "ifconfig" actives it.
  */
-static void
-dm9000_hash_table(struct net_device *dev)
+static int
+dm9000_open(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;
-        int i, oft;
-        u32 hash_val;
-        u16 hash_table[4];
-        u8 rcr = RCR_DIS_LONG | RCR_DIS_CRC | RCR_RXEN;
-        unsigned long flags;
-
-        dm9000_dbg(db, 1, "entering %s\n", __func__);
+        board_info_t *db = dev->priv;
+        unsigned long irqflags = db->irq_res->flags & IRQF_TRIGGER_MASK;
 
-        spin_lock_irqsave(&db->lock, flags);
+        if (netif_msg_ifup(db))
+                dev_dbg(db->dev, "enabling %s\n", dev->name);
 
-        for (i = 0, oft = DM9000_PAR; i < 6; i++, oft++)
-                iow(db, oft, dev->dev_addr[i]);
+        /* If there is no IRQ type specified, default to something that
+         * may work, and tell the user that this is a problem */
 
-        /* Clear Hash Table */
-        for (i = 0; i < 4; i++)
-                hash_table[i] = 0x0;
+        if (irqflags == IRQF_TRIGGER_NONE)
+                dev_warn(db->dev, "WARNING: no IRQ resource flags set.\n");
 
-        /* broadcast address */
-        hash_table[3] = 0x8000;
+        irqflags |= IRQF_SHARED;
 
-        if (dev->flags & IFF_PROMISC)
-                rcr |= RCR_PRMSC;
+        if (request_irq(dev->irq, &dm9000_interrupt, irqflags, dev->name, dev))
+                return -EAGAIN;
 
-        if (dev->flags & IFF_ALLMULTI)
-                rcr |= RCR_ALL;
+        /* Initialize DM9000 board */
+        dm9000_reset(db);
+        dm9000_init_dm9000(dev);
 
-        /* the multicast address in Hash Table : 64 bits */
-        for (i = 0; i < mc_cnt; i++, mcptr = mcptr->next) {
-                hash_val = ether_crc_le(6, mcptr->dmi_addr) & 0x3f;
-                hash_table[hash_val / 16] |= (u16) 1 << (hash_val % 16);
-        }
+        /* Init driver variable */
+        db->dbug_cnt = 0;
 
-        /* Write the hash table to MAC MD table */
-        for (i = 0, oft = DM9000_MAR; i < 4; i++) {
-                iow(db, oft++, hash_table[i]);
-                iow(db, oft++, hash_table[i] >> 8);
-        }
+        mii_check_media(&db->mii, netif_msg_link(db), 1);
+        netif_start_queue(dev);
+        
+        dm9000_schedule_poll(db);
 
-        iow(db, DM9000_RCR, rcr);
-        spin_unlock_irqrestore(&db->lock, flags);
+        return 0;
 }
 
-
 /*
  * Sleep, either by using msleep() or if we are suspending, then
  * use mdelay() to sleep.
@@ -1323,7 +1096,8 @@ dm9000_phy_read(struct net_device *dev, int phy_reg_unused, int reg)
  *   Write a word to phyxcer
  */
 static void
-dm9000_phy_write(struct net_device *dev, int phyaddr_unused, int reg, int value)
+dm9000_phy_write(struct net_device *dev,
+                 int phyaddr_unused, int reg, int value)
 {
         board_info_t *db = (board_info_t *) dev->priv;
         unsigned long flags;
@@ -1363,6 +1137,273 @@ dm9000_phy_write(struct net_device *dev, int phyaddr_unused, int reg, int value)
         mutex_unlock(&db->addr_lock);
 }
 
+static void
+dm9000_shutdown(struct net_device *dev)
+{
+        board_info_t *db = dev->priv;
+
+        /* RESET device */
+        dm9000_phy_write(dev, 0, MII_BMCR, BMCR_RESET); /* PHY RESET */
+        iow(db, DM9000_GPR, 0x01);      /* Power-Down PHY */
+        iow(db, DM9000_IMR, IMR_PAR);   /* Disable all interrupt */
+        iow(db, DM9000_RCR, 0x00);      /* Disable RX */
+}
+
+/*
+ * Stop the interface.
+ * The interface is stopped when it is brought.
+ */
+static int
+dm9000_stop(struct net_device *ndev)
+{
+        board_info_t *db = ndev->priv;
+
+        if (netif_msg_ifdown(db))
+                dev_dbg(db->dev, "shutting down %s\n", ndev->name);
+
+        cancel_delayed_work_sync(&db->phy_poll);
+
+        netif_stop_queue(ndev);
+        netif_carrier_off(ndev);
+
+        /* free interrupt */
+        free_irq(ndev->irq, ndev);
+
+        dm9000_shutdown(ndev);
+
+        return 0;
+}
+
+#define res_size(_r) (((_r)->end - (_r)->start) + 1)
+
+/*
+ * Search DM9000 board, allocate space and register it
+ */
+static int __devinit
+dm9000_probe(struct platform_device *pdev)
+{
+        struct dm9000_plat_data *pdata = pdev->dev.platform_data;
+        struct board_info *db;  /* Point a board information structure */
+        struct net_device *ndev;
+        const unsigned char *mac_src;
+        int ret = 0;
+        int iosize;
+        int i;
+        u32 id_val;
+
+        /* Init network device */
+        ndev = alloc_etherdev(sizeof(struct board_info));
+        if (!ndev) {
+                dev_err(&pdev->dev, "could not allocate device.\n");
+                return -ENOMEM;
+        }
+
+        SET_NETDEV_DEV(ndev, &pdev->dev);
+
+        dev_dbg(&pdev->dev, "dm9000_probe()\n");
+
+        /* setup board info structure */
+        db = ndev->priv;
+        memset(db, 0, sizeof(*db));
+
+        db->dev = &pdev->dev;
+        db->ndev = ndev;
+
+        spin_lock_init(&db->lock);
+        mutex_init(&db->addr_lock);
+
+        INIT_DELAYED_WORK(&db->phy_poll, dm9000_poll_work);
+
+        db->addr_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+        db->data_res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
+        db->irq_res  = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
+
+        if (db->addr_res == NULL || db->data_res == NULL ||
+            db->irq_res == NULL) {
+                dev_err(db->dev, "insufficient resources\n");
+                ret = -ENOENT;
+                goto out;
+        }
+
+        iosize = res_size(db->addr_res);
+        db->addr_req = request_mem_region(db->addr_res->start, iosize,
+                                          pdev->name);
+
+        if (db->addr_req == NULL) {
+                dev_err(db->dev, "cannot claim address reg area\n");
+                ret = -EIO;
+                goto out;
+        }
+
+        db->io_addr = ioremap(db->addr_res->start, iosize);
+
+        if (db->io_addr == NULL) {
+                dev_err(db->dev, "failed to ioremap address reg\n");
+                ret = -EINVAL;
+                goto out;
+        }
+
+        iosize = res_size(db->data_res);
+        db->data_req = request_mem_region(db->data_res->start, iosize,
+                                          pdev->name);
+
+        if (db->data_req == NULL) {
+                dev_err(db->dev, "cannot claim data reg area\n");
+                ret = -EIO;
+                goto out;
+        }
+
+        db->io_data = ioremap(db->data_res->start, iosize);
+
+        if (db->io_data == NULL) {
+                dev_err(db->dev, "failed to ioremap data reg\n");
+                ret = -EINVAL;
+                goto out;
+        }
+
+        /* fill in parameters for net-dev structure */
+        ndev->base_addr = (unsigned long)db->io_addr;
+        ndev->irq       = db->irq_res->start;
+
+        /* ensure at least we have a default set of IO routines */
+        dm9000_set_io(db, iosize);
+
+        /* check to see if anything is being over-ridden */
+        if (pdata != NULL) {
+                /* check to see if the driver wants to over-ride the
+                 * default IO width */
+
+                if (pdata->flags & DM9000_PLATF_8BITONLY)
+                        dm9000_set_io(db, 1);
+
+                if (pdata->flags & DM9000_PLATF_16BITONLY)
+                        dm9000_set_io(db, 2);
+
+                if (pdata->flags & DM9000_PLATF_32BITONLY)
+                        dm9000_set_io(db, 4);
+
+                /* check to see if there are any IO routine
+                 * over-rides */
+
+                if (pdata->inblk != NULL)
+                        db->inblk = pdata->inblk;
+
+                if (pdata->outblk != NULL)
+                        db->outblk = pdata->outblk;
+
+                if (pdata->dumpblk != NULL)
+                        db->dumpblk = pdata->dumpblk;
+
+                db->flags = pdata->flags;
+        }
+
+#ifdef CONFIG_DM9000_FORCE_SIMPLE_PHY_POLL
+        db->flags |= DM9000_PLATF_SIMPLE_PHY;
+#endif
+
+        dm9000_reset(db);
+
+        /* try multiple times, DM9000 sometimes gets the read wrong */
+        for (i = 0; i < 8; i++) {
+                id_val  = ior(db, DM9000_VIDL);
+                id_val |= (u32)ior(db, DM9000_VIDH) << 8;
+                id_val |= (u32)ior(db, DM9000_PIDL) << 16;
+                id_val |= (u32)ior(db, DM9000_PIDH) << 24;
+
+                if (id_val == DM9000_ID)
+                        break;
+                dev_err(db->dev, "read wrong id 0x%08x\n", id_val);
+        }
+
+        if (id_val != DM9000_ID) {
+                dev_err(db->dev, "wrong id: 0x%08x\n", id_val);
+                ret = -ENODEV;
+                goto out;
+        }
+
+        /* Identify what type of DM9000 we are working on */
+
+        id_val = ior(db, DM9000_CHIPR);
+        dev_dbg(db->dev, "dm9000 revision 0x%02x\n", id_val);
+
+        switch (id_val) {
+        case CHIPR_DM9000A:
+                db->type = TYPE_DM9000A;
+                break;
+        case CHIPR_DM9000B:
+                db->type = TYPE_DM9000B;
+                break;
+        default:
+                dev_dbg(db->dev, "ID %02x => defaulting to DM9000E\n", id_val);
+                db->type = TYPE_DM9000E;
+        }
+
+        /* from this point we assume that we have found a DM9000 */
+
+        /* driver system function */
+        ether_setup(ndev);
+
+        ndev->open               = &dm9000_open;
+        ndev->hard_start_xmit    = &dm9000_start_xmit;
+        ndev->tx_timeout         = &dm9000_timeout;
+        ndev->watchdog_timeo = msecs_to_jiffies(watchdog);
+        ndev->stop               = &dm9000_stop;
+        ndev->set_multicast_list = &dm9000_hash_table;
+        ndev->ethtool_ops        = &dm9000_ethtool_ops;
+        ndev->do_ioctl           = &dm9000_ioctl;
+
+#ifdef CONFIG_NET_POLL_CONTROLLER
+        ndev->poll_controller    = &dm9000_poll_controller;
+#endif
+
+        db->msg_enable       = NETIF_MSG_LINK;
+        db->mii.phy_id_mask  = 0x1f;
+        db->mii.reg_num_mask = 0x1f;
+        db->mii.force_media  = 0;
+        db->mii.full_duplex  = 0;
+        db->mii.dev          = ndev;
+        db->mii.mdio_read    = dm9000_phy_read;
+        db->mii.mdio_write   = dm9000_phy_write;
+
+        mac_src = "eeprom";
+
+        /* try reading the node address from the attached EEPROM */
+        for (i = 0; i < 6; i += 2)
+                dm9000_read_eeprom(db, i / 2, ndev->dev_addr+i);
+
+        if (!is_valid_ether_addr(ndev->dev_addr)) {
+                /* try reading from mac */
+                
+                mac_src = "chip";
+                for (i = 0; i < 6; i++)
+                        ndev->dev_addr[i] = ior(db, i+DM9000_PAR);
+        }
+
+        if (!is_valid_ether_addr(ndev->dev_addr))
+                dev_warn(db->dev, "%s: Invalid ethernet MAC address. Please "
+                         "set using ifconfig\n", ndev->name);
+
+        platform_set_drvdata(pdev, ndev);
+        ret = register_netdev(ndev);
+
+        if (ret == 0) {
+                DECLARE_MAC_BUF(mac);
+                printk(KERN_INFO "%s: dm9000%c at %p,%p IRQ %d MAC: %s (%s)\n",
+                       ndev->name, dm9000_type_to_char(db->type),
+                       db->io_addr, db->io_data, ndev->irq,
+                       print_mac(mac, ndev->dev_addr), mac_src);
+        }
+        return 0;
+
+out:
+        dev_err(db->dev, "not found (%d).\n", ret);
+
+        dm9000_release_board(pdev, db);
+        free_netdev(ndev);
+
+        return ret;
+}
+
 static int
 dm9000_drv_suspend(struct platform_device *dev, pm_message_t state)
 {
@@ -1432,7 +1473,7 @@ dm9000_init(void)
 {
         printk(KERN_INFO "%s Ethernet Driver, V%s\n", CARDNAME, DRV_VERSION);
 
-        return platform_driver_register(&dm9000_driver);        /* search board and register */
+        return platform_driver_register(&dm9000_driver);
 }
 
 static void __exit