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