Merge git://git.kernel.org/pub/scm/linux/kernel/git/mchehab/v4l-dvb
[pandora-kernel.git] / drivers / net / dm9000.c
index b6d4b8e..952e10d 100644 (file)
@@ -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,281 +611,85 @@ 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)
+static unsigned char dm9000_type_to_char(enum dm9000_type type)
+{
+       switch (type) {
+       case TYPE_DM9000E: return 'e';
+       case TYPE_DM9000A: return 'a';
+       case TYPE_DM9000B: return 'b';
+       }
+
+       return '?';
+}
 
 /*
- * Search DM9000 board, allocate space and register it
+ *  Set DM9000 multicast address
  */
-static int __devinit
-dm9000_probe(struct platform_device *pdev)
+static void
+dm9000_hash_table(struct net_device *dev)
 {
-       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;
-       }
+       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;
 
-       SET_NETDEV_DEV(ndev, &pdev->dev);
+       dm9000_dbg(db, 1, "entering %s\n", __func__);
 
-       dev_dbg(&pdev->dev, "dm9000_probe()\n");
+       spin_lock_irqsave(&db->lock, flags);
 
-       /* setup board info structure */
-       db = (struct board_info *) ndev->priv;
-       memset(db, 0, sizeof (*db));
+       for (i = 0, oft = DM9000_PAR; i < 6; i++, oft++)
+               iow(db, oft, dev->dev_addr[i]);
 
-       db->dev = &pdev->dev;
-       db->ndev = ndev;
+       /* Clear Hash Table */
+       for (i = 0; i < 4; i++)
+               hash_table[i] = 0x0;
 
-       spin_lock_init(&db->lock);
-       mutex_init(&db->addr_lock);
+       /* broadcast address */
+       hash_table[3] = 0x8000;
 
-       INIT_DELAYED_WORK(&db->phy_poll, dm9000_poll_work);
+       if (dev->flags & IFF_PROMISC)
+               rcr |= RCR_PRMSC;
 
+       if (dev->flags & IFF_ALLMULTI)
+               rcr |= RCR_ALL;
 
-       if (pdev->num_resources < 3) {
-               ret = -ENODEV;
-               goto out;
+       /* 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);
        }
 
-       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;
+       /* 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);
        }
 
-       iosize = res_size(db->addr_res);
-       db->addr_req = request_mem_region(db->addr_res->start, iosize,
-                                         pdev->name);
+       iow(db, DM9000_RCR, rcr);
+       spin_unlock_irqrestore(&db->lock, flags);
+}
 
-       if (db->addr_req == NULL) {
-               dev_err(db->dev, "cannot claim address reg area\n");
-               ret = -EIO;
-               goto out;
-       }
+/*
+ * Initilize dm9000 board
+ */
+static void
+dm9000_init_dm9000(struct net_device *dev)
+{
+       board_info_t *db = dev->priv;
+       unsigned int imr;
 
-       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;
-       }
-
-       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;
-}
-
-/*
- *  Open the interface.
- *  The interface is opened whenever "ifconfig" actives it.
- */
-static int
-dm9000_open(struct net_device *dev)
-{
-       board_info_t *db = (board_info_t *) dev->priv;
-       unsigned long irqflags = db->irq_res->flags & IRQF_TRIGGER_MASK;
-
-       if (netif_msg_ifup(db))
-               dev_dbg(db->dev, "enabling %s\n", dev->name);
-
-       /* If there is no IRQ type specified, default to something that
-        * may work, and tell the user that this is a problem */
-
-       if (irqflags == IRQF_TRIGGER_NONE) {
-               dev_warn(db->dev, "WARNING: no IRQ resource flags set.\n");
-               irqflags = DEFAULT_TRIGGER;
-       }
-
-       irqflags |= IRQF_SHARED;
-
-       if (request_irq(dev->irq, &dm9000_interrupt, irqflags, dev->name, dev))
-               return -EAGAIN;
-
-       /* Initialize DM9000 board */
-       dm9000_reset(db);
-       dm9000_init_dm9000(dev);
-
-       /* Init driver variable */
-       db->dbug_cnt = 0;
-
-       mii_check_media(&db->mii, netif_msg_link(db), 1);
-       netif_start_queue(dev);
-       
-       dm9000_schedule_poll(db);
-
-       return 0;
-}
-
-/*
- * Initilize dm9000 board
- */
-static void
-dm9000_init_dm9000(struct net_device *dev)
-{
-       board_info_t *db = (board_info_t *) dev->priv;
-
-       dm9000_dbg(db, 1, "entering %s\n", __func__);
+       dm9000_dbg(db, 1, "entering %s\n", __func__);
 
        /* I/O mode */
        db->io_mode = ior(db, DM9000_ISR) >> 6; /* ISR bit7:6 keeps I/O mode */
@@ -804,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;
@@ -813,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.
@@ -821,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__);
 
@@ -861,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 */
 
@@ -927,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;
@@ -1076,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.
@@ -1305,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;
@@ -1345,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)
 {
@@ -1414,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