Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
etherh.c
Go to the documentation of this file.
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/ecard.h>
49 #include <asm/io.h>
50 #include <asm/system_info.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 {
74  void __iomem *memc;
76  unsigned int id;
78  unsigned char ctrl;
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];
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:
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:
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 
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;
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);
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);
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;
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);
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 
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);
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 
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  ethtool_cmd_speed_set(cmd, 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 ?
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  .get_ts_info = ethtool_op_get_ts_info,
639 };
640 
641 static const struct net_device_ops etherh_netdev_ops = {
642  .ndo_open = etherh_open,
643  .ndo_stop = etherh_close,
644  .ndo_set_config = etherh_set_config,
645  .ndo_start_xmit = __ei_start_xmit,
646  .ndo_tx_timeout = __ei_tx_timeout,
647  .ndo_get_stats = __ei_get_stats,
648  .ndo_set_rx_mode = __ei_set_multicast_list,
649  .ndo_validate_addr = eth_validate_addr,
650  .ndo_set_mac_address = eth_mac_addr,
651  .ndo_change_mtu = eth_change_mtu,
652 #ifdef CONFIG_NET_POLL_CONTROLLER
653  .ndo_poll_controller = __ei_poll,
654 #endif
655 };
656 
657 static u32 etherh_regoffsets[16];
658 static u32 etherm_regoffsets[16];
659 
660 static int __devinit
661 etherh_probe(struct expansion_card *ec, const struct ecard_id *id)
662 {
663  const struct etherh_data *data = id->data;
664  struct ei_device *ei_local;
665  struct net_device *dev;
666  struct etherh_priv *eh;
667  int ret;
668 
669  etherh_banner();
670 
671  ret = ecard_request_resources(ec);
672  if (ret)
673  goto out;
674 
675  dev = ____alloc_ei_netdev(sizeof(struct etherh_priv));
676  if (!dev) {
677  ret = -ENOMEM;
678  goto release;
679  }
680 
681  SET_NETDEV_DEV(dev, &ec->dev);
682 
683  dev->netdev_ops = &etherh_netdev_ops;
684  dev->irq = ec->irq;
685  dev->ethtool_ops = &etherh_ethtool_ops;
686 
687  if (data->supported & SUPPORTED_Autoneg)
688  dev->flags |= IFF_AUTOMEDIA;
689  if (data->supported & SUPPORTED_TP) {
690  dev->flags |= IFF_PORTSEL;
691  dev->if_port = IF_PORT_10BASET;
692  } else if (data->supported & SUPPORTED_BNC) {
693  dev->flags |= IFF_PORTSEL;
694  dev->if_port = IF_PORT_10BASE2;
695  } else
696  dev->if_port = IF_PORT_UNKNOWN;
697 
698  eh = etherh_priv(dev);
699  eh->supported = data->supported;
700  eh->ctrl = 0;
701  eh->id = ec->cid.product;
702  eh->memc = ecardm_iomap(ec, ECARD_RES_MEMC, 0, PAGE_SIZE);
703  if (!eh->memc) {
704  ret = -ENOMEM;
705  goto free;
706  }
707 
708  eh->ctrl_port = eh->memc;
709  if (data->ctrl_ioc) {
711  if (!eh->ioc_fast) {
712  ret = -ENOMEM;
713  goto free;
714  }
715  eh->ctrl_port = eh->ioc_fast;
716  }
717 
718  dev->base_addr = (unsigned long)eh->memc + data->ns8390_offset;
719  eh->dma_base = eh->memc + data->dataport_offset;
720  eh->ctrl_port += data->ctrlport_offset;
721 
722  /*
723  * IRQ and control port handling - only for non-NIC slot cards.
724  */
725  if (ec->slot_no != 8) {
726  ecard_setirq(ec, &etherh_ops, eh);
727  } else {
728  /*
729  * If we're in the NIC slot, make sure the IRQ is enabled
730  */
731  etherh_set_ctrl(eh, ETHERH_CP_IE);
732  }
733 
734  ei_local = netdev_priv(dev);
735  spin_lock_init(&ei_local->page_lock);
736 
737  if (ec->cid.product == PROD_ANT_ETHERM) {
738  etherm_addr(dev->dev_addr);
739  ei_local->reg_offset = etherm_regoffsets;
740  } else {
741  etherh_addr(dev->dev_addr, ec);
742  ei_local->reg_offset = etherh_regoffsets;
743  }
744 
745  ei_local->name = dev->name;
746  ei_local->word16 = 1;
747  ei_local->tx_start_page = data->tx_start_page;
748  ei_local->rx_start_page = ei_local->tx_start_page + TX_PAGES;
749  ei_local->stop_page = data->stop_page;
750  ei_local->reset_8390 = etherh_reset;
751  ei_local->block_input = etherh_block_input;
752  ei_local->block_output = etherh_block_output;
753  ei_local->get_8390_hdr = etherh_get_header;
754  ei_local->interface_num = 0;
755 
756  etherh_reset(dev);
757  __NS8390_init(dev, 0);
758 
759  ret = register_netdev(dev);
760  if (ret)
761  goto free;
762 
763  printk(KERN_INFO "%s: %s in slot %d, %pM\n",
764  dev->name, data->name, ec->slot_no, dev->dev_addr);
765 
766  ecard_set_drvdata(ec, dev);
767 
768  return 0;
769 
770  free:
771  free_netdev(dev);
772  release:
774  out:
775  return ret;
776 }
777 
778 static void __devexit etherh_remove(struct expansion_card *ec)
779 {
780  struct net_device *dev = ecard_get_drvdata(ec);
781 
782  ecard_set_drvdata(ec, NULL);
783 
784  unregister_netdev(dev);
785 
786  free_netdev(dev);
787 
789 }
790 
791 static struct etherh_data etherm_data = {
792  .ns8390_offset = ETHERM_NS8390,
793  .dataport_offset = ETHERM_NS8390 + ETHERM_DATAPORT,
794  .ctrlport_offset = ETHERM_NS8390 + ETHERM_CTRLPORT,
795  .name = "ANT EtherM",
796  .supported = SUPPORTED_10baseT_Half,
797  .tx_start_page = ETHERM_TX_START_PAGE,
798  .stop_page = ETHERM_STOP_PAGE,
799 };
800 
801 static struct etherh_data etherlan500_data = {
802  .ns8390_offset = ETHERH500_NS8390,
803  .dataport_offset = ETHERH500_NS8390 + ETHERH500_DATAPORT,
804  .ctrlport_offset = ETHERH500_CTRLPORT,
805  .ctrl_ioc = 1,
806  .name = "i3 EtherH 500",
807  .supported = SUPPORTED_10baseT_Half,
808  .tx_start_page = ETHERH_TX_START_PAGE,
809  .stop_page = ETHERH_STOP_PAGE,
810 };
811 
812 static struct etherh_data etherlan600_data = {
813  .ns8390_offset = ETHERH600_NS8390,
814  .dataport_offset = ETHERH600_NS8390 + ETHERH600_DATAPORT,
815  .ctrlport_offset = ETHERH600_NS8390 + ETHERH600_CTRLPORT,
816  .name = "i3 EtherH 600",
818  .tx_start_page = ETHERH_TX_START_PAGE,
819  .stop_page = ETHERH_STOP_PAGE,
820 };
821 
822 static struct etherh_data etherlan600a_data = {
823  .ns8390_offset = ETHERH600_NS8390,
824  .dataport_offset = ETHERH600_NS8390 + ETHERH600_DATAPORT,
825  .ctrlport_offset = ETHERH600_NS8390 + ETHERH600_CTRLPORT,
826  .name = "i3 EtherH 600A",
828  .tx_start_page = ETHERH_TX_START_PAGE,
829  .stop_page = ETHERH_STOP_PAGE,
830 };
831 
832 static const struct ecard_id etherh_ids[] = {
833  { MANU_ANT, PROD_ANT_ETHERM, &etherm_data },
834  { MANU_I3, PROD_I3_ETHERLAN500, &etherlan500_data },
835  { MANU_I3, PROD_I3_ETHERLAN600, &etherlan600_data },
836  { MANU_I3, PROD_I3_ETHERLAN600A, &etherlan600a_data },
837  { 0xffff, 0xffff }
838 };
839 
840 static struct ecard_driver etherh_driver = {
841  .probe = etherh_probe,
842  .remove = __devexit_p(etherh_remove),
843  .id_table = etherh_ids,
844  .drv = {
845  .name = DRV_NAME,
846  },
847 };
848 
849 static int __init etherh_init(void)
850 {
851  int i;
852 
853  for (i = 0; i < 16; i++) {
854  etherh_regoffsets[i] = i << 2;
855  etherm_regoffsets[i] = i << 5;
856  }
857 
858  return ecard_register_driver(&etherh_driver);
859 }
860 
861 static void __exit etherh_exit(void)
862 {
863  ecard_remove_driver(&etherh_driver);
864 }
865 
866 module_init(etherh_init);
867 module_exit(etherh_exit);