projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
IRQ: Maintain regs pointer globally rather than passing to IRQ handlers
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / net / pcmcia / fmvj18x_cs.c
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.9"
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);
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 const 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)
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 if (skb_padto(skb, ETH_ZLEN))
835 return 0;
836 length = ETH_ZLEN;
837 }
838
839 netif_stop_queue(dev);
840
841 {
842 unsigned char *buf = skb->data;
843
844 if (length > ETH_FRAME_LEN) {
845 printk(KERN_NOTICE "%s: Attempting to send a large packet"
846 " (%d bytes).\n", dev->name, length);
847 return 1;
848 }
849
850 DEBUG(4, "%s: Transmitting a packet of length %lu.\n",
851 dev->name, (unsigned long)skb->len);
852 lp->stats.tx_bytes += skb->len;
853
854 /* Disable both interrupts. */
855 outw(0x0000, ioaddr + TX_INTR);
856
857 /* wait for a while */
858 udelay(1);
859
860 outw(length, ioaddr + DATAPORT);
861 outsw(ioaddr + DATAPORT, buf, (length + 1) >> 1);
862
863 lp->tx_queue++;
864 lp->tx_queue_len += ((length+3) & ~1);
865
866 if (lp->tx_started == 0) {
867 /* If the Tx is idle, always trigger a transmit. */
868 outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
869 lp->sent = lp->tx_queue ;
870 lp->tx_queue = 0;
871 lp->tx_queue_len = 0;
872 dev->trans_start = jiffies;
873 lp->tx_started = 1;
874 netif_start_queue(dev);
875 } else {
876 if( sram_config == 0 ) {
877 if (lp->tx_queue_len < (4096 - (ETH_FRAME_LEN +2)) )
878 /* Yes, there is room for one more packet. */
879 netif_start_queue(dev);
880 } else {
881 if (lp->tx_queue_len < (8192 - (ETH_FRAME_LEN +2)) &&
882 lp->tx_queue < 127 )
883 /* Yes, there is room for one more packet. */
884 netif_start_queue(dev);
885 }
886 }
887
888 /* Re-enable interrupts */
889 outb(D_TX_INTR, ioaddr + TX_INTR);
890 outb(D_RX_INTR, ioaddr + RX_INTR);
891 }
892 dev_kfree_skb (skb);
893
894 return 0;
895 } /* fjn_start_xmit */
896
897 /*====================================================================*/
898
899 static void fjn_reset(struct net_device *dev)
900 {
901 struct local_info_t *lp = netdev_priv(dev);
902 kio_addr_t ioaddr = dev->base_addr;
903 int i;
904
905 DEBUG(4, "fjn_reset(%s) called.\n",dev->name);
906
907 /* Reset controller */
908 if( sram_config == 0 )
909 outb(CONFIG0_RST, ioaddr + CONFIG_0);
910 else
911 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
912
913 /* Power On chip and select bank 0 */
914 if (lp->cardtype == MBH10302)
915 outb(BANK_0, ioaddr + CONFIG_1);
916 else
917 outb(BANK_0U, ioaddr + CONFIG_1);
918
919 /* Set Tx modes */
920 outb(D_TX_MODE, ioaddr + TX_MODE);
921 /* set Rx modes */
922 outb(ID_MATCHED, ioaddr + RX_MODE);
923
924 /* Set hardware address */
925 for (i = 0; i < 6; i++)
926 outb(dev->dev_addr[i], ioaddr + NODE_ID + i);
927
928 /* (re)initialize the multicast table */
929 set_rx_mode(dev);
930
931 /* Switch to bank 2 (runtime mode) */
932 if (lp->cardtype == MBH10302)
933 outb(BANK_2, ioaddr + CONFIG_1);
934 else
935 outb(BANK_2U, ioaddr + CONFIG_1);
936
937 /* set 16col ctrl bits */
938 if( lp->cardtype == TDK || lp->cardtype == CONTEC)
939 outb(TDK_AUTO_MODE, ioaddr + COL_CTRL);
940 else
941 outb(AUTO_MODE, ioaddr + COL_CTRL);
942
943 /* clear Reserved Regs */
944 outb(0x00, ioaddr + BMPR12);
945 outb(0x00, ioaddr + BMPR13);
946
947 /* reset Skip packet reg. */
948 outb(0x01, ioaddr + RX_SKIP);
949
950 /* Enable Tx and Rx */
951 if( sram_config == 0 )
952 outb(CONFIG0_DFL, ioaddr + CONFIG_0);
953 else
954 outb(CONFIG0_DFL_1, ioaddr + CONFIG_0);
955
956 /* Init receive pointer ? */
957 inw(ioaddr + DATAPORT);
958 inw(ioaddr + DATAPORT);
959
960 /* Clear all status */
961 outb(0xff, ioaddr + TX_STATUS);
962 outb(0xff, ioaddr + RX_STATUS);
963
964 if (lp->cardtype == MBH10302)
965 outb(INTR_OFF, ioaddr + LAN_CTRL);
966
967 /* Turn on Rx interrupts */
968 outb(D_TX_INTR, ioaddr + TX_INTR);
969 outb(D_RX_INTR, ioaddr + RX_INTR);
970
971 /* Turn on interrupts from LAN card controller */
972 if (lp->cardtype == MBH10302)
973 outb(INTR_ON, ioaddr + LAN_CTRL);
974 } /* fjn_reset */
975
976 /*====================================================================*/
977
978 static void fjn_rx(struct net_device *dev)
979 {
980 struct local_info_t *lp = netdev_priv(dev);
981 kio_addr_t ioaddr = dev->base_addr;
982 int boguscount = 10; /* 5 -> 10: by agy 19940922 */
983
984 DEBUG(4, "%s: in rx_packet(), rx_status %02x.\n",
985 dev->name, inb(ioaddr + RX_STATUS));
986
987 while ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
988 u_short status = inw(ioaddr + DATAPORT);
989
990 DEBUG(4, "%s: Rxing packet mode %02x status %04x.\n",
991 dev->name, inb(ioaddr + RX_MODE), status);
992 #ifndef final_version
993 if (status == 0) {
994 outb(F_SKP_PKT, ioaddr + RX_SKIP);
995 break;
996 }
997 #endif
998 if ((status & 0xF0) != 0x20) { /* There was an error. */
999 lp->stats.rx_errors++;
1000 if (status & F_LEN_ERR) lp->stats.rx_length_errors++;
1001 if (status & F_ALG_ERR) lp->stats.rx_frame_errors++;
1002 if (status & F_CRC_ERR) lp->stats.rx_crc_errors++;
1003 if (status & F_OVR_FLO) lp->stats.rx_over_errors++;
1004 } else {
1005 u_short pkt_len = inw(ioaddr + DATAPORT);
1006 /* Malloc up new buffer. */
1007 struct sk_buff *skb;
1008
1009 if (pkt_len > 1550) {
1010 printk(KERN_NOTICE "%s: The FMV-18x claimed a very "
1011 "large packet, size %d.\n", dev->name, pkt_len);
1012 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1013 lp->stats.rx_errors++;
1014 break;
1015 }
1016 skb = dev_alloc_skb(pkt_len+2);
1017 if (skb == NULL) {
1018 printk(KERN_NOTICE "%s: Memory squeeze, dropping "
1019 "packet (len %d).\n", dev->name, pkt_len);
1020 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1021 lp->stats.rx_dropped++;
1022 break;
1023 }
1024 skb->dev = dev;
1025
1026 skb_reserve(skb, 2);
1027 insw(ioaddr + DATAPORT, skb_put(skb, pkt_len),
1028 (pkt_len + 1) >> 1);
1029 skb->protocol = eth_type_trans(skb, dev);
1030
1031 #ifdef PCMCIA_DEBUG
1032 if (pc_debug > 5) {
1033 int i;
1034 printk(KERN_DEBUG "%s: Rxed packet of length %d: ",
1035 dev->name, pkt_len);
1036 for (i = 0; i < 14; i++)
1037 printk(" %02x", skb->data[i]);
1038 printk(".\n");
1039 }
1040 #endif
1041
1042 netif_rx(skb);
1043 dev->last_rx = jiffies;
1044 lp->stats.rx_packets++;
1045 lp->stats.rx_bytes += pkt_len;
1046 }
1047 if (--boguscount <= 0)
1048 break;
1049 }
1050
1051 /* If any worth-while packets have been received, dev_rint()
1052 has done a netif_wake_queue() for us and will work on them
1053 when we get to the bottom-half routine. */
1054 /*
1055 if (lp->cardtype != TDK) {
1056 int i;
1057 for (i = 0; i < 20; i++) {
1058 if ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == F_BUF_EMP)
1059 break;
1060 (void)inw(ioaddr + DATAPORT); /+ dummy status read +/
1061 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1062 }
1063
1064 if (i > 0)
1065 DEBUG(5, "%s: Exint Rx packet with mode %02x after "
1066 "%d ticks.\n", dev->name, inb(ioaddr + RX_MODE), i);
1067 }
1068 */
1069
1070 return;
1071 } /* fjn_rx */
1072
1073 /*====================================================================*/
1074
1075 static void netdev_get_drvinfo(struct net_device *dev,
1076 struct ethtool_drvinfo *info)
1077 {
1078 strcpy(info->driver, DRV_NAME);
1079 strcpy(info->version, DRV_VERSION);
1080 sprintf(info->bus_info, "PCMCIA 0x%lx", dev->base_addr);
1081 }
1082
1083 #ifdef PCMCIA_DEBUG
1084 static u32 netdev_get_msglevel(struct net_device *dev)
1085 {
1086 return pc_debug;
1087 }
1088
1089 static void netdev_set_msglevel(struct net_device *dev, u32 level)
1090 {
1091 pc_debug = level;
1092 }
1093 #endif /* PCMCIA_DEBUG */
1094
1095 static const struct ethtool_ops netdev_ethtool_ops = {
1096 .get_drvinfo = netdev_get_drvinfo,
1097 #ifdef PCMCIA_DEBUG
1098 .get_msglevel = netdev_get_msglevel,
1099 .set_msglevel = netdev_set_msglevel,
1100 #endif /* PCMCIA_DEBUG */
1101 };
1102
1103 static int fjn_config(struct net_device *dev, struct ifmap *map){
1104 return 0;
1105 }
1106
1107 static int fjn_open(struct net_device *dev)
1108 {
1109 struct local_info_t *lp = netdev_priv(dev);
1110 struct pcmcia_device *link = lp->p_dev;
1111
1112 DEBUG(4, "fjn_open('%s').\n", dev->name);
1113
1114 if (!pcmcia_dev_present(link))
1115 return -ENODEV;
1116
1117 link->open++;
1118
1119 fjn_reset(dev);
1120
1121 lp->tx_started = 0;
1122 lp->tx_queue = 0;
1123 lp->tx_queue_len = 0;
1124 lp->open_time = jiffies;
1125 netif_start_queue(dev);
1126
1127 return 0;
1128 } /* fjn_open */
1129
1130 /*====================================================================*/
1131
1132 static int fjn_close(struct net_device *dev)
1133 {
1134 struct local_info_t *lp = netdev_priv(dev);
1135 struct pcmcia_device *link = lp->p_dev;
1136 kio_addr_t ioaddr = dev->base_addr;
1137
1138 DEBUG(4, "fjn_close('%s').\n", dev->name);
1139
1140 lp->open_time = 0;
1141 netif_stop_queue(dev);
1142
1143 /* Set configuration register 0 to disable Tx and Rx. */
1144 if( sram_config == 0 )
1145 outb(CONFIG0_RST ,ioaddr + CONFIG_0);
1146 else
1147 outb(CONFIG0_RST_1 ,ioaddr + CONFIG_0);
1148
1149 /* Update the statistics -- ToDo. */
1150
1151 /* Power-down the chip. Green, green, green! */
1152 outb(CHIP_OFF ,ioaddr + CONFIG_1);
1153
1154 /* Set the ethernet adaptor disable IRQ */
1155 if (lp->cardtype == MBH10302)
1156 outb(INTR_OFF, ioaddr + LAN_CTRL);
1157
1158 link->open--;
1159
1160 return 0;
1161 } /* fjn_close */
1162
1163 /*====================================================================*/
1164
1165 static struct net_device_stats *fjn_get_stats(struct net_device *dev)
1166 {
1167 local_info_t *lp = netdev_priv(dev);
1168 return &lp->stats;
1169 } /* fjn_get_stats */
1170
1171 /*====================================================================*/
1172
1173 /*
1174 Set the multicast/promiscuous mode for this adaptor.
1175 */
1176
1177 static void set_rx_mode(struct net_device *dev)
1178 {
1179 kio_addr_t ioaddr = dev->base_addr;
1180 u_char mc_filter[8]; /* Multicast hash filter */
1181 u_long flags;
1182 int i;
1183
1184 int saved_bank;
1185 int saved_config_0 = inb(ioaddr + CONFIG_0);
1186
1187 local_irq_save(flags);
1188
1189 /* Disable Tx and Rx */
1190 if (sram_config == 0)
1191 outb(CONFIG0_RST, ioaddr + CONFIG_0);
1192 else
1193 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
1194
1195 if (dev->flags & IFF_PROMISC) {
1196 memset(mc_filter, 0xff, sizeof(mc_filter));
1197 outb(3, ioaddr + RX_MODE); /* Enable promiscuous mode */
1198 } else if (dev->mc_count > MC_FILTERBREAK
1199 || (dev->flags & IFF_ALLMULTI)) {
1200 /* Too many to filter perfectly -- accept all multicasts. */
1201 memset(mc_filter, 0xff, sizeof(mc_filter));
1202 outb(2, ioaddr + RX_MODE); /* Use normal mode. */
1203 } else if (dev->mc_count == 0) {
1204 memset(mc_filter, 0x00, sizeof(mc_filter));
1205 outb(1, ioaddr + RX_MODE); /* Ignore almost all multicasts. */
1206 } else {
1207 struct dev_mc_list *mclist;
1208 int i;
1209
1210 memset(mc_filter, 0, sizeof(mc_filter));
1211 for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
1212 i++, mclist = mclist->next) {
1213 unsigned int bit =
1214 ether_crc_le(ETH_ALEN, mclist->dmi_addr) >> 26;
1215 mc_filter[bit >> 3] |= (1 << (bit & 7));
1216 }
1217 outb(2, ioaddr + RX_MODE); /* Use normal mode. */
1218 }
1219
1220 /* Switch to bank 1 and set the multicast table. */
1221 saved_bank = inb(ioaddr + CONFIG_1);
1222 outb(0xe4, ioaddr + CONFIG_1);
1223
1224 for (i = 0; i < 8; i++)
1225 outb(mc_filter[i], ioaddr + MAR_ADR + i);
1226 outb(saved_bank, ioaddr + CONFIG_1);
1227
1228 outb(saved_config_0, ioaddr + CONFIG_0);
1229
1230 local_irq_restore(flags);
1231 }
kernel source for telekom puls (alcatel/mediatek)