]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/net/arm/etherh.c
git://bbs.cooldavid.org / net-next-2.6.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit...
[net-next-2.6.git] / drivers / net / arm / etherh.c
CommitLineData
1da177e4
LT		 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>
1da177e4
LT		 31#include <linux/types.h>
32#include <linux/fcntl.h>
33#include <linux/interrupt.h>
1da177e4
LT		 34#include <linux/ioport.h>
35#include <linux/in.h>
1da177e4
LT		 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>
ff5688ae 46#include <linux/jiffies.h>
1da177e4
LT		 47
48#include <asm/system.h>
49#include <asm/ecard.h>
50#include <asm/io.h>
1da177e4 51
6c3561b0
AV		 52#define EI_SHIFT(x) (ei_local->reg_offset[x])
53
b936889c
AV		 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)
1da177e4
LT		 58
59#define NET_DEBUG 0
60#define DEBUG_INIT 2
61
62#define DRV_NAME "etherh"
63#define DRV_VERSION "1.11"
64
6c3561b0
AV		 65static char version[] __initdata =
66 "EtherH/EtherM Driver (c) 2002-2004 Russell King " DRV_VERSION "\n";
67
68#include "../lib8390.c"
69
1da177e4
LT		 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
1da177e4
LT		 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:
b936889c 184 addr = (void __iomem *)dev->base_addr + EN0_RCNTHI;
1da177e4
LT		 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:
b936889c 225 addr = (void __iomem *)dev->base_addr + EN0_RCNTHI;
1da177e4
LT		 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);
b936889c 288 void __iomem *addr = (void __iomem *)dev->base_addr;
1da177e4
LT		 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
b936889c 334 addr = (void __iomem *)dev->base_addr;
1da177e4
LT		 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)
ff5688ae 363 if (time_after(jiffies, dma_start + 2*HZ/100)) { /* 20ms */
1da177e4
LT		 364 printk(KERN_ERR "%s: timeout waiting for TX RDC\n",
365 dev->name);
366 etherh_reset (dev);
6c3561b0 367 __NS8390_init (dev, 1);
1da177e4
LT		 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
b936889c 394 addr = (void __iomem *)dev->base_addr;
1da177e4
LT		 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
b936889c 434 addr = (void __iomem *)dev->base_addr;
1da177e4
LT		 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
6c3561b0 472 if (request_irq(dev->irq, __ei_interrupt, 0, dev->name, dev))
1da177e4
LT		 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);
6c3561b0 498 __ei_open(dev);
1da177e4
LT		 499
500 return 0;
501}
502
503/*
504 * The inverse routine to etherh_open().
505 */
506static int
507etherh_close(struct net_device *dev)
508{
6c3561b0 509 __ei_close (dev);
1da177e4
LT		 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 __init 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",
3f978704 537 dev_name(&ec->dev));
1da177e4
LT		 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",
3f978704 556 dev_name(&ec->dev), cd.d.string);
1da177e4
LT		 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));
3f978704 587 strlcpy(info->bus_info, dev_name(dev->dev.parent),
1da177e4
LT		 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 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
601static 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
7282d491 633static const struct ethtool_ops etherh_ethtool_ops = {
1da177e4
LT		 634 .get_settings = etherh_get_settings,
635 .set_settings = etherh_set_settings,
636 .get_drvinfo = etherh_get_drvinfo,
637};
638
b9a9b4b0
SH		 639static 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,
8cfd9e92
RK		 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,
b9a9b4b0 647 .ndo_validate_addr = eth_validate_addr,
a71558d0 648 .ndo_set_mac_address = eth_mac_addr,
b9a9b4b0
SH		 649 .ndo_change_mtu = eth_change_mtu,
650#ifdef CONFIG_NET_POLL_CONTROLLER
8cfd9e92 651 .ndo_poll_controller = __ei_poll,
b9a9b4b0
SH		 652#endif
653};
654
1da177e4
LT		 655static u32 etherh_regoffsets[16];
656static u32 etherm_regoffsets[16];
657
658static int __init
659etherh_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;
36149f02 665 int ret;
1da177e4
LT		 666
667 etherh_banner();
668
669 ret = ecard_request_resources(ec);
670 if (ret)
671 goto out;
672
6c3561b0 673 dev = ____alloc_ei_netdev(sizeof(struct etherh_priv));
1da177e4
LT		 674 if (!dev) {
675 ret = -ENOMEM;
676 goto release;
677 }
678
1da177e4
LT		 679 SET_NETDEV_DEV(dev, &ec->dev);
680
b9a9b4b0 681 dev->netdev_ops = &etherh_netdev_ops;
1da177e4
LT		 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;
10bdaaa0 700 eh->memc = ecardm_iomap(ec, ECARD_RES_MEMC, 0, PAGE_SIZE);
1da177e4
LT		 701 if (!eh->memc) {
702 ret = -ENOMEM;
703 goto free;
704 }
705
706 eh->ctrl_port = eh->memc;
707 if (data->ctrl_ioc) {
10bdaaa0 708 eh->ioc_fast = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, PAGE_SIZE);
1da177e4
LT		 709 if (!eh->ioc_fast) {
710 ret = -ENOMEM;
711 goto free;
712 }
713 eh->ctrl_port = eh->ioc_fast;
714 }
715
c7e78876 716 dev->base_addr = (unsigned long)eh->memc + data->ns8390_offset;
1da177e4
LT		 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) {
c7b87f3d 724 ecard_setirq(ec, &etherh_ops, eh);
1da177e4
LT		 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);
6c3561b0 755 __NS8390_init(dev, 0);
1da177e4
LT		 756
757 ret = register_netdev(dev);
758 if (ret)
759 goto free;
760
e174961c
JB		 761 printk(KERN_INFO "%s: %s in slot %d, %pM\n",
762 dev->name, data->name, ec->slot_no, dev->dev_addr);
1da177e4
LT		 763
764 ecard_set_drvdata(ec, dev);
765
766 return 0;
767
768 free:
1da177e4
LT		 769 free_netdev(dev);
770 release:
771 ecard_release_resources(ec);
772 out:
773 return ret;
774}
775
776static void __devexit etherh_remove(struct expansion_card *ec)
777{
778 struct net_device *dev = ecard_get_drvdata(ec);
1da177e4
LT		 779
780 ecard_set_drvdata(ec, NULL);
781
782 unregister_netdev(dev);
1da177e4 783
1da177e4
LT		 784 free_netdev(dev);
785
786 ecard_release_resources(ec);
787}
788
789static 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
799static 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
810static 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
820static 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
830static 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
838static 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
847static 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
859static void __exit etherh_exit(void)
860{
861 ecard_remove_driver(&etherh_driver);
862}
863
864module_init(etherh_init);
865module_exit(etherh_exit);
Clone of davem's net-next-2.6 tree