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