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