Merge master.kernel.org:/pub/scm/linux/kernel/git/gregkh/pci-2.6
[linux-2.6] / drivers / net / arm / etherh.c
1 /*
2  *  linux/drivers/acorn/net/etherh.c
3  *
4  *  Copyright (C) 2000-2002 Russell King
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License version 2 as
8  * published by the Free Software Foundation.
9  *
10  * NS8390 I-cubed EtherH and ANT EtherM specific driver
11  * Thanks to I-Cubed for information on their cards.
12  * EtherM conversion (C) 1999 Chris Kemp and Tim Watterton
13  * EtherM integration (C) 2000 Aleph One Ltd (Tak-Shing Chan)
14  * EtherM integration re-engineered by Russell King.
15  *
16  * Changelog:
17  *  08-12-1996  RMK     1.00    Created
18  *              RMK     1.03    Added support for EtherLan500 cards
19  *  23-11-1997  RMK     1.04    Added media autodetection
20  *  16-04-1998  RMK     1.05    Improved media autodetection
21  *  10-02-2000  RMK     1.06    Updated for 2.3.43
22  *  13-05-2000  RMK     1.07    Updated for 2.3.99-pre8
23  *  12-10-1999  CK/TEW          EtherM driver first release
24  *  21-12-2000  TTC             EtherH/EtherM integration
25  *  25-12-2000  RMK     1.08    Clean integration of EtherM into this driver.
26  *  03-01-2002  RMK     1.09    Always enable IRQs if we're in the nic slot.
27  */
28
29 #include <linux/module.h>
30 #include <linux/kernel.h>
31 #include <linux/sched.h>
32 #include <linux/types.h>
33 #include <linux/fcntl.h>
34 #include <linux/interrupt.h>
35 #include <linux/ptrace.h>
36 #include <linux/ioport.h>
37 #include <linux/in.h>
38 #include <linux/slab.h>
39 #include <linux/string.h>
40 #include <linux/errno.h>
41 #include <linux/netdevice.h>
42 #include <linux/etherdevice.h>
43 #include <linux/ethtool.h>
44 #include <linux/skbuff.h>
45 #include <linux/delay.h>
46 #include <linux/device.h>
47 #include <linux/init.h>
48 #include <linux/bitops.h>
49 #include <linux/jiffies.h>
50
51 #include <asm/system.h>
52 #include <asm/ecard.h>
53 #include <asm/io.h>
54
55 #define EI_SHIFT(x)     (ei_local->reg_offset[x])
56
57 #define ei_inb(_p)       readb((void __iomem *)_p)
58 #define ei_outb(_v,_p)   writeb(_v,(void __iomem *)_p)
59 #define ei_inb_p(_p)     readb((void __iomem *)_p)
60 #define ei_outb_p(_v,_p) writeb(_v,(void __iomem *)_p)
61
62 #define NET_DEBUG  0
63 #define DEBUG_INIT 2
64
65 #define DRV_NAME        "etherh"
66 #define DRV_VERSION     "1.11"
67
68 static char version[] __initdata =
69         "EtherH/EtherM Driver (c) 2002-2004 Russell King " DRV_VERSION "\n";
70
71 #include "../lib8390.c"
72
73 static unsigned int net_debug = NET_DEBUG;
74
75 struct etherh_priv {
76         void __iomem    *ioc_fast;
77         void __iomem    *memc;
78         void __iomem    *dma_base;
79         unsigned int    id;
80         void __iomem    *ctrl_port;
81         unsigned char   ctrl;
82         u32             supported;
83 };
84
85 struct etherh_data {
86         unsigned long   ns8390_offset;
87         unsigned long   dataport_offset;
88         unsigned long   ctrlport_offset;
89         int             ctrl_ioc;
90         const char      name[16];
91         u32             supported;
92         unsigned char   tx_start_page;
93         unsigned char   stop_page;
94 };
95
96 MODULE_AUTHOR("Russell King");
97 MODULE_DESCRIPTION("EtherH/EtherM driver");
98 MODULE_LICENSE("GPL");
99
100 #define ETHERH500_DATAPORT      0x800   /* MEMC */
101 #define ETHERH500_NS8390        0x000   /* MEMC */
102 #define ETHERH500_CTRLPORT      0x800   /* IOC  */
103
104 #define ETHERH600_DATAPORT      0x040   /* MEMC */
105 #define ETHERH600_NS8390        0x800   /* MEMC */
106 #define ETHERH600_CTRLPORT      0x200   /* MEMC */
107
108 #define ETHERH_CP_IE            1
109 #define ETHERH_CP_IF            2
110 #define ETHERH_CP_HEARTBEAT     2
111
112 #define ETHERH_TX_START_PAGE    1
113 #define ETHERH_STOP_PAGE        127
114
115 /*
116  * These came from CK/TEW
117  */
118 #define ETHERM_DATAPORT         0x200   /* MEMC */
119 #define ETHERM_NS8390           0x800   /* MEMC */
120 #define ETHERM_CTRLPORT         0x23c   /* MEMC */
121
122 #define ETHERM_TX_START_PAGE    64
123 #define ETHERM_STOP_PAGE        127
124
125 /* ------------------------------------------------------------------------ */
126
127 #define etherh_priv(dev) \
128  ((struct etherh_priv *)(((char *)netdev_priv(dev)) + sizeof(struct ei_device)))
129
130 static inline void etherh_set_ctrl(struct etherh_priv *eh, unsigned char mask)
131 {
132         unsigned char ctrl = eh->ctrl | mask;
133         eh->ctrl = ctrl;
134         writeb(ctrl, eh->ctrl_port);
135 }
136
137 static inline void etherh_clr_ctrl(struct etherh_priv *eh, unsigned char mask)
138 {
139         unsigned char ctrl = eh->ctrl & ~mask;
140         eh->ctrl = ctrl;
141         writeb(ctrl, eh->ctrl_port);
142 }
143
144 static inline unsigned int etherh_get_stat(struct etherh_priv *eh)
145 {
146         return readb(eh->ctrl_port);
147 }
148
149
150
151
152 static void etherh_irq_enable(ecard_t *ec, int irqnr)
153 {
154         struct etherh_priv *eh = ec->irq_data;
155
156         etherh_set_ctrl(eh, ETHERH_CP_IE);
157 }
158
159 static void etherh_irq_disable(ecard_t *ec, int irqnr)
160 {
161         struct etherh_priv *eh = ec->irq_data;
162
163         etherh_clr_ctrl(eh, ETHERH_CP_IE);
164 }
165
166 static expansioncard_ops_t etherh_ops = {
167         .irqenable      = etherh_irq_enable,
168         .irqdisable     = etherh_irq_disable,
169 };
170
171
172
173
174 static void
175 etherh_setif(struct net_device *dev)
176 {
177         struct ei_device *ei_local = netdev_priv(dev);
178         unsigned long flags;
179         void __iomem *addr;
180
181         local_irq_save(flags);
182
183         /* set the interface type */
184         switch (etherh_priv(dev)->id) {
185         case PROD_I3_ETHERLAN600:
186         case PROD_I3_ETHERLAN600A:
187                 addr = (void __iomem *)dev->base_addr + EN0_RCNTHI;
188
189                 switch (dev->if_port) {
190                 case IF_PORT_10BASE2:
191                         writeb((readb(addr) & 0xf8) | 1, addr);
192                         break;
193                 case IF_PORT_10BASET:
194                         writeb((readb(addr) & 0xf8), addr);
195                         break;
196                 }
197                 break;
198
199         case PROD_I3_ETHERLAN500:
200                 switch (dev->if_port) {
201                 case IF_PORT_10BASE2:
202                         etherh_clr_ctrl(etherh_priv(dev), ETHERH_CP_IF);
203                         break;
204
205                 case IF_PORT_10BASET:
206                         etherh_set_ctrl(etherh_priv(dev), ETHERH_CP_IF);
207                         break;
208                 }
209                 break;
210
211         default:
212                 break;
213         }
214
215         local_irq_restore(flags);
216 }
217
218 static int
219 etherh_getifstat(struct net_device *dev)
220 {
221         struct ei_device *ei_local = netdev_priv(dev);
222         void __iomem *addr;
223         int stat = 0;
224
225         switch (etherh_priv(dev)->id) {
226         case PROD_I3_ETHERLAN600:
227         case PROD_I3_ETHERLAN600A:
228                 addr = (void __iomem *)dev->base_addr + EN0_RCNTHI;
229                 switch (dev->if_port) {
230                 case IF_PORT_10BASE2:
231                         stat = 1;
232                         break;
233                 case IF_PORT_10BASET:
234                         stat = readb(addr) & 4;
235                         break;
236                 }
237                 break;
238
239         case PROD_I3_ETHERLAN500:
240                 switch (dev->if_port) {
241                 case IF_PORT_10BASE2:
242                         stat = 1;
243                         break;
244                 case IF_PORT_10BASET:
245                         stat = etherh_get_stat(etherh_priv(dev)) & ETHERH_CP_HEARTBEAT;
246                         break;
247                 }
248                 break;
249
250         default:
251                 stat = 0;
252                 break;
253         }
254
255         return stat != 0;
256 }
257
258 /*
259  * Configure the interface.  Note that we ignore the other
260  * parts of ifmap, since its mostly meaningless for this driver.
261  */
262 static int etherh_set_config(struct net_device *dev, struct ifmap *map)
263 {
264         switch (map->port) {
265         case IF_PORT_10BASE2:
266         case IF_PORT_10BASET:
267                 /*
268                  * If the user explicitly sets the interface
269                  * media type, turn off automedia detection.
270                  */
271                 dev->flags &= ~IFF_AUTOMEDIA;
272                 dev->if_port = map->port;
273                 break;
274
275         default:
276                 return -EINVAL;
277         }
278
279         etherh_setif(dev);
280
281         return 0;
282 }
283
284 /*
285  * Reset the 8390 (hard reset).  Note that we can't actually do this.
286  */
287 static void
288 etherh_reset(struct net_device *dev)
289 {
290         struct ei_device *ei_local = netdev_priv(dev);
291         void __iomem *addr = (void __iomem *)dev->base_addr;
292
293         writeb(E8390_NODMA+E8390_PAGE0+E8390_STOP, addr);
294
295         /*
296          * See if we need to change the interface type.
297          * Note that we use 'interface_num' as a flag
298          * to indicate that we need to change the media.
299          */
300         if (dev->flags & IFF_AUTOMEDIA && ei_local->interface_num) {
301                 ei_local->interface_num = 0;
302
303                 if (dev->if_port == IF_PORT_10BASET)
304                         dev->if_port = IF_PORT_10BASE2;
305                 else
306                         dev->if_port = IF_PORT_10BASET;
307
308                 etherh_setif(dev);
309         }
310 }
311
312 /*
313  * Write a block of data out to the 8390
314  */
315 static void
316 etherh_block_output (struct net_device *dev, int count, const unsigned char *buf, int start_page)
317 {
318         struct ei_device *ei_local = netdev_priv(dev);
319         unsigned long dma_start;
320         void __iomem *dma_base, *addr;
321
322         if (ei_local->dmaing) {
323                 printk(KERN_ERR "%s: DMAing conflict in etherh_block_input: "
324                         " DMAstat %d irqlock %d\n", dev->name,
325                         ei_local->dmaing, ei_local->irqlock);
326                 return;
327         }
328
329         /*
330          * Make sure we have a round number of bytes if we're in word mode.
331          */
332         if (count & 1 && ei_local->word16)
333                 count++;
334
335         ei_local->dmaing = 1;
336
337         addr = (void __iomem *)dev->base_addr;
338         dma_base = etherh_priv(dev)->dma_base;
339
340         count = (count + 1) & ~1;
341         writeb (E8390_NODMA | E8390_PAGE0 | E8390_START, addr + E8390_CMD);
342
343         writeb (0x42, addr + EN0_RCNTLO);
344         writeb (0x00, addr + EN0_RCNTHI);
345         writeb (0x42, addr + EN0_RSARLO);
346         writeb (0x00, addr + EN0_RSARHI);
347         writeb (E8390_RREAD | E8390_START, addr + E8390_CMD);
348
349         udelay (1);
350
351         writeb (ENISR_RDC, addr + EN0_ISR);
352         writeb (count, addr + EN0_RCNTLO);
353         writeb (count >> 8, addr + EN0_RCNTHI);
354         writeb (0, addr + EN0_RSARLO);
355         writeb (start_page, addr + EN0_RSARHI);
356         writeb (E8390_RWRITE | E8390_START, addr + E8390_CMD);
357
358         if (ei_local->word16)
359                 writesw (dma_base, buf, count >> 1);
360         else
361                 writesb (dma_base, buf, count);
362
363         dma_start = jiffies;
364
365         while ((readb (addr + EN0_ISR) & ENISR_RDC) == 0)
366                 if (time_after(jiffies, dma_start + 2*HZ/100)) { /* 20ms */
367                         printk(KERN_ERR "%s: timeout waiting for TX RDC\n",
368                                 dev->name);
369                         etherh_reset (dev);
370                         __NS8390_init (dev, 1);
371                         break;
372                 }
373
374         writeb (ENISR_RDC, addr + EN0_ISR);
375         ei_local->dmaing = 0;
376 }
377
378 /*
379  * Read a block of data from the 8390
380  */
381 static void
382 etherh_block_input (struct net_device *dev, int count, struct sk_buff *skb, int ring_offset)
383 {
384         struct ei_device *ei_local = netdev_priv(dev);
385         unsigned char *buf;
386         void __iomem *dma_base, *addr;
387
388         if (ei_local->dmaing) {
389                 printk(KERN_ERR "%s: DMAing conflict in etherh_block_input: "
390                         " DMAstat %d irqlock %d\n", dev->name,
391                         ei_local->dmaing, ei_local->irqlock);
392                 return;
393         }
394
395         ei_local->dmaing = 1;
396
397         addr = (void __iomem *)dev->base_addr;
398         dma_base = etherh_priv(dev)->dma_base;
399
400         buf = skb->data;
401         writeb (E8390_NODMA | E8390_PAGE0 | E8390_START, addr + E8390_CMD);
402         writeb (count, addr + EN0_RCNTLO);
403         writeb (count >> 8, addr + EN0_RCNTHI);
404         writeb (ring_offset, addr + EN0_RSARLO);
405         writeb (ring_offset >> 8, addr + EN0_RSARHI);
406         writeb (E8390_RREAD | E8390_START, addr + E8390_CMD);
407
408         if (ei_local->word16) {
409                 readsw (dma_base, buf, count >> 1);
410                 if (count & 1)
411                         buf[count - 1] = readb (dma_base);
412         } else
413                 readsb (dma_base, buf, count);
414
415         writeb (ENISR_RDC, addr + EN0_ISR);
416         ei_local->dmaing = 0;
417 }
418
419 /*
420  * Read a header from the 8390
421  */
422 static void
423 etherh_get_header (struct net_device *dev, struct e8390_pkt_hdr *hdr, int ring_page)
424 {
425         struct ei_device *ei_local = netdev_priv(dev);
426         void __iomem *dma_base, *addr;
427
428         if (ei_local->dmaing) {
429                 printk(KERN_ERR "%s: DMAing conflict in etherh_get_header: "
430                         " DMAstat %d irqlock %d\n", dev->name,
431                         ei_local->dmaing, ei_local->irqlock);
432                 return;
433         }
434
435         ei_local->dmaing = 1;
436
437         addr = (void __iomem *)dev->base_addr;
438         dma_base = etherh_priv(dev)->dma_base;
439
440         writeb (E8390_NODMA | E8390_PAGE0 | E8390_START, addr + E8390_CMD);
441         writeb (sizeof (*hdr), addr + EN0_RCNTLO);
442         writeb (0, addr + EN0_RCNTHI);
443         writeb (0, addr + EN0_RSARLO);
444         writeb (ring_page, addr + EN0_RSARHI);
445         writeb (E8390_RREAD | E8390_START, addr + E8390_CMD);
446
447         if (ei_local->word16)
448                 readsw (dma_base, hdr, sizeof (*hdr) >> 1);
449         else
450                 readsb (dma_base, hdr, sizeof (*hdr));
451
452         writeb (ENISR_RDC, addr + EN0_ISR);
453         ei_local->dmaing = 0;
454 }
455
456 /*
457  * Open/initialize the board.  This is called (in the current kernel)
458  * sometime after booting when the 'ifconfig' program is run.
459  *
460  * This routine should set everything up anew at each open, even
461  * registers that "should" only need to be set once at boot, so that
462  * there is non-reboot way to recover if something goes wrong.
463  */
464 static int
465 etherh_open(struct net_device *dev)
466 {
467         struct ei_device *ei_local = netdev_priv(dev);
468
469         if (!is_valid_ether_addr(dev->dev_addr)) {
470                 printk(KERN_WARNING "%s: invalid ethernet MAC address\n",
471                         dev->name);
472                 return -EINVAL;
473         }
474
475         if (request_irq(dev->irq, __ei_interrupt, 0, dev->name, dev))
476                 return -EAGAIN;
477
478         /*
479          * Make sure that we aren't going to change the
480          * media type on the next reset - we are about to
481          * do automedia manually now.
482          */
483         ei_local->interface_num = 0;
484
485         /*
486          * If we are doing automedia detection, do it now.
487          * This is more reliable than the 8390's detection.
488          */
489         if (dev->flags & IFF_AUTOMEDIA) {
490                 dev->if_port = IF_PORT_10BASET;
491                 etherh_setif(dev);
492                 mdelay(1);
493                 if (!etherh_getifstat(dev)) {
494                         dev->if_port = IF_PORT_10BASE2;
495                         etherh_setif(dev);
496                 }
497         } else
498                 etherh_setif(dev);
499
500         etherh_reset(dev);
501         __ei_open(dev);
502
503         return 0;
504 }
505
506 /*
507  * The inverse routine to etherh_open().
508  */
509 static int
510 etherh_close(struct net_device *dev)
511 {
512         __ei_close (dev);
513         free_irq (dev->irq, dev);
514         return 0;
515 }
516
517 /*
518  * Initialisation
519  */
520
521 static void __init etherh_banner(void)
522 {
523         static int version_printed;
524
525         if (net_debug && version_printed++ == 0)
526                 printk(KERN_INFO "%s", version);
527 }
528
529 /*
530  * Read the ethernet address string from the on board rom.
531  * This is an ascii string...
532  */
533 static int __init etherh_addr(char *addr, struct expansion_card *ec)
534 {
535         struct in_chunk_dir cd;
536         char *s;
537         
538         if (!ecard_readchunk(&cd, ec, 0xf5, 0)) {
539                 printk(KERN_ERR "%s: unable to read podule description string\n",
540                        ec->dev.bus_id);
541                 goto no_addr;
542         }
543
544         s = strchr(cd.d.string, '(');
545         if (s) {
546                 int i;
547
548                 for (i = 0; i < 6; i++) {
549                         addr[i] = simple_strtoul(s + 1, &s, 0x10);
550                         if (*s != (i == 5? ')' : ':'))
551                                 break;
552                 }
553
554                 if (i == 6)
555                         return 0;
556         }
557
558         printk(KERN_ERR "%s: unable to parse MAC address: %s\n",
559                ec->dev.bus_id, cd.d.string);
560
561  no_addr:
562         return -ENODEV;
563 }
564
565 /*
566  * Create an ethernet address from the system serial number.
567  */
568 static int __init etherm_addr(char *addr)
569 {
570         unsigned int serial;
571
572         if (system_serial_low == 0 && system_serial_high == 0)
573                 return -ENODEV;
574
575         serial = system_serial_low | system_serial_high;
576
577         addr[0] = 0;
578         addr[1] = 0;
579         addr[2] = 0xa4;
580         addr[3] = 0x10 + (serial >> 24);
581         addr[4] = serial >> 16;
582         addr[5] = serial >> 8;
583         return 0;
584 }
585
586 static void etherh_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
587 {
588         strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
589         strlcpy(info->version, DRV_VERSION, sizeof(info->version));
590         strlcpy(info->bus_info, dev->dev.parent->bus_id,
591                 sizeof(info->bus_info));
592 }
593
594 static int etherh_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
595 {
596         cmd->supported  = etherh_priv(dev)->supported;
597         cmd->speed      = SPEED_10;
598         cmd->duplex     = DUPLEX_HALF;
599         cmd->port       = dev->if_port == IF_PORT_10BASET ? PORT_TP : PORT_BNC;
600         cmd->autoneg    = dev->flags & IFF_AUTOMEDIA ? AUTONEG_ENABLE : AUTONEG_DISABLE;
601         return 0;
602 }
603
604 static int etherh_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
605 {
606         switch (cmd->autoneg) {
607         case AUTONEG_ENABLE:
608                 dev->flags |= IFF_AUTOMEDIA;
609                 break;
610
611         case AUTONEG_DISABLE:
612                 switch (cmd->port) {
613                 case PORT_TP:
614                         dev->if_port = IF_PORT_10BASET;
615                         break;
616
617                 case PORT_BNC:
618                         dev->if_port = IF_PORT_10BASE2;
619                         break;
620
621                 default:
622                         return -EINVAL;
623                 }
624                 dev->flags &= ~IFF_AUTOMEDIA;
625                 break;
626
627         default:
628                 return -EINVAL;
629         }
630
631         etherh_setif(dev);
632
633         return 0;
634 }
635
636 static const struct ethtool_ops etherh_ethtool_ops = {
637         .get_settings   = etherh_get_settings,
638         .set_settings   = etherh_set_settings,
639         .get_drvinfo    = etherh_get_drvinfo,
640 };
641
642 static u32 etherh_regoffsets[16];
643 static u32 etherm_regoffsets[16];
644
645 static int __init
646 etherh_probe(struct expansion_card *ec, const struct ecard_id *id)
647 {
648         const struct etherh_data *data = id->data;
649         struct ei_device *ei_local;
650         struct net_device *dev;
651         struct etherh_priv *eh;
652         int i, ret;
653
654         etherh_banner();
655
656         ret = ecard_request_resources(ec);
657         if (ret)
658                 goto out;
659
660         dev = ____alloc_ei_netdev(sizeof(struct etherh_priv));
661         if (!dev) {
662                 ret = -ENOMEM;
663                 goto release;
664         }
665
666         SET_MODULE_OWNER(dev);
667         SET_NETDEV_DEV(dev, &ec->dev);
668
669         dev->open               = etherh_open;
670         dev->stop               = etherh_close;
671         dev->set_config         = etherh_set_config;
672         dev->irq                = ec->irq;
673         dev->ethtool_ops        = &etherh_ethtool_ops;
674
675         if (data->supported & SUPPORTED_Autoneg)
676                 dev->flags |= IFF_AUTOMEDIA;
677         if (data->supported & SUPPORTED_TP) {
678                 dev->flags |= IFF_PORTSEL;
679                 dev->if_port = IF_PORT_10BASET;
680         } else if (data->supported & SUPPORTED_BNC) {
681                 dev->flags |= IFF_PORTSEL;
682                 dev->if_port = IF_PORT_10BASE2;
683         } else
684                 dev->if_port = IF_PORT_UNKNOWN;
685
686         eh = etherh_priv(dev);
687         eh->supported           = data->supported;
688         eh->ctrl                = 0;
689         eh->id                  = ec->cid.product;
690         eh->memc                = ioremap(ecard_resource_start(ec, ECARD_RES_MEMC), PAGE_SIZE);
691         if (!eh->memc) {
692                 ret = -ENOMEM;
693                 goto free;
694         }
695
696         eh->ctrl_port = eh->memc;
697         if (data->ctrl_ioc) {
698                 eh->ioc_fast = ioremap(ecard_resource_start(ec, ECARD_RES_IOCFAST), PAGE_SIZE);
699                 if (!eh->ioc_fast) {
700                         ret = -ENOMEM;
701                         goto free;
702                 }
703                 eh->ctrl_port = eh->ioc_fast;
704         }
705
706         dev->base_addr = (unsigned long)eh->memc + data->ns8390_offset;
707         eh->dma_base = eh->memc + data->dataport_offset;
708         eh->ctrl_port += data->ctrlport_offset;
709
710         /*
711          * IRQ and control port handling - only for non-NIC slot cards.
712          */
713         if (ec->slot_no != 8) {
714                 ec->ops         = &etherh_ops;
715                 ec->irq_data    = eh;
716         } else {
717                 /*
718                  * If we're in the NIC slot, make sure the IRQ is enabled
719                  */
720                 etherh_set_ctrl(eh, ETHERH_CP_IE);
721         }
722
723         ei_local = netdev_priv(dev);
724         spin_lock_init(&ei_local->page_lock);
725
726         if (ec->cid.product == PROD_ANT_ETHERM) {
727                 etherm_addr(dev->dev_addr);
728                 ei_local->reg_offset = etherm_regoffsets;
729         } else {
730                 etherh_addr(dev->dev_addr, ec);
731                 ei_local->reg_offset = etherh_regoffsets;
732         }
733
734         ei_local->name          = dev->name;
735         ei_local->word16        = 1;
736         ei_local->tx_start_page = data->tx_start_page;
737         ei_local->rx_start_page = ei_local->tx_start_page + TX_PAGES;
738         ei_local->stop_page     = data->stop_page;
739         ei_local->reset_8390    = etherh_reset;
740         ei_local->block_input   = etherh_block_input;
741         ei_local->block_output  = etherh_block_output;
742         ei_local->get_8390_hdr  = etherh_get_header;
743         ei_local->interface_num = 0;
744
745         etherh_reset(dev);
746         __NS8390_init(dev, 0);
747
748         ret = register_netdev(dev);
749         if (ret)
750                 goto free;
751
752         printk(KERN_INFO "%s: %s in slot %d, ",
753                 dev->name, data->name, ec->slot_no);
754
755         for (i = 0; i < 6; i++)
756                 printk("%2.2x%c", dev->dev_addr[i], i == 5 ? '\n' : ':');
757
758         ecard_set_drvdata(ec, dev);
759
760         return 0;
761
762  free:
763         if (eh->ioc_fast)
764                 iounmap(eh->ioc_fast);
765         if (eh->memc)
766                 iounmap(eh->memc);
767         free_netdev(dev);
768  release:
769         ecard_release_resources(ec);
770  out:
771         return ret;
772 }
773
774 static void __devexit etherh_remove(struct expansion_card *ec)
775 {
776         struct net_device *dev = ecard_get_drvdata(ec);
777         struct etherh_priv *eh = etherh_priv(dev);
778
779         ecard_set_drvdata(ec, NULL);
780
781         unregister_netdev(dev);
782         ec->ops = NULL;
783
784         if (eh->ioc_fast)
785                 iounmap(eh->ioc_fast);
786         iounmap(eh->memc);
787
788         free_netdev(dev);
789
790         ecard_release_resources(ec);
791 }
792
793 static struct etherh_data etherm_data = {
794         .ns8390_offset          = ETHERM_NS8390,
795         .dataport_offset        = ETHERM_NS8390 + ETHERM_DATAPORT,
796         .ctrlport_offset        = ETHERM_NS8390 + ETHERM_CTRLPORT,
797         .name                   = "ANT EtherM",
798         .supported              = SUPPORTED_10baseT_Half,
799         .tx_start_page          = ETHERM_TX_START_PAGE,
800         .stop_page              = ETHERM_STOP_PAGE,
801 };
802
803 static struct etherh_data etherlan500_data = {
804         .ns8390_offset          = ETHERH500_NS8390,
805         .dataport_offset        = ETHERH500_NS8390 + ETHERH500_DATAPORT,
806         .ctrlport_offset        = ETHERH500_CTRLPORT,
807         .ctrl_ioc               = 1,
808         .name                   = "i3 EtherH 500",
809         .supported              = SUPPORTED_10baseT_Half,
810         .tx_start_page          = ETHERH_TX_START_PAGE,
811         .stop_page              = ETHERH_STOP_PAGE,
812 };
813
814 static struct etherh_data etherlan600_data = {
815         .ns8390_offset          = ETHERH600_NS8390,
816         .dataport_offset        = ETHERH600_NS8390 + ETHERH600_DATAPORT,
817         .ctrlport_offset        = ETHERH600_NS8390 + ETHERH600_CTRLPORT,
818         .name                   = "i3 EtherH 600",
819         .supported              = SUPPORTED_10baseT_Half | SUPPORTED_TP | SUPPORTED_BNC | SUPPORTED_Autoneg,
820         .tx_start_page          = ETHERH_TX_START_PAGE,
821         .stop_page              = ETHERH_STOP_PAGE,
822 };
823
824 static struct etherh_data etherlan600a_data = {
825         .ns8390_offset          = ETHERH600_NS8390,
826         .dataport_offset        = ETHERH600_NS8390 + ETHERH600_DATAPORT,
827         .ctrlport_offset        = ETHERH600_NS8390 + ETHERH600_CTRLPORT,
828         .name                   = "i3 EtherH 600A",
829         .supported              = SUPPORTED_10baseT_Half | SUPPORTED_TP | SUPPORTED_BNC | SUPPORTED_Autoneg,
830         .tx_start_page          = ETHERH_TX_START_PAGE,
831         .stop_page              = ETHERH_STOP_PAGE,
832 };
833
834 static const struct ecard_id etherh_ids[] = {
835         { MANU_ANT, PROD_ANT_ETHERM,      &etherm_data       },
836         { MANU_I3,  PROD_I3_ETHERLAN500,  &etherlan500_data  },
837         { MANU_I3,  PROD_I3_ETHERLAN600,  &etherlan600_data  },
838         { MANU_I3,  PROD_I3_ETHERLAN600A, &etherlan600a_data },
839         { 0xffff,   0xffff }
840 };
841
842 static struct ecard_driver etherh_driver = {
843         .probe          = etherh_probe,
844         .remove         = __devexit_p(etherh_remove),
845         .id_table       = etherh_ids,
846         .drv = {
847                 .name   = DRV_NAME,
848         },
849 };
850
851 static int __init etherh_init(void)
852 {
853         int i;
854
855         for (i = 0; i < 16; i++) {
856                 etherh_regoffsets[i] = i << 2;
857                 etherm_regoffsets[i] = i << 5;
858         }
859
860         return ecard_register_driver(&etherh_driver);
861 }
862
863 static void __exit etherh_exit(void)
864 {
865         ecard_remove_driver(&etherh_driver);
866 }
867
868 module_init(etherh_init);
869 module_exit(etherh_exit);