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