?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 2.6.17.7
[linux/fpc-iii.git] / drivers / net / pcmcia / fmvj18x_cs.c
blob09b11761cdfabf6a4acf700cc2b4dfca0791391c
1 /*======================================================================
2 fmvj18x_cs.c 2.8 2002/03/23
3
4 A fmvj18x (and its compatibles) PCMCIA client driver
5
6 Contributed by Shingo Fujimoto, shingo@flab.fujitsu.co.jp
7
8 TDK LAK-CD021 and CONTEC C-NET(PC)C support added by
9 Nobuhiro Katayama, kata-n@po.iijnet.or.jp
10
11 The PCMCIA client code is based on code written by David Hinds.
12 Network code is based on the "FMV-18x driver" by Yutaka TAMIYA
13 but is actually largely Donald Becker's AT1700 driver, which
14 carries the following attribution:
15
16 Written 1993-94 by Donald Becker.
17
18 Copyright 1993 United States Government as represented by the
19 Director, National Security Agency.
20
21 This software may be used and distributed according to the terms
22 of the GNU General Public License, incorporated herein by reference.
23
24 The author may be reached as becker@scyld.com, or C/O
25 Scyld Computing Corporation
26 410 Severn Ave., Suite 210
27 Annapolis MD 21403
28
29 ======================================================================*/
30
31 #define DRV_NAME "fmvj18x_cs"
32 #define DRV_VERSION "2.8"
33
34 #include <linux/module.h>
35 #include <linux/kernel.h>
36 #include <linux/init.h>
37 #include <linux/ptrace.h>
38 #include <linux/slab.h>
39 #include <linux/string.h>
40 #include <linux/timer.h>
41 #include <linux/interrupt.h>
42 #include <linux/in.h>
43 #include <linux/delay.h>
44 #include <linux/ethtool.h>
45 #include <linux/netdevice.h>
46 #include <linux/etherdevice.h>
47 #include <linux/skbuff.h>
48 #include <linux/if_arp.h>
49 #include <linux/ioport.h>
50 #include <linux/crc32.h>
51
52 #include <pcmcia/cs_types.h>
53 #include <pcmcia/cs.h>
54 #include <pcmcia/cistpl.h>
55 #include <pcmcia/ciscode.h>
56 #include <pcmcia/ds.h>
57
58 #include <asm/uaccess.h>
59 #include <asm/io.h>
60 #include <asm/system.h>
61
62 /*====================================================================*/
63
64 /* Module parameters */
65
66 MODULE_DESCRIPTION("fmvj18x and compatible PCMCIA ethernet driver");
67 MODULE_LICENSE("GPL");
68
69 #define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0)
70
71 /* SRAM configuration */
72 /* 0:4KB*2 TX buffer else:8KB*2 TX buffer */
73 INT_MODULE_PARM(sram_config, 0);
74
75 #ifdef PCMCIA_DEBUG
76 INT_MODULE_PARM(pc_debug, PCMCIA_DEBUG);
77 #define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args)
78 static char *version = DRV_NAME ".c " DRV_VERSION " 2002/03/23";
79 #else
80 #define DEBUG(n, args...)
81 #endif
82
83 /*====================================================================*/
84 /*
85 PCMCIA event handlers
86 */
87 static int fmvj18x_config(struct pcmcia_device *link);
88 static int fmvj18x_get_hwinfo(struct pcmcia_device *link, u_char *node_id);
89 static int fmvj18x_setup_mfc(struct pcmcia_device *link);
90 static void fmvj18x_release(struct pcmcia_device *link);
91 static void fmvj18x_detach(struct pcmcia_device *p_dev);
92
93 /*
94 LAN controller(MBH86960A) specific routines
95 */
96 static int fjn_config(struct net_device *dev, struct ifmap *map);
97 static int fjn_open(struct net_device *dev);
98 static int fjn_close(struct net_device *dev);
99 static int fjn_start_xmit(struct sk_buff *skb, struct net_device *dev);
100 static irqreturn_t fjn_interrupt(int irq, void *dev_id, struct pt_regs *regs);
101 static void fjn_rx(struct net_device *dev);
102 static void fjn_reset(struct net_device *dev);
103 static struct net_device_stats *fjn_get_stats(struct net_device *dev);
104 static void set_rx_mode(struct net_device *dev);
105 static void fjn_tx_timeout(struct net_device *dev);
106 static struct ethtool_ops netdev_ethtool_ops;
107
108 /*
109 card type
110 */
111 typedef enum { MBH10302, MBH10304, TDK, CONTEC, LA501, UNGERMANN,
112 XXX10304
113 } cardtype_t;
114
115 /*
116 driver specific data structure
117 */
118 typedef struct local_info_t {
119 struct pcmcia_device *p_dev;
120 dev_node_t node;
121 struct net_device_stats stats;
122 long open_time;
123 uint tx_started:1;
124 uint tx_queue;
125 u_short tx_queue_len;
126 cardtype_t cardtype;
127 u_short sent;
128 } local_info_t;
129
130 #define MC_FILTERBREAK 64
131
132 /*====================================================================*/
133 /*
134 ioport offset from the base address
135 */
136 #define TX_STATUS 0 /* transmit status register */
137 #define RX_STATUS 1 /* receive status register */
138 #define TX_INTR 2 /* transmit interrupt mask register */
139 #define RX_INTR 3 /* receive interrupt mask register */
140 #define TX_MODE 4 /* transmit mode register */
141 #define RX_MODE 5 /* receive mode register */
142 #define CONFIG_0 6 /* configuration register 0 */
143 #define CONFIG_1 7 /* configuration register 1 */
144
145 #define NODE_ID 8 /* node ID register (bank 0) */
146 #define MAR_ADR 8 /* multicast address registers (bank 1) */
147
148 #define DATAPORT 8 /* buffer mem port registers (bank 2) */
149 #define TX_START 10 /* transmit start register */
150 #define COL_CTRL 11 /* 16 collision control register */
151 #define BMPR12 12 /* reserved */
152 #define BMPR13 13 /* reserved */
153 #define RX_SKIP 14 /* skip received packet register */
154
155 #define LAN_CTRL 16 /* LAN card control register */
156
157 #define MAC_ID 0x1a /* hardware address */
158 #define UNGERMANN_MAC_ID 0x18 /* UNGERMANN-BASS hardware address */
159
160 /*
161 control bits
162 */
163 #define ENA_TMT_OK 0x80
164 #define ENA_TMT_REC 0x20
165 #define ENA_COL 0x04
166 #define ENA_16_COL 0x02
167 #define ENA_TBUS_ERR 0x01
168
169 #define ENA_PKT_RDY 0x80
170 #define ENA_BUS_ERR 0x40
171 #define ENA_LEN_ERR 0x08
172 #define ENA_ALG_ERR 0x04
173 #define ENA_CRC_ERR 0x02
174 #define ENA_OVR_FLO 0x01
175
176 /* flags */
177 #define F_TMT_RDY 0x80 /* can accept new packet */
178 #define F_NET_BSY 0x40 /* carrier is detected */
179 #define F_TMT_OK 0x20 /* send packet successfully */
180 #define F_SRT_PKT 0x10 /* short packet error */
181 #define F_COL_ERR 0x04 /* collision error */
182 #define F_16_COL 0x02 /* 16 collision error */
183 #define F_TBUS_ERR 0x01 /* bus read error */
184
185 #define F_PKT_RDY 0x80 /* packet(s) in buffer */
186 #define F_BUS_ERR 0x40 /* bus read error */
187 #define F_LEN_ERR 0x08 /* short packet */
188 #define F_ALG_ERR 0x04 /* frame error */
189 #define F_CRC_ERR 0x02 /* CRC error */
190 #define F_OVR_FLO 0x01 /* overflow error */
191
192 #define F_BUF_EMP 0x40 /* receive buffer is empty */
193
194 #define F_SKP_PKT 0x05 /* drop packet in buffer */
195
196 /* default bitmaps */
197 #define D_TX_INTR ( ENA_TMT_OK )
198 #define D_RX_INTR ( ENA_PKT_RDY | ENA_LEN_ERR \
199 | ENA_ALG_ERR | ENA_CRC_ERR | ENA_OVR_FLO )
200 #define TX_STAT_M ( F_TMT_RDY )
201 #define RX_STAT_M ( F_PKT_RDY | F_LEN_ERR \
202 | F_ALG_ERR | F_CRC_ERR | F_OVR_FLO )
203
204 /* commands */
205 #define D_TX_MODE 0x06 /* no tests, detect carrier */
206 #define ID_MATCHED 0x02 /* (RX_MODE) */
207 #define RECV_ALL 0x03 /* (RX_MODE) */
208 #define CONFIG0_DFL 0x5a /* 16bit bus, 4K x 2 Tx queues */
209 #define CONFIG0_DFL_1 0x5e /* 16bit bus, 8K x 2 Tx queues */
210 #define CONFIG0_RST 0xda /* Data Link Controller off (CONFIG_0) */
211 #define CONFIG0_RST_1 0xde /* Data Link Controller off (CONFIG_0) */
212 #define BANK_0 0xa0 /* bank 0 (CONFIG_1) */
213 #define BANK_1 0xa4 /* bank 1 (CONFIG_1) */
214 #define BANK_2 0xa8 /* bank 2 (CONFIG_1) */
215 #define CHIP_OFF 0x80 /* contrl chip power off (CONFIG_1) */
216 #define DO_TX 0x80 /* do transmit packet */
217 #define SEND_PKT 0x81 /* send a packet */
218 #define AUTO_MODE 0x07 /* Auto skip packet on 16 col detected */
219 #define MANU_MODE 0x03 /* Stop and skip packet on 16 col */
220 #define TDK_AUTO_MODE 0x47 /* Auto skip packet on 16 col detected */
221 #define TDK_MANU_MODE 0x43 /* Stop and skip packet on 16 col */
222 #define INTR_OFF 0x0d /* LAN controller ignores interrupts */
223 #define INTR_ON 0x1d /* LAN controller will catch interrupts */
224
225 #define TX_TIMEOUT ((400*HZ)/1000)
226
227 #define BANK_0U 0x20 /* bank 0 (CONFIG_1) */
228 #define BANK_1U 0x24 /* bank 1 (CONFIG_1) */
229 #define BANK_2U 0x28 /* bank 2 (CONFIG_1) */
230
231 static int fmvj18x_probe(struct pcmcia_device *link)
232 {
233 local_info_t *lp;
234 struct net_device *dev;
235
236 DEBUG(0, "fmvj18x_attach()\n");
237
238 /* Make up a FMVJ18x specific data structure */
239 dev = alloc_etherdev(sizeof(local_info_t));
240 if (!dev)
241 return -ENOMEM;
242 lp = netdev_priv(dev);
243 link->priv = dev;
244 lp->p_dev = link;
245
246 /* The io structure describes IO port mapping */
247 link->io.NumPorts1 = 32;
248 link->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
249 link->io.IOAddrLines = 5;
250
251 /* Interrupt setup */
252 link->irq.Attributes = IRQ_TYPE_EXCLUSIVE | IRQ_HANDLE_PRESENT;
253 link->irq.IRQInfo1 = IRQ_LEVEL_ID;
254 link->irq.Handler = &fjn_interrupt;
255 link->irq.Instance = dev;
256
257 /* General socket configuration */
258 link->conf.Attributes = CONF_ENABLE_IRQ;
259 link->conf.IntType = INT_MEMORY_AND_IO;
260
261 /* The FMVJ18x specific entries in the device structure. */
262 SET_MODULE_OWNER(dev);
263 dev->hard_start_xmit = &fjn_start_xmit;
264 dev->set_config = &fjn_config;
265 dev->get_stats = &fjn_get_stats;
266 dev->set_multicast_list = &set_rx_mode;
267 dev->open = &fjn_open;
268 dev->stop = &fjn_close;
269 #ifdef HAVE_TX_TIMEOUT
270 dev->tx_timeout = fjn_tx_timeout;
271 dev->watchdog_timeo = TX_TIMEOUT;
272 #endif
273 SET_ETHTOOL_OPS(dev, &netdev_ethtool_ops);
274
275 return fmvj18x_config(link);
276 } /* fmvj18x_attach */
277
278 /*====================================================================*/
279
280 static void fmvj18x_detach(struct pcmcia_device *link)
281 {
282 struct net_device *dev = link->priv;
283
284 DEBUG(0, "fmvj18x_detach(0x%p)\n", link);
285
286 if (link->dev_node)
287 unregister_netdev(dev);
288
289 fmvj18x_release(link);
290
291 free_netdev(dev);
292 } /* fmvj18x_detach */
293
294 /*====================================================================*/
295
296 #define CS_CHECK(fn, ret) \
297 do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
298
299 static int mfc_try_io_port(struct pcmcia_device *link)
300 {
301 int i, ret;
302 static const kio_addr_t serial_base[5] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, 0x0 };
303
304 for (i = 0; i < 5; i++) {
305 link->io.BasePort2 = serial_base[i];
306 link->io.Attributes2 = IO_DATA_PATH_WIDTH_8;
307 if (link->io.BasePort2 == 0) {
308 link->io.NumPorts2 = 0;
309 printk(KERN_NOTICE "fmvj18x_cs: out of resource for serial\n");
310 }
311 ret = pcmcia_request_io(link, &link->io);
312 if (ret == CS_SUCCESS) return ret;
313 }
314 return ret;
315 }
316
317 static int ungermann_try_io_port(struct pcmcia_device *link)
318 {
319 int ret;
320 kio_addr_t ioaddr;
321 /*
322 Ungermann-Bass Access/CARD accepts 0x300,0x320,0x340,0x360
323 0x380,0x3c0 only for ioport.
324 */
325 for (ioaddr = 0x300; ioaddr < 0x3e0; ioaddr += 0x20) {
326 link->io.BasePort1 = ioaddr;
327 ret = pcmcia_request_io(link, &link->io);
328 if (ret == CS_SUCCESS) {
329 /* calculate ConfigIndex value */
330 link->conf.ConfigIndex =
331 ((link->io.BasePort1 & 0x0f0) >> 3) | 0x22;
332 return ret;
333 }
334 }
335 return ret; /* RequestIO failed */
336 }
337
338 static int fmvj18x_config(struct pcmcia_device *link)
339 {
340 struct net_device *dev = link->priv;
341 local_info_t *lp = netdev_priv(dev);
342 tuple_t tuple;
343 cisparse_t parse;
344 u_short buf[32];
345 int i, last_fn, last_ret, ret;
346 kio_addr_t ioaddr;
347 cardtype_t cardtype;
348 char *card_name = "unknown";
349 u_char *node_id;
350
351 DEBUG(0, "fmvj18x_config(0x%p)\n", link);
352
353 /*
354 This reads the card's CONFIG tuple to find its configuration
355 registers.
356 */
357 tuple.DesiredTuple = CISTPL_CONFIG;
358 CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
359 tuple.TupleData = (u_char *)buf;
360 tuple.TupleDataMax = 64;
361 tuple.TupleOffset = 0;
362 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
363 CS_CHECK(ParseTuple, pcmcia_parse_tuple(link, &tuple, &parse));
364
365 link->conf.ConfigBase = parse.config.base;
366 link->conf.Present = parse.config.rmask[0];
367
368 tuple.DesiredTuple = CISTPL_FUNCE;
369 tuple.TupleOffset = 0;
370 if (pcmcia_get_first_tuple(link, &tuple) == CS_SUCCESS) {
371 /* Yes, I have CISTPL_FUNCE. Let's check CISTPL_MANFID */
372 tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
373 CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
374 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
375 CS_CHECK(ParseTuple, pcmcia_parse_tuple(link, &tuple, &parse));
376 link->conf.ConfigIndex = parse.cftable_entry.index;
377 tuple.DesiredTuple = CISTPL_MANFID;
378 if (pcmcia_get_first_tuple(link, &tuple) == CS_SUCCESS)
379 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
380 else
381 buf[0] = 0xffff;
382 switch (le16_to_cpu(buf[0])) {
383 case MANFID_TDK:
384 cardtype = TDK;
385 if (le16_to_cpu(buf[1]) == PRODID_TDK_GN3410
386 || le16_to_cpu(buf[1]) == PRODID_TDK_NP9610
387 || le16_to_cpu(buf[1]) == PRODID_TDK_MN3200) {
388 /* MultiFunction Card */
389 link->conf.ConfigBase = 0x800;
390 link->conf.ConfigIndex = 0x47;
391 link->io.NumPorts2 = 8;
392 }
393 break;
394 case MANFID_CONTEC:
395 cardtype = CONTEC;
396 break;
397 case MANFID_FUJITSU:
398 if (le16_to_cpu(buf[1]) == PRODID_FUJITSU_MBH10302)
399 /* RATOC REX-5588/9822/4886's PRODID are 0004(=MBH10302),
400 but these are MBH10304 based card. */
401 cardtype = MBH10304;
402 else if (le16_to_cpu(buf[1]) == PRODID_FUJITSU_MBH10304)
403 cardtype = MBH10304;
404 else
405 cardtype = LA501;
406 break;
407 default:
408 cardtype = MBH10304;
409 }
410 } else {
411 /* old type card */
412 tuple.DesiredTuple = CISTPL_MANFID;
413 if (pcmcia_get_first_tuple(link, &tuple) == CS_SUCCESS)
414 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
415 else
416 buf[0] = 0xffff;
417 switch (le16_to_cpu(buf[0])) {
418 case MANFID_FUJITSU:
419 if (le16_to_cpu(buf[1]) == PRODID_FUJITSU_MBH10304) {
420 cardtype = XXX10304; /* MBH10304 with buggy CIS */
421 link->conf.ConfigIndex = 0x20;
422 } else {
423 cardtype = MBH10302; /* NextCom NC5310, etc. */
424 link->conf.ConfigIndex = 1;
425 }
426 break;
427 case MANFID_UNGERMANN:
428 cardtype = UNGERMANN;
429 break;
430 default:
431 cardtype = MBH10302;
432 link->conf.ConfigIndex = 1;
433 }
434 }
435
436 if (link->io.NumPorts2 != 0) {
437 link->irq.Attributes =
438 IRQ_TYPE_DYNAMIC_SHARING|IRQ_FIRST_SHARED|IRQ_HANDLE_PRESENT;
439 ret = mfc_try_io_port(link);
440 if (ret != CS_SUCCESS) goto cs_failed;
441 } else if (cardtype == UNGERMANN) {
442 ret = ungermann_try_io_port(link);
443 if (ret != CS_SUCCESS) goto cs_failed;
444 } else {
445 CS_CHECK(RequestIO, pcmcia_request_io(link, &link->io));
446 }
447 CS_CHECK(RequestIRQ, pcmcia_request_irq(link, &link->irq));
448 CS_CHECK(RequestConfiguration, pcmcia_request_configuration(link, &link->conf));
449 dev->irq = link->irq.AssignedIRQ;
450 dev->base_addr = link->io.BasePort1;
451
452 if (link->io.BasePort2 != 0)
453 fmvj18x_setup_mfc(link);
454
455 ioaddr = dev->base_addr;
456
457 /* Reset controller */
458 if (sram_config == 0)
459 outb(CONFIG0_RST, ioaddr + CONFIG_0);
460 else
461 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
462
463 /* Power On chip and select bank 0 */
464 if (cardtype == MBH10302)
465 outb(BANK_0, ioaddr + CONFIG_1);
466 else
467 outb(BANK_0U, ioaddr + CONFIG_1);
468
469 /* Set hardware address */
470 switch (cardtype) {
471 case MBH10304:
472 case TDK:
473 case LA501:
474 case CONTEC:
475 tuple.DesiredTuple = CISTPL_FUNCE;
476 tuple.TupleOffset = 0;
477 CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
478 tuple.TupleOffset = 0;
479 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
480 if (cardtype == MBH10304) {
481 /* MBH10304's CIS_FUNCE is corrupted */
482 node_id = &(tuple.TupleData[5]);
483 card_name = "FMV-J182";
484 } else {
485 while (tuple.TupleData[0] != CISTPL_FUNCE_LAN_NODE_ID ) {
486 CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(link, &tuple));
487 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
488 }
489 node_id = &(tuple.TupleData[2]);
490 if( cardtype == TDK ) {
491 card_name = "TDK LAK-CD021";
492 } else if( cardtype == LA501 ) {
493 card_name = "LA501";
494 } else {
495 card_name = "C-NET(PC)C";
496 }
497 }
498 /* Read MACID from CIS */
499 for (i = 0; i < 6; i++)
500 dev->dev_addr[i] = node_id[i];
501 break;
502 case UNGERMANN:
503 /* Read MACID from register */
504 for (i = 0; i < 6; i++)
505 dev->dev_addr[i] = inb(ioaddr + UNGERMANN_MAC_ID + i);
506 card_name = "Access/CARD";
507 break;
508 case XXX10304:
509 /* Read MACID from Buggy CIS */
510 if (fmvj18x_get_hwinfo(link, tuple.TupleData) == -1) {
511 printk(KERN_NOTICE "fmvj18x_cs: unable to read hardware net address.\n");
512 goto failed;
513 }
514 for (i = 0 ; i < 6; i++) {
515 dev->dev_addr[i] = tuple.TupleData[i];
516 }
517 card_name = "FMV-J182";
518 break;
519 case MBH10302:
520 default:
521 /* Read MACID from register */
522 for (i = 0; i < 6; i++)
523 dev->dev_addr[i] = inb(ioaddr + MAC_ID + i);
524 card_name = "FMV-J181";
525 break;
526 }
527
528 lp->cardtype = cardtype;
529 link->dev_node = &lp->node;
530 SET_NETDEV_DEV(dev, &handle_to_dev(link));
531
532 if (register_netdev(dev) != 0) {
533 printk(KERN_NOTICE "fmvj18x_cs: register_netdev() failed\n");
534 link->dev_node = NULL;
535 goto failed;
536 }
537
538 strcpy(lp->node.dev_name, dev->name);
539
540 /* print current configuration */
541 printk(KERN_INFO "%s: %s, sram %s, port %#3lx, irq %d, hw_addr ",
542 dev->name, card_name, sram_config == 0 ? "4K TX*2" : "8K TX*2",
543 dev->base_addr, dev->irq);
544 for (i = 0; i < 6; i++)
545 printk("%02X%s", dev->dev_addr[i], ((i<5) ? ":" : "\n"));
546
547 return 0;
548
549 cs_failed:
550 /* All Card Services errors end up here */
551 cs_error(link, last_fn, last_ret);
552 failed:
553 fmvj18x_release(link);
554 return -ENODEV;
555 } /* fmvj18x_config */
556 /*====================================================================*/
557
558 static int fmvj18x_get_hwinfo(struct pcmcia_device *link, u_char *node_id)
559 {
560 win_req_t req;
561 memreq_t mem;
562 u_char __iomem *base;
563 int i, j;
564
565 /* Allocate a small memory window */
566 req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
567 req.Base = 0; req.Size = 0;
568 req.AccessSpeed = 0;
569 i = pcmcia_request_window(&link, &req, &link->win);
570 if (i != CS_SUCCESS) {
571 cs_error(link, RequestWindow, i);
572 return -1;
573 }
574
575 base = ioremap(req.Base, req.Size);
576 mem.Page = 0;
577 mem.CardOffset = 0;
578 pcmcia_map_mem_page(link->win, &mem);
579
580 /*
581 * MBH10304 CISTPL_FUNCE_LAN_NODE_ID format
582 * 22 0d xx xx xx 04 06 yy yy yy yy yy yy ff
583 * 'xx' is garbage.
584 * 'yy' is MAC address.
585 */
586 for (i = 0; i < 0x200; i++) {
587 if (readb(base+i*2) == 0x22) {
588 if (readb(base+(i-1)*2) == 0xff
589 && readb(base+(i+5)*2) == 0x04
590 && readb(base+(i+6)*2) == 0x06
591 && readb(base+(i+13)*2) == 0xff)
592 break;
593 }
594 }
595
596 if (i != 0x200) {
597 for (j = 0 ; j < 6; j++,i++) {
598 node_id[j] = readb(base+(i+7)*2);
599 }
600 }
601
602 iounmap(base);
603 j = pcmcia_release_window(link->win);
604 if (j != CS_SUCCESS)
605 cs_error(link, ReleaseWindow, j);
606 return (i != 0x200) ? 0 : -1;
607
608 } /* fmvj18x_get_hwinfo */
609 /*====================================================================*/
610
611 static int fmvj18x_setup_mfc(struct pcmcia_device *link)
612 {
613 win_req_t req;
614 memreq_t mem;
615 u_char __iomem *base;
616 int i, j;
617 struct net_device *dev = link->priv;
618 kio_addr_t ioaddr;
619
620 /* Allocate a small memory window */
621 req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
622 req.Base = 0; req.Size = 0;
623 req.AccessSpeed = 0;
624 i = pcmcia_request_window(&link, &req, &link->win);
625 if (i != CS_SUCCESS) {
626 cs_error(link, RequestWindow, i);
627 return -1;
628 }
629
630 base = ioremap(req.Base, req.Size);
631 mem.Page = 0;
632 mem.CardOffset = 0;
633 pcmcia_map_mem_page(link->win, &mem);
634
635 ioaddr = dev->base_addr;
636 writeb(0x47, base+0x800); /* Config Option Register of LAN */
637 writeb(0x0, base+0x802); /* Config and Status Register */
638
639 writeb(ioaddr & 0xff, base+0x80a); /* I/O Base(Low) of LAN */
640 writeb((ioaddr >> 8) & 0xff, base+0x80c); /* I/O Base(High) of LAN */
641
642 writeb(0x45, base+0x820); /* Config Option Register of Modem */
643 writeb(0x8, base+0x822); /* Config and Status Register */
644
645 iounmap(base);
646 j = pcmcia_release_window(link->win);
647 if (j != CS_SUCCESS)
648 cs_error(link, ReleaseWindow, j);
649 return 0;
650
651 }
652 /*====================================================================*/
653
654 static void fmvj18x_release(struct pcmcia_device *link)
655 {
656 DEBUG(0, "fmvj18x_release(0x%p)\n", link);
657 pcmcia_disable_device(link);
658 }
659
660 static int fmvj18x_suspend(struct pcmcia_device *link)
661 {
662 struct net_device *dev = link->priv;
663
664 if (link->open)
665 netif_device_detach(dev);
666
667 return 0;
668 }
669
670 static int fmvj18x_resume(struct pcmcia_device *link)
671 {
672 struct net_device *dev = link->priv;
673
674 if (link->open) {
675 fjn_reset(dev);
676 netif_device_attach(dev);
677 }
678
679 return 0;
680 }
681
682 /*====================================================================*/
683
684 static struct pcmcia_device_id fmvj18x_ids[] = {
685 PCMCIA_DEVICE_MANF_CARD(0x0004, 0x0004),
686 PCMCIA_DEVICE_PROD_ID12("EAGLE Technology", "NE200 ETHERNET LAN MBH10302 04", 0x528c88c4, 0x74f91e59),
687 PCMCIA_DEVICE_PROD_ID12("Eiger Labs,Inc", "EPX-10BT PC Card Ethernet 10BT", 0x53af556e, 0x877f9922),
688 PCMCIA_DEVICE_PROD_ID12("Eiger labs,Inc.", "EPX-10BT PC Card Ethernet 10BT", 0xf47e6c66, 0x877f9922),
689 PCMCIA_DEVICE_PROD_ID12("FUJITSU", "LAN Card(FMV-J182)", 0x6ee5a3d8, 0x5baf31db),
690 PCMCIA_DEVICE_PROD_ID12("FUJITSU", "MBH10308", 0x6ee5a3d8, 0x3f04875e),
691 PCMCIA_DEVICE_PROD_ID12("FUJITSU TOWA", "LA501", 0xb8451188, 0x12939ba2),
692 PCMCIA_DEVICE_PROD_ID12("HITACHI", "HT-4840-11", 0xf4f43949, 0x773910f4),
693 PCMCIA_DEVICE_PROD_ID12("NextComK.K.", "NC5310B Ver1.0 ", 0x8cef4d3a, 0x075fc7b6),
694 PCMCIA_DEVICE_PROD_ID12("NextComK.K.", "NC5310 Ver1.0 ", 0x8cef4d3a, 0xbccf43e6),
695 PCMCIA_DEVICE_PROD_ID12("RATOC System Inc.", "10BASE_T CARD R280", 0x85c10e17, 0xd9413666),
696 PCMCIA_DEVICE_PROD_ID12("TDK", "LAC-CD02x", 0x1eae9475, 0x8fa0ee70),
697 PCMCIA_DEVICE_PROD_ID12("TDK", "LAC-CF010", 0x1eae9475, 0x7683bc9a),
698 PCMCIA_DEVICE_PROD_ID1("CONTEC Co.,Ltd.", 0x58d8fee2),
699 PCMCIA_DEVICE_PROD_ID1("PCMCIA LAN MBH10304 ES", 0x2599f454),
700 PCMCIA_DEVICE_PROD_ID1("PCMCIA MBH10302", 0x8f4005da),
701 PCMCIA_DEVICE_PROD_ID1("UBKK,V2.0", 0x90888080),
702 PCMCIA_PFC_DEVICE_PROD_ID12(0, "TDK", "GlobalNetworker 3410/3412", 0x1eae9475, 0xd9a93bed),
703 PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0105, 0x0d0a),
704 PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0105, 0x0e0a),
705 PCMCIA_DEVICE_NULL,
706 };
707 MODULE_DEVICE_TABLE(pcmcia, fmvj18x_ids);
708
709 static struct pcmcia_driver fmvj18x_cs_driver = {
710 .owner = THIS_MODULE,
711 .drv = {
712 .name = "fmvj18x_cs",
713 },
714 .probe = fmvj18x_probe,
715 .remove = fmvj18x_detach,
716 .id_table = fmvj18x_ids,
717 .suspend = fmvj18x_suspend,
718 .resume = fmvj18x_resume,
719 };
720
721 static int __init init_fmvj18x_cs(void)
722 {
723 return pcmcia_register_driver(&fmvj18x_cs_driver);
724 }
725
726 static void __exit exit_fmvj18x_cs(void)
727 {
728 pcmcia_unregister_driver(&fmvj18x_cs_driver);
729 }
730
731 module_init(init_fmvj18x_cs);
732 module_exit(exit_fmvj18x_cs);
733
734 /*====================================================================*/
735
736 static irqreturn_t fjn_interrupt(int irq, void *dev_id, struct pt_regs *regs)
737 {
738 struct net_device *dev = dev_id;
739 local_info_t *lp = netdev_priv(dev);
740 kio_addr_t ioaddr;
741 unsigned short tx_stat, rx_stat;
742
743 if (lp == NULL) {
744 printk(KERN_NOTICE "fjn_interrupt(): irq %d for "
745 "unknown device.\n", irq);
746 return IRQ_NONE;
747 }
748 ioaddr = dev->base_addr;
749
750 /* avoid multiple interrupts */
751 outw(0x0000, ioaddr + TX_INTR);
752
753 /* wait for a while */
754 udelay(1);
755
756 /* get status */
757 tx_stat = inb(ioaddr + TX_STATUS);
758 rx_stat = inb(ioaddr + RX_STATUS);
759
760 /* clear status */
761 outb(tx_stat, ioaddr + TX_STATUS);
762 outb(rx_stat, ioaddr + RX_STATUS);
763
764 DEBUG(4, "%s: interrupt, rx_status %02x.\n", dev->name, rx_stat);
765 DEBUG(4, " tx_status %02x.\n", tx_stat);
766
767 if (rx_stat || (inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
768 /* there is packet(s) in rx buffer */
769 fjn_rx(dev);
770 }
771 if (tx_stat & F_TMT_RDY) {
772 lp->stats.tx_packets += lp->sent ;
773 lp->sent = 0 ;
774 if (lp->tx_queue) {
775 outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
776 lp->sent = lp->tx_queue ;
777 lp->tx_queue = 0;
778 lp->tx_queue_len = 0;
779 dev->trans_start = jiffies;
780 } else {
781 lp->tx_started = 0;
782 }
783 netif_wake_queue(dev);
784 }
785 DEBUG(4, "%s: exiting interrupt,\n", dev->name);
786 DEBUG(4, " tx_status %02x, rx_status %02x.\n", tx_stat, rx_stat);
787
788 outb(D_TX_INTR, ioaddr + TX_INTR);
789 outb(D_RX_INTR, ioaddr + RX_INTR);
790 return IRQ_HANDLED;
791
792 } /* fjn_interrupt */
793
794 /*====================================================================*/
795
796 static void fjn_tx_timeout(struct net_device *dev)
797 {
798 struct local_info_t *lp = netdev_priv(dev);
799 kio_addr_t ioaddr = dev->base_addr;
800
801 printk(KERN_NOTICE "%s: transmit timed out with status %04x, %s?\n",
802 dev->name, htons(inw(ioaddr + TX_STATUS)),
803 inb(ioaddr + TX_STATUS) & F_TMT_RDY
804 ? "IRQ conflict" : "network cable problem");
805 printk(KERN_NOTICE "%s: timeout registers: %04x %04x %04x "
806 "%04x %04x %04x %04x %04x.\n",
807 dev->name, htons(inw(ioaddr + 0)),
808 htons(inw(ioaddr + 2)), htons(inw(ioaddr + 4)),
809 htons(inw(ioaddr + 6)), htons(inw(ioaddr + 8)),
810 htons(inw(ioaddr +10)), htons(inw(ioaddr +12)),
811 htons(inw(ioaddr +14)));
812 lp->stats.tx_errors++;
813 /* ToDo: We should try to restart the adaptor... */
814 local_irq_disable();
815 fjn_reset(dev);
816
817 lp->tx_started = 0;
818 lp->tx_queue = 0;
819 lp->tx_queue_len = 0;
820 lp->sent = 0;
821 lp->open_time = jiffies;
822 local_irq_enable();
823 netif_wake_queue(dev);
824 }
825
826 static int fjn_start_xmit(struct sk_buff *skb, struct net_device *dev)
827 {
828 struct local_info_t *lp = netdev_priv(dev);
829 kio_addr_t ioaddr = dev->base_addr;
830 short length = skb->len;
831
832 if (length < ETH_ZLEN)
833 {
834 skb = skb_padto(skb, ETH_ZLEN);
835 if (skb == NULL)
836 return 0;
837 length = ETH_ZLEN;
838 }
839
840 netif_stop_queue(dev);
841
842 {
843 unsigned char *buf = skb->data;
844
845 if (length > ETH_FRAME_LEN) {
846 printk(KERN_NOTICE "%s: Attempting to send a large packet"
847 " (%d bytes).\n", dev->name, length);
848 return 1;
849 }
850
851 DEBUG(4, "%s: Transmitting a packet of length %lu.\n",
852 dev->name, (unsigned long)skb->len);
853 lp->stats.tx_bytes += skb->len;
854
855 /* Disable both interrupts. */
856 outw(0x0000, ioaddr + TX_INTR);
857
858 /* wait for a while */
859 udelay(1);
860
861 outw(length, ioaddr + DATAPORT);
862 outsw(ioaddr + DATAPORT, buf, (length + 1) >> 1);
863
864 lp->tx_queue++;
865 lp->tx_queue_len += ((length+3) & ~1);
866
867 if (lp->tx_started == 0) {
868 /* If the Tx is idle, always trigger a transmit. */
869 outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
870 lp->sent = lp->tx_queue ;
871 lp->tx_queue = 0;
872 lp->tx_queue_len = 0;
873 dev->trans_start = jiffies;
874 lp->tx_started = 1;
875 netif_start_queue(dev);
876 } else {
877 if( sram_config == 0 ) {
878 if (lp->tx_queue_len < (4096 - (ETH_FRAME_LEN +2)) )
879 /* Yes, there is room for one more packet. */
880 netif_start_queue(dev);
881 } else {
882 if (lp->tx_queue_len < (8192 - (ETH_FRAME_LEN +2)) &&
883 lp->tx_queue < 127 )
884 /* Yes, there is room for one more packet. */
885 netif_start_queue(dev);
886 }
887 }
888
889 /* Re-enable interrupts */
890 outb(D_TX_INTR, ioaddr + TX_INTR);
891 outb(D_RX_INTR, ioaddr + RX_INTR);
892 }
893 dev_kfree_skb (skb);
894
895 return 0;
896 } /* fjn_start_xmit */
897
898 /*====================================================================*/
899
900 static void fjn_reset(struct net_device *dev)
901 {
902 struct local_info_t *lp = netdev_priv(dev);
903 kio_addr_t ioaddr = dev->base_addr;
904 int i;
905
906 DEBUG(4, "fjn_reset(%s) called.\n",dev->name);
907
908 /* Reset controller */
909 if( sram_config == 0 )
910 outb(CONFIG0_RST, ioaddr + CONFIG_0);
911 else
912 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
913
914 /* Power On chip and select bank 0 */
915 if (lp->cardtype == MBH10302)
916 outb(BANK_0, ioaddr + CONFIG_1);
917 else
918 outb(BANK_0U, ioaddr + CONFIG_1);
919
920 /* Set Tx modes */
921 outb(D_TX_MODE, ioaddr + TX_MODE);
922 /* set Rx modes */
923 outb(ID_MATCHED, ioaddr + RX_MODE);
924
925 /* Set hardware address */
926 for (i = 0; i < 6; i++)
927 outb(dev->dev_addr[i], ioaddr + NODE_ID + i);
928
929 /* (re)initialize the multicast table */
930 set_rx_mode(dev);
931
932 /* Switch to bank 2 (runtime mode) */
933 if (lp->cardtype == MBH10302)
934 outb(BANK_2, ioaddr + CONFIG_1);
935 else
936 outb(BANK_2U, ioaddr + CONFIG_1);
937
938 /* set 16col ctrl bits */
939 if( lp->cardtype == TDK || lp->cardtype == CONTEC)
940 outb(TDK_AUTO_MODE, ioaddr + COL_CTRL);
941 else
942 outb(AUTO_MODE, ioaddr + COL_CTRL);
943
944 /* clear Reserved Regs */
945 outb(0x00, ioaddr + BMPR12);
946 outb(0x00, ioaddr + BMPR13);
947
948 /* reset Skip packet reg. */
949 outb(0x01, ioaddr + RX_SKIP);
950
951 /* Enable Tx and Rx */
952 if( sram_config == 0 )
953 outb(CONFIG0_DFL, ioaddr + CONFIG_0);
954 else
955 outb(CONFIG0_DFL_1, ioaddr + CONFIG_0);
956
957 /* Init receive pointer ? */
958 inw(ioaddr + DATAPORT);
959 inw(ioaddr + DATAPORT);
960
961 /* Clear all status */
962 outb(0xff, ioaddr + TX_STATUS);
963 outb(0xff, ioaddr + RX_STATUS);
964
965 if (lp->cardtype == MBH10302)
966 outb(INTR_OFF, ioaddr + LAN_CTRL);
967
968 /* Turn on Rx interrupts */
969 outb(D_TX_INTR, ioaddr + TX_INTR);
970 outb(D_RX_INTR, ioaddr + RX_INTR);
971
972 /* Turn on interrupts from LAN card controller */
973 if (lp->cardtype == MBH10302)
974 outb(INTR_ON, ioaddr + LAN_CTRL);
975 } /* fjn_reset */
976
977 /*====================================================================*/
978
979 static void fjn_rx(struct net_device *dev)
980 {
981 struct local_info_t *lp = netdev_priv(dev);
982 kio_addr_t ioaddr = dev->base_addr;
983 int boguscount = 10; /* 5 -> 10: by agy 19940922 */
984
985 DEBUG(4, "%s: in rx_packet(), rx_status %02x.\n",
986 dev->name, inb(ioaddr + RX_STATUS));
987
988 while ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
989 u_short status = inw(ioaddr + DATAPORT);
990
991 DEBUG(4, "%s: Rxing packet mode %02x status %04x.\n",
992 dev->name, inb(ioaddr + RX_MODE), status);
993 #ifndef final_version
994 if (status == 0) {
995 outb(F_SKP_PKT, ioaddr + RX_SKIP);
996 break;
997 }
998 #endif
999 if ((status & 0xF0) != 0x20) { /* There was an error. */
1000 lp->stats.rx_errors++;
1001 if (status & F_LEN_ERR) lp->stats.rx_length_errors++;
1002 if (status & F_ALG_ERR) lp->stats.rx_frame_errors++;
1003 if (status & F_CRC_ERR) lp->stats.rx_crc_errors++;
1004 if (status & F_OVR_FLO) lp->stats.rx_over_errors++;
1005 } else {
1006 u_short pkt_len = inw(ioaddr + DATAPORT);
1007 /* Malloc up new buffer. */
1008 struct sk_buff *skb;
1009
1010 if (pkt_len > 1550) {
1011 printk(KERN_NOTICE "%s: The FMV-18x claimed a very "
1012 "large packet, size %d.\n", dev->name, pkt_len);
1013 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1014 lp->stats.rx_errors++;
1015 break;
1016 }
1017 skb = dev_alloc_skb(pkt_len+2);
1018 if (skb == NULL) {
1019 printk(KERN_NOTICE "%s: Memory squeeze, dropping "
1020 "packet (len %d).\n", dev->name, pkt_len);
1021 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1022 lp->stats.rx_dropped++;
1023 break;
1024 }
1025 skb->dev = dev;
1026
1027 skb_reserve(skb, 2);
1028 insw(ioaddr + DATAPORT, skb_put(skb, pkt_len),
1029 (pkt_len + 1) >> 1);
1030 skb->protocol = eth_type_trans(skb, dev);
1031
1032 #ifdef PCMCIA_DEBUG
1033 if (pc_debug > 5) {
1034 int i;
1035 printk(KERN_DEBUG "%s: Rxed packet of length %d: ",
1036 dev->name, pkt_len);
1037 for (i = 0; i < 14; i++)
1038 printk(" %02x", skb->data[i]);
1039 printk(".\n");
1040 }
1041 #endif
1042
1043 netif_rx(skb);
1044 dev->last_rx = jiffies;
1045 lp->stats.rx_packets++;
1046 lp->stats.rx_bytes += pkt_len;
1047 }
1048 if (--boguscount <= 0)
1049 break;
1050 }
1051
1052 /* If any worth-while packets have been received, dev_rint()
1053 has done a netif_wake_queue() for us and will work on them
1054 when we get to the bottom-half routine. */
1055 /*
1056 if (lp->cardtype != TDK) {
1057 int i;
1058 for (i = 0; i < 20; i++) {
1059 if ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == F_BUF_EMP)
1060 break;
1061 (void)inw(ioaddr + DATAPORT); /+ dummy status read +/
1062 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1063 }
1064
1065 if (i > 0)
1066 DEBUG(5, "%s: Exint Rx packet with mode %02x after "
1067 "%d ticks.\n", dev->name, inb(ioaddr + RX_MODE), i);
1068 }
1069 */
1070
1071 return;
1072 } /* fjn_rx */
1073
1074 /*====================================================================*/
1075
1076 static void netdev_get_drvinfo(struct net_device *dev,
1077 struct ethtool_drvinfo *info)
1078 {
1079 strcpy(info->driver, DRV_NAME);
1080 strcpy(info->version, DRV_VERSION);
1081 sprintf(info->bus_info, "PCMCIA 0x%lx", dev->base_addr);
1082 }
1083
1084 #ifdef PCMCIA_DEBUG
1085 static u32 netdev_get_msglevel(struct net_device *dev)
1086 {
1087 return pc_debug;
1088 }
1089
1090 static void netdev_set_msglevel(struct net_device *dev, u32 level)
1091 {
1092 pc_debug = level;
1093 }
1094 #endif /* PCMCIA_DEBUG */
1095
1096 static struct ethtool_ops netdev_ethtool_ops = {
1097 .get_drvinfo = netdev_get_drvinfo,
1098 #ifdef PCMCIA_DEBUG
1099 .get_msglevel = netdev_get_msglevel,
1100 .set_msglevel = netdev_set_msglevel,
1101 #endif /* PCMCIA_DEBUG */
1102 };
1103
1104 static int fjn_config(struct net_device *dev, struct ifmap *map){
1105 return 0;
1106 }
1107
1108 static int fjn_open(struct net_device *dev)
1109 {
1110 struct local_info_t *lp = netdev_priv(dev);
1111 struct pcmcia_device *link = lp->p_dev;
1112
1113 DEBUG(4, "fjn_open('%s').\n", dev->name);
1114
1115 if (!pcmcia_dev_present(link))
1116 return -ENODEV;
1117
1118 link->open++;
1119
1120 fjn_reset(dev);
1121
1122 lp->tx_started = 0;
1123 lp->tx_queue = 0;
1124 lp->tx_queue_len = 0;
1125 lp->open_time = jiffies;
1126 netif_start_queue(dev);
1127
1128 return 0;
1129 } /* fjn_open */
1130
1131 /*====================================================================*/
1132
1133 static int fjn_close(struct net_device *dev)
1134 {
1135 struct local_info_t *lp = netdev_priv(dev);
1136 struct pcmcia_device *link = lp->p_dev;
1137 kio_addr_t ioaddr = dev->base_addr;
1138
1139 DEBUG(4, "fjn_close('%s').\n", dev->name);
1140
1141 lp->open_time = 0;
1142 netif_stop_queue(dev);
1143
1144 /* Set configuration register 0 to disable Tx and Rx. */
1145 if( sram_config == 0 )
1146 outb(CONFIG0_RST ,ioaddr + CONFIG_0);
1147 else
1148 outb(CONFIG0_RST_1 ,ioaddr + CONFIG_0);
1149
1150 /* Update the statistics -- ToDo. */
1151
1152 /* Power-down the chip. Green, green, green! */
1153 outb(CHIP_OFF ,ioaddr + CONFIG_1);
1154
1155 /* Set the ethernet adaptor disable IRQ */
1156 if (lp->cardtype == MBH10302)
1157 outb(INTR_OFF, ioaddr + LAN_CTRL);
1158
1159 link->open--;
1160
1161 return 0;
1162 } /* fjn_close */
1163
1164 /*====================================================================*/
1165
1166 static struct net_device_stats *fjn_get_stats(struct net_device *dev)
1167 {
1168 local_info_t *lp = netdev_priv(dev);
1169 return &lp->stats;
1170 } /* fjn_get_stats */
1171
1172 /*====================================================================*/
1173
1174 /*
1175 Set the multicast/promiscuous mode for this adaptor.
1176 */
1177
1178 static void set_rx_mode(struct net_device *dev)
1179 {
1180 kio_addr_t ioaddr = dev->base_addr;
1181 u_char mc_filter[8]; /* Multicast hash filter */
1182 u_long flags;
1183 int i;
1184
1185 int saved_bank;
1186 int saved_config_0 = inb(ioaddr + CONFIG_0);
1187
1188 local_irq_save(flags);
1189
1190 /* Disable Tx and Rx */
1191 if (sram_config == 0)
1192 outb(CONFIG0_RST, ioaddr + CONFIG_0);
1193 else
1194 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
1195
1196 if (dev->flags & IFF_PROMISC) {
1197 /* Unconditionally log net taps. */
1198 printk("%s: Promiscuous mode enabled.\n", dev->name);
1199 memset(mc_filter, 0xff, sizeof(mc_filter));
1200 outb(3, ioaddr + RX_MODE); /* Enable promiscuous mode */
1201 } else if (dev->mc_count > MC_FILTERBREAK
1202 || (dev->flags & IFF_ALLMULTI)) {
1203 /* Too many to filter perfectly -- accept all multicasts. */
1204 memset(mc_filter, 0xff, sizeof(mc_filter));
1205 outb(2, ioaddr + RX_MODE); /* Use normal mode. */
1206 } else if (dev->mc_count == 0) {
1207 memset(mc_filter, 0x00, sizeof(mc_filter));
1208 outb(1, ioaddr + RX_MODE); /* Ignore almost all multicasts. */
1209 } else {
1210 struct dev_mc_list *mclist;
1211 int i;
1212
1213 memset(mc_filter, 0, sizeof(mc_filter));
1214 for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
1215 i++, mclist = mclist->next) {
1216 unsigned int bit =
1217 ether_crc_le(ETH_ALEN, mclist->dmi_addr) >> 26;
1218 mc_filter[bit >> 3] |= (1 << (bit & 7));
1219 }
1220 outb(2, ioaddr + RX_MODE); /* Use normal mode. */
1221 }
1222
1223 /* Switch to bank 1 and set the multicast table. */
1224 saved_bank = inb(ioaddr + CONFIG_1);
1225 outb(0xe4, ioaddr + CONFIG_1);
1226
1227 for (i = 0; i < 8; i++)
1228 outb(mc_filter[i], ioaddr + MAR_ADR + i);
1229 outb(saved_bank, ioaddr + CONFIG_1);
1230
1231 outb(saved_config_0, ioaddr + CONFIG_0);
1232
1233 local_irq_restore(flags);
1234 }
Linux with added FPC-III support