net: convert multiple drivers to use netdev_for_each_mc_addr, part5 V2
[safe/jmp/linux-2.6] / drivers / net / ni52.c
index 3b1c4af..05c29c2 100644 (file)
@@ -9,8 +9,6 @@
  *    [feel free to mail ....]
  *
  * when using as module: (no autoprobing!)
- *   compile with:
- *       gcc -O2 -fomit-frame-pointer -m486 -D__KERNEL__ -DMODULE -c ni52.c
  *   run with e.g:
  *       insmod ni52.o io=0x360 irq=9 memstart=0xd0000 memend=0xd4000
  *
@@ -134,7 +132,7 @@ static int fifo = 0x8;      /* don't change */
 #define ni_disint()   { outb(0, dev->base_addr + NI52_INTDIS); }
 #define ni_enaint()   { outb(0, dev->base_addr + NI52_INTENA); }
 
-#define make32(ptr16) (p->memtop + (short) (ptr16))
+#define make32(ptr16) ((void __iomem *)(p->memtop + (short) (ptr16)))
 #define make24(ptr32) ((char __iomem *)(ptr32)) - p->base
 #define make16(ptr32) ((unsigned short) ((char __iomem *)(ptr32)\
                                        - p->memtop))
@@ -172,7 +170,7 @@ static int     ni52_probe1(struct net_device *dev, int ioaddr);
 static irqreturn_t ni52_interrupt(int irq, void *dev_id);
 static int     ni52_open(struct net_device *dev);
 static int     ni52_close(struct net_device *dev);
-static int     ni52_send_packet(struct sk_buff *, struct net_device *);
+static netdev_tx_t ni52_send_packet(struct sk_buff *, struct net_device *);
 static struct  net_device_stats *ni52_get_stats(struct net_device *dev);
 static void    set_multicast_list(struct net_device *dev);
 static void    ni52_timeout(struct net_device *dev);
@@ -214,7 +212,7 @@ struct priv {
 /* wait for command with timeout: */
 static void wait_for_scb_cmd(struct net_device *dev)
 {
-       struct priv *p = dev->priv;
+       struct priv *p = netdev_priv(dev);
        int i;
        for (i = 0; i < 16384; i++) {
                if (readb(&p->scb->cmd_cuc) == 0)
@@ -233,7 +231,7 @@ static void wait_for_scb_cmd(struct net_device *dev)
 
 static void wait_for_scb_cmd_ruc(struct net_device *dev)
 {
-       struct priv *p = dev->priv;
+       struct priv *p = netdev_priv(dev);
        int i;
        for (i = 0; i < 16384; i++) {
                if (readb(&p->scb->cmd_ruc) == 0)
@@ -241,7 +239,8 @@ static void wait_for_scb_cmd_ruc(struct net_device *dev)
                udelay(4);
                if (i == 16383) {
                        printk(KERN_ERR "%s: scb_cmd (ruc) timed out: %04x,%04x .. disabling i82586!!\n",
-                               dev->name, p->scb->cmd_ruc, p->scb->rus);
+                               dev->name, readb(&p->scb->cmd_ruc),
+                               readb(&p->scb->rus));
                        if (!p->reset) {
                                p->reset = 1;
                                ni_reset586();
@@ -285,7 +284,7 @@ static int ni52_open(struct net_device *dev)
        startrecv586(dev);
        ni_enaint();
 
-       ret = request_irq(dev->irq, &ni52_interrupt, 0, dev->name, dev);
+       ret = request_irq(dev->irq, ni52_interrupt, 0, dev->name, dev);
        if (ret) {
                ni_reset586();
                return ret;
@@ -294,51 +293,58 @@ static int ni52_open(struct net_device *dev)
        return 0; /* most done by init */
 }
 
+static int check_iscp(struct net_device *dev, void __iomem *addr)
+{
+       struct iscp_struct __iomem *iscp = addr;
+       struct priv *p = netdev_priv(dev);
+       memset_io(iscp, 0, sizeof(struct iscp_struct));
+
+       writel(make24(iscp), &p->scp->iscp);
+       writeb(1, &iscp->busy);
+
+       ni_reset586();
+       ni_attn586();
+       mdelay(32);     /* wait a while... */
+       /* i82586 clears 'busy' after successful init */
+       if (readb(&iscp->busy))
+               return 0;
+       return 1;
+}
+
 /**********************************************
  * Check to see if there's an 82586 out there.
  */
 static int check586(struct net_device *dev, unsigned size)
 {
-       unsigned long where = dev->mem_start;
-       struct priv *p = dev->priv;
-       char __iomem *iscp_addrs[2];
+       struct priv *p = netdev_priv(dev);
        int i;
 
-       p->mapped = (char __iomem *)isa_bus_to_virt(where);
+       p->mapped = ioremap(dev->mem_start, size);
+       if (!p->mapped)
+               return 0;
+
        p->base = p->mapped + size - 0x01000000;
        p->memtop = p->mapped + size;
        p->scp = (struct scp_struct __iomem *)(p->base + SCP_DEFAULT_ADDRESS);
        p->scb  = (struct scb_struct __iomem *) p->mapped;
+       p->iscp = (struct iscp_struct __iomem *)p->scp - 1;
        memset_io(p->scp, 0, sizeof(struct scp_struct));
        for (i = 0; i < sizeof(struct scp_struct); i++)
                /* memory was writeable? */
                if (readb((char __iomem *)p->scp + i))
-                       return 0;
+                       goto Enodev;
        writeb(SYSBUSVAL, &p->scp->sysbus);     /* 1 = 8Bit-Bus, 0 = 16 Bit */
        if (readb(&p->scp->sysbus) != SYSBUSVAL)
-               return 0;
-
-       iscp_addrs[0] = p->mapped;
-       iscp_addrs[1] = (char __iomem *)p->scp - sizeof(struct iscp_struct);
-
-       for (i = 0; i < 2; i++) {
-               p->iscp = (struct iscp_struct __iomem *) iscp_addrs[i];
-               memset_io(p->iscp, 0, sizeof(struct iscp_struct));
-
-               writel(make24(p->iscp), &p->scp->iscp);
-               writeb(1, &p->iscp->busy);
+               goto Enodev;
 
-               ni_reset586();
-               ni_attn586();
-               mdelay(32);     /* wait a while... */
-               /* i82586 clears 'busy' after successful init */
-               if (readb(&p->iscp->busy))
-                       return 0;
-       }
-
-       p->iscp = (struct iscp_struct __iomem *)
-                       ((char __iomem *)p->scp - sizeof(struct iscp_struct));
+       if (!check_iscp(dev, p->mapped))
+               goto Enodev;
+       if (!check_iscp(dev, p->iscp))
+               goto Enodev;
        return 1;
+Enodev:
+       iounmap(p->mapped);
+       return 0;
 }
 
 /******************************************************************
@@ -346,7 +352,7 @@ static int check586(struct net_device *dev, unsigned size)
  */
 static void alloc586(struct net_device *dev)
 {
-       struct priv *p =        (struct priv *) dev->priv;
+       struct priv *p = netdev_priv(dev);
 
        ni_reset586();
        mdelay(32);
@@ -385,12 +391,15 @@ struct net_device * __init ni52_probe(int unit)
 {
        struct net_device *dev = alloc_etherdev(sizeof(struct priv));
        static int ports[] = {0x300, 0x280, 0x360 , 0x320 , 0x340, 0};
+       struct priv *p;
        int *port;
        int err = 0;
 
        if (!dev)
                return ERR_PTR(-ENOMEM);
 
+       p = netdev_priv(dev);
+
        if (unit >= 0) {
                sprintf(dev->name, "eth%d", unit);
                netdev_boot_setup_check(dev);
@@ -425,16 +434,29 @@ got_it:
                goto out1;
        return dev;
 out1:
+       iounmap(p->mapped);
        release_region(dev->base_addr, NI52_TOTAL_SIZE);
 out:
        free_netdev(dev);
        return ERR_PTR(err);
 }
 
+static const struct net_device_ops ni52_netdev_ops = {
+       .ndo_open               = ni52_open,
+       .ndo_stop               = ni52_close,
+       .ndo_get_stats          = ni52_get_stats,
+       .ndo_tx_timeout         = ni52_timeout,
+       .ndo_start_xmit         = ni52_send_packet,
+       .ndo_set_multicast_list = set_multicast_list,
+       .ndo_change_mtu         = eth_change_mtu,
+       .ndo_set_mac_address    = eth_mac_addr,
+       .ndo_validate_addr      = eth_validate_addr,
+};
+
 static int __init ni52_probe1(struct net_device *dev, int ioaddr)
 {
        int i, size, retval;
-       struct priv *priv = dev->priv;
+       struct priv *priv = netdev_priv(dev);
 
        dev->base_addr = ioaddr;
        dev->irq = irq;
@@ -455,8 +477,8 @@ static int __init ni52_probe1(struct net_device *dev, int ioaddr)
        for (i = 0; i < ETH_ALEN; i++)
                dev->dev_addr[i] = inb(dev->base_addr+i);
 
-       if (dev->dev_addr[0] != NI52_ADDR0 || dev->dev_addr[1] != NI52_ADDR1
-                || dev->dev_addr[2] != NI52_ADDR2) {
+       if (dev->dev_addr[0] != NI52_ADDR0 || dev->dev_addr[1] != NI52_ADDR1 ||
+           dev->dev_addr[2] != NI52_ADDR2) {
                retval = -ENODEV;
                goto out;
        }
@@ -541,6 +563,7 @@ static int __init ni52_probe1(struct net_device *dev, int ioaddr)
                if (!dev->irq) {
                        printk("?autoirq, Failed to detect IRQ line!\n");
                        retval = -EAGAIN;
+                       iounmap(priv->mapped);
                        goto out;
                }
                printk("IRQ %d (autodetected).\n", dev->irq);
@@ -550,15 +573,8 @@ static int __init ni52_probe1(struct net_device *dev, int ioaddr)
                printk("IRQ %d (assigned and not checked!).\n", dev->irq);
        }
 
-       dev->open               = ni52_open;
-       dev->stop               = ni52_close;
-       dev->get_stats          = ni52_get_stats;
-       dev->tx_timeout         = ni52_timeout;
+       dev->netdev_ops         = &ni52_netdev_ops;
        dev->watchdog_timeo     = HZ/20;
-       dev->hard_start_xmit    = ni52_send_packet;
-       dev->set_multicast_list = set_multicast_list;
-
-       dev->if_port            = 0;
 
        return 0;
 out:
@@ -575,13 +591,13 @@ static int init586(struct net_device *dev)
 {
        void __iomem *ptr;
        int i, result = 0;
-       struct priv *p = (struct priv *)dev->priv;
+       struct priv *p = netdev_priv(dev);
        struct configure_cmd_struct __iomem *cfg_cmd;
        struct iasetup_cmd_struct __iomem *ias_cmd;
        struct tdr_cmd_struct __iomem *tdr_cmd;
        struct mcsetup_cmd_struct __iomem *mc_cmd;
-       struct dev_mc_list *dmi = dev->mc_list;
-       int num_addrs = dev->mc_count;
+       struct dev_mc_list *dmi;
+       int num_addrs = netdev_mc_count(dev);
 
        ptr = p->scb + 1;
 
@@ -599,23 +615,23 @@ static int init586(struct net_device *dev)
        /* addr_len |!src_insert |pre-len |loopback */
        writeb(0x2e, &cfg_cmd->adr_len);
        writeb(0x00, &cfg_cmd->priority);
-       writeb(0x60, &cfg_cmd->ifs);;
+       writeb(0x60, &cfg_cmd->ifs);
        writeb(0x00, &cfg_cmd->time_low);
        writeb(0xf2, &cfg_cmd->time_high);
-       writeb(0x00, &cfg_cmd->promisc);;
+       writeb(0x00, &cfg_cmd->promisc);
        if (dev->flags & IFF_ALLMULTI) {
                int len = ((char __iomem *)p->iscp - (char __iomem *)ptr - 8) / 6;
                if (num_addrs > len) {
                        printk(KERN_ERR "%s: switching to promisc. mode\n",
                                dev->name);
-                       dev->flags |= IFF_PROMISC;
+                       writeb(0x01, &cfg_cmd->promisc);
                }
        }
        if (dev->flags & IFF_PROMISC)
                writeb(0x01, &cfg_cmd->promisc);
        writeb(0x00, &cfg_cmd->carr_coll);
        writew(make16(cfg_cmd), &p->scb->cbl_offset);
-       writew(0, &p->scb->cmd_ruc);
+       writeb(0, &p->scb->cmd_ruc);
 
        writeb(CUC_START, &p->scb->cmd_cuc); /* cmd.-unit start */
        ni_attn586();
@@ -708,9 +724,9 @@ static int init586(struct net_device *dev)
                writew(0xffff, &mc_cmd->cmd_link);
                writew(num_addrs * 6, &mc_cmd->mc_cnt);
 
-               for (i = 0; i < num_addrs; i++, dmi = dmi->next)
-                       memcpy_toio(mc_cmd->mc_list[i],
-                                                       dmi->dmi_addr, 6);
+               i = 0;
+               netdev_for_each_mc_addr(dmi, dev)
+                       memcpy_toio(mc_cmd->mc_list[i++], dmi->dmi_addr, 6);
 
                writew(make16(mc_cmd), &p->scb->cbl_offset);
                writeb(CUC_START, &p->scb->cmd_cuc);
@@ -816,7 +832,7 @@ static void __iomem *alloc_rfa(struct net_device *dev, void __iomem *ptr)
        struct rfd_struct __iomem *rfd = ptr;
        struct rbd_struct __iomem *rbd;
        int i;
-       struct priv *p = (struct priv *) dev->priv;
+       struct priv *p = netdev_priv(dev);
 
        memset_io(rfd, 0,
                sizeof(struct rfd_struct) * (p->num_recv_buffs + rfdadd));
@@ -865,7 +881,7 @@ static irqreturn_t ni52_interrupt(int irq, void *dev_id)
        int cnt = 0;
        struct priv *p;
 
-       p = (struct priv *) dev->priv;
+       p = netdev_priv(dev);
 
        if (debuglevel > 1)
                printk("I");
@@ -886,7 +902,7 @@ static irqreturn_t ni52_interrupt(int irq, void *dev_id)
                        if (readb(&p->scb->rus) & RU_SUSPEND) {
                                /* special case: RU_SUSPEND */
                                wait_for_scb_cmd(dev);
-                               p->scb->cmd_ruc = RUC_RESUME;
+                               writeb(RUC_RESUME, &p->scb->cmd_ruc);
                                ni_attn586();
                                wait_for_scb_cmd_ruc(dev);
                        } else {
@@ -913,7 +929,7 @@ static irqreturn_t ni52_interrupt(int irq, void *dev_id)
 
                /* Wait for ack. (ni52_xmt_int can be faster than ack!!) */
                wait_for_scb_cmd(dev);
-               if (p->scb->cmd_cuc) {   /* timed out? */
+               if (readb(&p->scb->cmd_cuc)) {   /* timed out? */
                        printk(KERN_ERR "%s: Acknowledge timed out.\n",
                                dev->name);
                        ni_disint();
@@ -937,13 +953,13 @@ static void ni52_rcv_int(struct net_device *dev)
        unsigned short totlen;
        struct sk_buff *skb;
        struct rbd_struct __iomem *rbd;
-       struct priv *p = (struct priv *)dev->priv;
+       struct priv *p = netdev_priv(dev);
 
        if (debuglevel > 0)
                printk("R");
 
        for (; (status = readb(&p->rfd_top->stat_high)) & RFD_COMPL;) {
-               rbd = (struct rbd_struct __iomem *) make32(p->rfd_top->rbd_offset);
+               rbd = make32(readw(&p->rfd_top->rbd_offset));
                if (status & RFD_OK) { /* frame received without error? */
                        totlen = readw(&rbd->status);
                        if (totlen & RBD_LAST) {
@@ -954,10 +970,9 @@ static void ni52_rcv_int(struct net_device *dev)
                                if (skb != NULL) {
                                        skb_reserve(skb, 2);
                                        skb_put(skb, totlen);
-                                       skb_copy_to_linear_data(skb, p->base + (unsigned long) rbd->buffer, totlen);
+                                       memcpy_fromio(skb->data, p->base + readl(&rbd->buffer), totlen);
                                        skb->protocol = eth_type_trans(skb, dev);
                                        netif_rx(skb);
-                                       dev->last_rx = jiffies;
                                        p->stats.rx_packets++;
                                        p->stats.rx_bytes += totlen;
                                } else
@@ -973,7 +988,7 @@ static void ni52_rcv_int(struct net_device *dev)
                                                break;
                                        }
                                        writew(0, &rbd->status);
-                                       rbd = (struct rbd_struct __iomem *) make32(readl(&rbd->next));
+                                       rbd = make32(readw(&rbd->next));
                                }
                                totlen += rstat & RBD_MASK;
                                writew(0, &rbd->status);
@@ -991,7 +1006,7 @@ static void ni52_rcv_int(struct net_device *dev)
                writew(0xffff, &p->rfd_top->rbd_offset);
                writeb(0, &p->rfd_last->last);  /* delete RFD_SUSP      */
                p->rfd_last = p->rfd_top;
-               p->rfd_top = (struct rfd_struct __iomem *) make32(p->rfd_top->next); /* step to next RFD */
+               p->rfd_top = make32(readw(&p->rfd_top->next)); /* step to next RFD */
                writew(make16(p->rfd_top), &p->scb->rfa_offset);
 
                if (debuglevel > 0)
@@ -1027,7 +1042,7 @@ static void ni52_rcv_int(struct net_device *dev)
 
 static void ni52_rnr_int(struct net_device *dev)
 {
-       struct priv *p = (struct priv *) dev->priv;
+       struct priv *p = netdev_priv(dev);
 
        p->stats.rx_errors++;
 
@@ -1040,7 +1055,8 @@ static void ni52_rnr_int(struct net_device *dev)
        /* maybe add a check here, before restarting the RU */
        startrecv586(dev); /* restart RU */
 
-       printk(KERN_ERR "%s: Receive-Unit restarted. Status: %04x\n", dev->name, p->scb->rus);
+       printk(KERN_ERR "%s: Receive-Unit restarted. Status: %04x\n",
+               dev->name, readb(&p->scb->rus));
 
 }
 
@@ -1051,7 +1067,7 @@ static void ni52_rnr_int(struct net_device *dev)
 static void ni52_xmt_int(struct net_device *dev)
 {
        int status;
-       struct priv *p = (struct priv *) dev->priv;
+       struct priv *p = netdev_priv(dev);
 
        if (debuglevel > 0)
                printk("X");
@@ -1099,7 +1115,7 @@ static void ni52_xmt_int(struct net_device *dev)
 
 static void startrecv586(struct net_device *dev)
 {
-       struct priv *p = (struct priv *) dev->priv;
+       struct priv *p = netdev_priv(dev);
 
        wait_for_scb_cmd(dev);
        wait_for_scb_cmd_ruc(dev);
@@ -1112,7 +1128,7 @@ static void startrecv586(struct net_device *dev)
 
 static void ni52_timeout(struct net_device *dev)
 {
-       struct priv *p = (struct priv *) dev->priv;
+       struct priv *p = netdev_priv(dev);
 #ifndef NO_NOPCOMMANDS
        if (readb(&p->scb->cus) & CU_ACTIVE) { /* COMMAND-UNIT active? */
                netif_wake_queue(dev);
@@ -1157,27 +1173,27 @@ static void ni52_timeout(struct net_device *dev)
  * send frame
  */
 
-static int ni52_send_packet(struct sk_buff *skb, struct net_device *dev)
+static netdev_tx_t ni52_send_packet(struct sk_buff *skb,
+                                   struct net_device *dev)
 {
        int len, i;
 #ifndef NO_NOPCOMMANDS
        int next_nop;
 #endif
-       struct priv *p = (struct priv *) dev->priv;
+       struct priv *p = netdev_priv(dev);
 
        if (skb->len > XMIT_BUFF_SIZE) {
                printk(KERN_ERR "%s: Sorry, max. framelength is %d bytes. The length of your frame is %d bytes.\n", dev->name, XMIT_BUFF_SIZE, skb->len);
-               return 0;
+               return NETDEV_TX_OK;
        }
 
        netif_stop_queue(dev);
 
-       skb_copy_from_linear_data(skb, (char *)p->xmit_cbuffs[p->xmit_count],
-                                                       skb->len);
+       memcpy_toio(p->xmit_cbuffs[p->xmit_count], skb->data, skb->len);
        len = skb->len;
        if (len < ETH_ZLEN) {
                len = ETH_ZLEN;
-               memset((char *)p->xmit_cbuffs[p->xmit_count]+skb->len, 0,
+               memset_io(p->xmit_cbuffs[p->xmit_count]+skb->len, 0,
                                                        len - skb->len);
        }
 
@@ -1185,14 +1201,14 @@ static int ni52_send_packet(struct sk_buff *skb, struct net_device *dev)
 #      ifdef NO_NOPCOMMANDS
 
 #ifdef DEBUG
-       if (p->scb->cus & CU_ACTIVE) {
+       if (readb(&p->scb->cus) & CU_ACTIVE) {
                printk(KERN_ERR "%s: Hmmm .. CU is still running and we wanna send a new packet.\n", dev->name);
                printk(KERN_ERR "%s: stat: %04x %04x\n",
                                dev->name, readb(&p->scb->cus),
                                readw(&p->xmit_cmds[0]->cmd_status));
        }
 #endif
-       writew(TBD_LAST | len, &p->xmit_buffs[0]->size);;
+       writew(TBD_LAST | len, &p->xmit_buffs[0]->size);
        for (i = 0; i < 16; i++) {
                writew(0, &p->xmit_cmds[0]->cmd_status);
                wait_for_scb_cmd(dev);
@@ -1252,7 +1268,7 @@ static int ni52_send_packet(struct sk_buff *skb, struct net_device *dev)
        }
        dev_kfree_skb(skb);
 #endif
-       return 0;
+       return NETDEV_TX_OK;
 }
 
 /*******************************************
@@ -1261,7 +1277,7 @@ static int ni52_send_packet(struct sk_buff *skb, struct net_device *dev)
 
 static struct net_device_stats *ni52_get_stats(struct net_device *dev)
 {
-       struct priv *p = (struct priv *) dev->priv;
+       struct priv *p = netdev_priv(dev);
        unsigned short crc, aln, rsc, ovrn;
 
        /* Get error-statistics from the ni82586 */
@@ -1324,14 +1340,12 @@ int __init init_module(void)
 
 void __exit cleanup_module(void)
 {
+       struct priv *p = netdev_priv(dev_ni52);
        unregister_netdev(dev_ni52);
+       iounmap(p->mapped);
        release_region(dev_ni52->base_addr, NI52_TOTAL_SIZE);
        free_netdev(dev_ni52);
 }
 #endif /* MODULE */
 
 MODULE_LICENSE("GPL");
-
-/*
- * END: linux/drivers/net/ni52.c
- */