Linux Audio

Check our new training course

Loading...
  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
 65static char version[] __initdata =
 66	"EtherH/EtherM Driver (c) 2002-2004 Russell King " DRV_VERSION "\n";
 67
 68#include "lib8390.c"
 69
 70static unsigned int net_debug = NET_DEBUG;
 71
 72struct 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
 82struct 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
 93MODULE_AUTHOR("Russell King");
 94MODULE_DESCRIPTION("EtherH/EtherM driver");
 95MODULE_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
127static 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
134static 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
141static inline unsigned int etherh_get_stat(struct etherh_priv *eh)
142{
143	return readb(eh->ctrl_port);
144}
145
146
147
148
149static 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
156static 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
163static expansioncard_ops_t etherh_ops = {
164	.irqenable	= etherh_irq_enable,
165	.irqdisable	= etherh_irq_disable,
166};
167
168
169
170
171static void
172etherh_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
215static int
216etherh_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 */
259static 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 */
284static void
285etherh_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 */
312static void
313etherh_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 */
378static void
379etherh_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 */
419static void
420etherh_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 */
461static int
462etherh_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 */
506static int
507etherh_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
518static 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 */
530static 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 */
565static 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
583static 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
591static 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 ?
598			   AUTONEG_ENABLE : AUTONEG_DISABLE);
599	return 0;
600}
601
602static 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
634static 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
641static 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
657static u32 etherh_regoffsets[16];
658static u32 etherm_regoffsets[16];
659
660static int __devinit
661etherh_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) {
710		eh->ioc_fast = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, PAGE_SIZE);
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:
773	ecard_release_resources(ec);
774 out:
775	return ret;
776}
777
778static 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
788	ecard_release_resources(ec);
789}
790
791static 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
801static 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
812static 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",
817	.supported		= SUPPORTED_10baseT_Half | SUPPORTED_TP | SUPPORTED_BNC | SUPPORTED_Autoneg,
818	.tx_start_page		= ETHERH_TX_START_PAGE,
819	.stop_page		= ETHERH_STOP_PAGE,
820};
821
822static 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",
827	.supported		= SUPPORTED_10baseT_Half | SUPPORTED_TP | SUPPORTED_BNC | SUPPORTED_Autoneg,
828	.tx_start_page		= ETHERH_TX_START_PAGE,
829	.stop_page		= ETHERH_STOP_PAGE,
830};
831
832static 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
840static 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
849static 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
861static void __exit etherh_exit(void)
862{
863	ecard_remove_driver(&etherh_driver);
864}
865
866module_init(etherh_init);
867module_exit(etherh_exit);