?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
ACPI: thinkpad-acpi: add power-management handler capability
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / net / pcmcia / fmvj18x_cs.c
blob85d5f2ca4bb55d6e14e0e2ffc0684975d7b0e500
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, NEC, KME
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 = 0, last_ret = 0, 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 tuple.TupleData = (u_char *)buf;
354 tuple.TupleDataMax = 64;
355 tuple.TupleOffset = 0;
356 tuple.DesiredTuple = CISTPL_FUNCE;
357 tuple.TupleOffset = 0;
358 if (pcmcia_get_first_tuple(link, &tuple) == CS_SUCCESS) {
359 /* Yes, I have CISTPL_FUNCE. Let's check CISTPL_MANFID */
360 tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
361 CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
362 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
363 CS_CHECK(ParseTuple, pcmcia_parse_tuple(link, &tuple, &parse));
364 link->conf.ConfigIndex = parse.cftable_entry.index;
365 switch (link->manf_id) {
366 case MANFID_TDK:
367 cardtype = TDK;
368 if (link->card_id == PRODID_TDK_GN3410
369 || link->card_id == PRODID_TDK_NP9610
370 || link->card_id == PRODID_TDK_MN3200) {
371 /* MultiFunction Card */
372 link->conf.ConfigBase = 0x800;
373 link->conf.ConfigIndex = 0x47;
374 link->io.NumPorts2 = 8;
375 }
376 break;
377 case MANFID_NEC:
378 cardtype = NEC; /* MultiFunction Card */
379 link->conf.ConfigBase = 0x800;
380 link->conf.ConfigIndex = 0x47;
381 link->io.NumPorts2 = 8;
382 break;
383 case MANFID_KME:
384 cardtype = KME; /* MultiFunction Card */
385 link->conf.ConfigBase = 0x800;
386 link->conf.ConfigIndex = 0x47;
387 link->io.NumPorts2 = 8;
388 break;
389 case MANFID_CONTEC:
390 cardtype = CONTEC;
391 break;
392 case MANFID_FUJITSU:
393 if (link->card_id == PRODID_FUJITSU_MBH10302)
394 /* RATOC REX-5588/9822/4886's PRODID are 0004(=MBH10302),
395 but these are MBH10304 based card. */
396 cardtype = MBH10304;
397 else if (link->card_id == PRODID_FUJITSU_MBH10304)
398 cardtype = MBH10304;
399 else
400 cardtype = LA501;
401 break;
402 default:
403 cardtype = MBH10304;
404 }
405 } else {
406 /* old type card */
407 switch (link->manf_id) {
408 case MANFID_FUJITSU:
409 if (link->card_id == PRODID_FUJITSU_MBH10304) {
410 cardtype = XXX10304; /* MBH10304 with buggy CIS */
411 link->conf.ConfigIndex = 0x20;
412 } else {
413 cardtype = MBH10302; /* NextCom NC5310, etc. */
414 link->conf.ConfigIndex = 1;
415 }
416 break;
417 case MANFID_UNGERMANN:
418 cardtype = UNGERMANN;
419 break;
420 default:
421 cardtype = MBH10302;
422 link->conf.ConfigIndex = 1;
423 }
424 }
425
426 if (link->io.NumPorts2 != 0) {
427 link->irq.Attributes =
428 IRQ_TYPE_DYNAMIC_SHARING|IRQ_FIRST_SHARED|IRQ_HANDLE_PRESENT;
429 ret = mfc_try_io_port(link);
430 if (ret != CS_SUCCESS) goto cs_failed;
431 } else if (cardtype == UNGERMANN) {
432 ret = ungermann_try_io_port(link);
433 if (ret != CS_SUCCESS) goto cs_failed;
434 } else {
435 CS_CHECK(RequestIO, pcmcia_request_io(link, &link->io));
436 }
437 CS_CHECK(RequestIRQ, pcmcia_request_irq(link, &link->irq));
438 CS_CHECK(RequestConfiguration, pcmcia_request_configuration(link, &link->conf));
439 dev->irq = link->irq.AssignedIRQ;
440 dev->base_addr = link->io.BasePort1;
441
442 if (link->io.BasePort2 != 0)
443 fmvj18x_setup_mfc(link);
444
445 ioaddr = dev->base_addr;
446
447 /* Reset controller */
448 if (sram_config == 0)
449 outb(CONFIG0_RST, ioaddr + CONFIG_0);
450 else
451 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
452
453 /* Power On chip and select bank 0 */
454 if (cardtype == MBH10302)
455 outb(BANK_0, ioaddr + CONFIG_1);
456 else
457 outb(BANK_0U, ioaddr + CONFIG_1);
458
459 /* Set hardware address */
460 switch (cardtype) {
461 case MBH10304:
462 case TDK:
463 case LA501:
464 case CONTEC:
465 case NEC:
466 case KME:
467 tuple.DesiredTuple = CISTPL_FUNCE;
468 tuple.TupleOffset = 0;
469 CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
470 tuple.TupleOffset = 0;
471 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
472 if (cardtype == MBH10304) {
473 /* MBH10304's CIS_FUNCE is corrupted */
474 node_id = &(tuple.TupleData[5]);
475 card_name = "FMV-J182";
476 } else {
477 while (tuple.TupleData[0] != CISTPL_FUNCE_LAN_NODE_ID ) {
478 CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(link, &tuple));
479 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
480 }
481 node_id = &(tuple.TupleData[2]);
482 if( cardtype == TDK ) {
483 card_name = "TDK LAK-CD021";
484 } else if( cardtype == LA501 ) {
485 card_name = "LA501";
486 } else if( cardtype == NEC ) {
487 card_name = "PK-UG-J001";
488 } else if( cardtype == KME ) {
489 card_name = "Panasonic";
490 } else {
491 card_name = "C-NET(PC)C";
492 }
493 }
494 /* Read MACID from CIS */
495 for (i = 0; i < 6; i++)
496 dev->dev_addr[i] = node_id[i];
497 break;
498 case UNGERMANN:
499 /* Read MACID from register */
500 for (i = 0; i < 6; i++)
501 dev->dev_addr[i] = inb(ioaddr + UNGERMANN_MAC_ID + i);
502 card_name = "Access/CARD";
503 break;
504 case XXX10304:
505 /* Read MACID from Buggy CIS */
506 if (fmvj18x_get_hwinfo(link, tuple.TupleData) == -1) {
507 printk(KERN_NOTICE "fmvj18x_cs: unable to read hardware net address.\n");
508 goto failed;
509 }
510 for (i = 0 ; i < 6; i++) {
511 dev->dev_addr[i] = tuple.TupleData[i];
512 }
513 card_name = "FMV-J182";
514 break;
515 case MBH10302:
516 default:
517 /* Read MACID from register */
518 for (i = 0; i < 6; i++)
519 dev->dev_addr[i] = inb(ioaddr + MAC_ID + i);
520 card_name = "FMV-J181";
521 break;
522 }
523
524 lp->cardtype = cardtype;
525 link->dev_node = &lp->node;
526 SET_NETDEV_DEV(dev, &handle_to_dev(link));
527
528 if (register_netdev(dev) != 0) {
529 printk(KERN_NOTICE "fmvj18x_cs: register_netdev() failed\n");
530 link->dev_node = NULL;
531 goto failed;
532 }
533
534 strcpy(lp->node.dev_name, dev->name);
535
536 /* print current configuration */
537 printk(KERN_INFO "%s: %s, sram %s, port %#3lx, irq %d, hw_addr ",
538 dev->name, card_name, sram_config == 0 ? "4K TX*2" : "8K TX*2",
539 dev->base_addr, dev->irq);
540 for (i = 0; i < 6; i++)
541 printk("%02X%s", dev->dev_addr[i], ((i<5) ? ":" : "\n"));
542
543 return 0;
544
545 cs_failed:
546 /* All Card Services errors end up here */
547 cs_error(link, last_fn, last_ret);
548 failed:
549 fmvj18x_release(link);
550 return -ENODEV;
551 } /* fmvj18x_config */
552 /*====================================================================*/
553
554 static int fmvj18x_get_hwinfo(struct pcmcia_device *link, u_char *node_id)
555 {
556 win_req_t req;
557 memreq_t mem;
558 u_char __iomem *base;
559 int i, j;
560
561 /* Allocate a small memory window */
562 req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
563 req.Base = 0; req.Size = 0;
564 req.AccessSpeed = 0;
565 i = pcmcia_request_window(&link, &req, &link->win);
566 if (i != CS_SUCCESS) {
567 cs_error(link, RequestWindow, i);
568 return -1;
569 }
570
571 base = ioremap(req.Base, req.Size);
572 mem.Page = 0;
573 mem.CardOffset = 0;
574 pcmcia_map_mem_page(link->win, &mem);
575
576 /*
577 * MBH10304 CISTPL_FUNCE_LAN_NODE_ID format
578 * 22 0d xx xx xx 04 06 yy yy yy yy yy yy ff
579 * 'xx' is garbage.
580 * 'yy' is MAC address.
581 */
582 for (i = 0; i < 0x200; i++) {
583 if (readb(base+i*2) == 0x22) {
584 if (readb(base+(i-1)*2) == 0xff
585 && readb(base+(i+5)*2) == 0x04
586 && readb(base+(i+6)*2) == 0x06
587 && readb(base+(i+13)*2) == 0xff)
588 break;
589 }
590 }
591
592 if (i != 0x200) {
593 for (j = 0 ; j < 6; j++,i++) {
594 node_id[j] = readb(base+(i+7)*2);
595 }
596 }
597
598 iounmap(base);
599 j = pcmcia_release_window(link->win);
600 if (j != CS_SUCCESS)
601 cs_error(link, ReleaseWindow, j);
602 return (i != 0x200) ? 0 : -1;
603
604 } /* fmvj18x_get_hwinfo */
605 /*====================================================================*/
606
607 static int fmvj18x_setup_mfc(struct pcmcia_device *link)
608 {
609 win_req_t req;
610 memreq_t mem;
611 u_char __iomem *base;
612 int i, j;
613 struct net_device *dev = link->priv;
614 kio_addr_t ioaddr;
615
616 /* Allocate a small memory window */
617 req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
618 req.Base = 0; req.Size = 0;
619 req.AccessSpeed = 0;
620 i = pcmcia_request_window(&link, &req, &link->win);
621 if (i != CS_SUCCESS) {
622 cs_error(link, RequestWindow, i);
623 return -1;
624 }
625
626 base = ioremap(req.Base, req.Size);
627 mem.Page = 0;
628 mem.CardOffset = 0;
629 pcmcia_map_mem_page(link->win, &mem);
630
631 ioaddr = dev->base_addr;
632 writeb(0x47, base+0x800); /* Config Option Register of LAN */
633 writeb(0x0, base+0x802); /* Config and Status Register */
634
635 writeb(ioaddr & 0xff, base+0x80a); /* I/O Base(Low) of LAN */
636 writeb((ioaddr >> 8) & 0xff, base+0x80c); /* I/O Base(High) of LAN */
637
638 writeb(0x45, base+0x820); /* Config Option Register of Modem */
639 writeb(0x8, base+0x822); /* Config and Status Register */
640
641 iounmap(base);
642 j = pcmcia_release_window(link->win);
643 if (j != CS_SUCCESS)
644 cs_error(link, ReleaseWindow, j);
645 return 0;
646
647 }
648 /*====================================================================*/
649
650 static void fmvj18x_release(struct pcmcia_device *link)
651 {
652 DEBUG(0, "fmvj18x_release(0x%p)\n", link);
653 pcmcia_disable_device(link);
654 }
655
656 static int fmvj18x_suspend(struct pcmcia_device *link)
657 {
658 struct net_device *dev = link->priv;
659
660 if (link->open)
661 netif_device_detach(dev);
662
663 return 0;
664 }
665
666 static int fmvj18x_resume(struct pcmcia_device *link)
667 {
668 struct net_device *dev = link->priv;
669
670 if (link->open) {
671 fjn_reset(dev);
672 netif_device_attach(dev);
673 }
674
675 return 0;
676 }
677
678 /*====================================================================*/
679
680 static struct pcmcia_device_id fmvj18x_ids[] = {
681 PCMCIA_DEVICE_MANF_CARD(0x0004, 0x0004),
682 PCMCIA_DEVICE_PROD_ID12("EAGLE Technology", "NE200 ETHERNET LAN MBH10302 04", 0x528c88c4, 0x74f91e59),
683 PCMCIA_DEVICE_PROD_ID12("Eiger Labs,Inc", "EPX-10BT PC Card Ethernet 10BT", 0x53af556e, 0x877f9922),
684 PCMCIA_DEVICE_PROD_ID12("Eiger labs,Inc.", "EPX-10BT PC Card Ethernet 10BT", 0xf47e6c66, 0x877f9922),
685 PCMCIA_DEVICE_PROD_ID12("FUJITSU", "LAN Card(FMV-J182)", 0x6ee5a3d8, 0x5baf31db),
686 PCMCIA_DEVICE_PROD_ID12("FUJITSU", "MBH10308", 0x6ee5a3d8, 0x3f04875e),
687 PCMCIA_DEVICE_PROD_ID12("FUJITSU TOWA", "LA501", 0xb8451188, 0x12939ba2),
688 PCMCIA_DEVICE_PROD_ID12("HITACHI", "HT-4840-11", 0xf4f43949, 0x773910f4),
689 PCMCIA_DEVICE_PROD_ID12("NextComK.K.", "NC5310B Ver1.0 ", 0x8cef4d3a, 0x075fc7b6),
690 PCMCIA_DEVICE_PROD_ID12("NextComK.K.", "NC5310 Ver1.0 ", 0x8cef4d3a, 0xbccf43e6),
691 PCMCIA_DEVICE_PROD_ID12("RATOC System Inc.", "10BASE_T CARD R280", 0x85c10e17, 0xd9413666),
692 PCMCIA_DEVICE_PROD_ID12("TDK", "LAC-CD02x", 0x1eae9475, 0x8fa0ee70),
693 PCMCIA_DEVICE_PROD_ID12("TDK", "LAC-CF010", 0x1eae9475, 0x7683bc9a),
694 PCMCIA_DEVICE_PROD_ID1("CONTEC Co.,Ltd.", 0x58d8fee2),
695 PCMCIA_DEVICE_PROD_ID1("PCMCIA LAN MBH10304 ES", 0x2599f454),
696 PCMCIA_DEVICE_PROD_ID1("PCMCIA MBH10302", 0x8f4005da),
697 PCMCIA_DEVICE_PROD_ID1("UBKK,V2.0", 0x90888080),
698 PCMCIA_PFC_DEVICE_PROD_ID12(0, "TDK", "GlobalNetworker 3410/3412", 0x1eae9475, 0xd9a93bed),
699 PCMCIA_PFC_DEVICE_PROD_ID12(0, "NEC", "PK-UG-J001" ,0x18df0ba0 ,0x831b1064),
700 PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0105, 0x0d0a),
701 PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0105, 0x0e0a),
702 PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0032, 0x0a05),
703 PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0032, 0x1101),
704 PCMCIA_DEVICE_NULL,
705 };
706 MODULE_DEVICE_TABLE(pcmcia, fmvj18x_ids);
707
708 static struct pcmcia_driver fmvj18x_cs_driver = {
709 .owner = THIS_MODULE,
710 .drv = {
711 .name = "fmvj18x_cs",
712 },
713 .probe = fmvj18x_probe,
714 .remove = fmvj18x_detach,
715 .id_table = fmvj18x_ids,
716 .suspend = fmvj18x_suspend,
717 .resume = fmvj18x_resume,
718 };
719
720 static int __init init_fmvj18x_cs(void)
721 {
722 return pcmcia_register_driver(&fmvj18x_cs_driver);
723 }
724
725 static void __exit exit_fmvj18x_cs(void)
726 {
727 pcmcia_unregister_driver(&fmvj18x_cs_driver);
728 }
729
730 module_init(init_fmvj18x_cs);
731 module_exit(exit_fmvj18x_cs);
732
733 /*====================================================================*/
734
735 static irqreturn_t fjn_interrupt(int irq, void *dev_id)
736 {
737 struct net_device *dev = dev_id;
738 local_info_t *lp = netdev_priv(dev);
739 kio_addr_t ioaddr;
740 unsigned short tx_stat, rx_stat;
741
742 if (lp == NULL) {
743 printk(KERN_NOTICE "fjn_interrupt(): irq %d for "
744 "unknown device.\n", irq);
745 return IRQ_NONE;
746 }
747 ioaddr = dev->base_addr;
748
749 /* avoid multiple interrupts */
750 outw(0x0000, ioaddr + TX_INTR);
751
752 /* wait for a while */
753 udelay(1);
754
755 /* get status */
756 tx_stat = inb(ioaddr + TX_STATUS);
757 rx_stat = inb(ioaddr + RX_STATUS);
758
759 /* clear status */
760 outb(tx_stat, ioaddr + TX_STATUS);
761 outb(rx_stat, ioaddr + RX_STATUS);
762
763 DEBUG(4, "%s: interrupt, rx_status %02x.\n", dev->name, rx_stat);
764 DEBUG(4, " tx_status %02x.\n", tx_stat);
765
766 if (rx_stat || (inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
767 /* there is packet(s) in rx buffer */
768 fjn_rx(dev);
769 }
770 if (tx_stat & F_TMT_RDY) {
771 lp->stats.tx_packets += lp->sent ;
772 lp->sent = 0 ;
773 if (lp->tx_queue) {
774 outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
775 lp->sent = lp->tx_queue ;
776 lp->tx_queue = 0;
777 lp->tx_queue_len = 0;
778 dev->trans_start = jiffies;
779 } else {
780 lp->tx_started = 0;
781 }
782 netif_wake_queue(dev);
783 }
784 DEBUG(4, "%s: exiting interrupt,\n", dev->name);
785 DEBUG(4, " tx_status %02x, rx_status %02x.\n", tx_stat, rx_stat);
786
787 outb(D_TX_INTR, ioaddr + TX_INTR);
788 outb(D_RX_INTR, ioaddr + RX_INTR);
789 return IRQ_HANDLED;
790
791 } /* fjn_interrupt */
792
793 /*====================================================================*/
794
795 static void fjn_tx_timeout(struct net_device *dev)
796 {
797 struct local_info_t *lp = netdev_priv(dev);
798 kio_addr_t ioaddr = dev->base_addr;
799
800 printk(KERN_NOTICE "%s: transmit timed out with status %04x, %s?\n",
801 dev->name, htons(inw(ioaddr + TX_STATUS)),
802 inb(ioaddr + TX_STATUS) & F_TMT_RDY
803 ? "IRQ conflict" : "network cable problem");
804 printk(KERN_NOTICE "%s: timeout registers: %04x %04x %04x "
805 "%04x %04x %04x %04x %04x.\n",
806 dev->name, htons(inw(ioaddr + 0)),
807 htons(inw(ioaddr + 2)), htons(inw(ioaddr + 4)),
808 htons(inw(ioaddr + 6)), htons(inw(ioaddr + 8)),
809 htons(inw(ioaddr +10)), htons(inw(ioaddr +12)),
810 htons(inw(ioaddr +14)));
811 lp->stats.tx_errors++;
812 /* ToDo: We should try to restart the adaptor... */
813 local_irq_disable();
814 fjn_reset(dev);
815
816 lp->tx_started = 0;
817 lp->tx_queue = 0;
818 lp->tx_queue_len = 0;
819 lp->sent = 0;
820 lp->open_time = jiffies;
821 local_irq_enable();
822 netif_wake_queue(dev);
823 }
824
825 static int fjn_start_xmit(struct sk_buff *skb, struct net_device *dev)
826 {
827 struct local_info_t *lp = netdev_priv(dev);
828 kio_addr_t ioaddr = dev->base_addr;
829 short length = skb->len;
830
831 if (length < ETH_ZLEN)
832 {
833 if (skb_padto(skb, ETH_ZLEN))
834 return 0;
835 length = ETH_ZLEN;
836 }
837
838 netif_stop_queue(dev);
839
840 {
841 unsigned char *buf = skb->data;
842
843 if (length > ETH_FRAME_LEN) {
844 printk(KERN_NOTICE "%s: Attempting to send a large packet"
845 " (%d bytes).\n", dev->name, length);
846 return 1;
847 }
848
849 DEBUG(4, "%s: Transmitting a packet of length %lu.\n",
850 dev->name, (unsigned long)skb->len);
851 lp->stats.tx_bytes += skb->len;
852
853 /* Disable both interrupts. */
854 outw(0x0000, ioaddr + TX_INTR);
855
856 /* wait for a while */
857 udelay(1);
858
859 outw(length, ioaddr + DATAPORT);
860 outsw(ioaddr + DATAPORT, buf, (length + 1) >> 1);
861
862 lp->tx_queue++;
863 lp->tx_queue_len += ((length+3) & ~1);
864
865 if (lp->tx_started == 0) {
866 /* If the Tx is idle, always trigger a transmit. */
867 outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
868 lp->sent = lp->tx_queue ;
869 lp->tx_queue = 0;
870 lp->tx_queue_len = 0;
871 dev->trans_start = jiffies;
872 lp->tx_started = 1;
873 netif_start_queue(dev);
874 } else {
875 if( sram_config == 0 ) {
876 if (lp->tx_queue_len < (4096 - (ETH_FRAME_LEN +2)) )
877 /* Yes, there is room for one more packet. */
878 netif_start_queue(dev);
879 } else {
880 if (lp->tx_queue_len < (8192 - (ETH_FRAME_LEN +2)) &&
881 lp->tx_queue < 127 )
882 /* Yes, there is room for one more packet. */
883 netif_start_queue(dev);
884 }
885 }
886
887 /* Re-enable interrupts */
888 outb(D_TX_INTR, ioaddr + TX_INTR);
889 outb(D_RX_INTR, ioaddr + RX_INTR);
890 }
891 dev_kfree_skb (skb);
892
893 return 0;
894 } /* fjn_start_xmit */
895
896 /*====================================================================*/
897
898 static void fjn_reset(struct net_device *dev)
899 {
900 struct local_info_t *lp = netdev_priv(dev);
901 kio_addr_t ioaddr = dev->base_addr;
902 int i;
903
904 DEBUG(4, "fjn_reset(%s) called.\n",dev->name);
905
906 /* Reset controller */
907 if( sram_config == 0 )
908 outb(CONFIG0_RST, ioaddr + CONFIG_0);
909 else
910 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
911
912 /* Power On chip and select bank 0 */
913 if (lp->cardtype == MBH10302)
914 outb(BANK_0, ioaddr + CONFIG_1);
915 else
916 outb(BANK_0U, ioaddr + CONFIG_1);
917
918 /* Set Tx modes */
919 outb(D_TX_MODE, ioaddr + TX_MODE);
920 /* set Rx modes */
921 outb(ID_MATCHED, ioaddr + RX_MODE);
922
923 /* Set hardware address */
924 for (i = 0; i < 6; i++)
925 outb(dev->dev_addr[i], ioaddr + NODE_ID + i);
926
927 /* (re)initialize the multicast table */
928 set_rx_mode(dev);
929
930 /* Switch to bank 2 (runtime mode) */
931 if (lp->cardtype == MBH10302)
932 outb(BANK_2, ioaddr + CONFIG_1);
933 else
934 outb(BANK_2U, ioaddr + CONFIG_1);
935
936 /* set 16col ctrl bits */
937 if( lp->cardtype == TDK || lp->cardtype == CONTEC)
938 outb(TDK_AUTO_MODE, ioaddr + COL_CTRL);
939 else
940 outb(AUTO_MODE, ioaddr + COL_CTRL);
941
942 /* clear Reserved Regs */
943 outb(0x00, ioaddr + BMPR12);
944 outb(0x00, ioaddr + BMPR13);
945
946 /* reset Skip packet reg. */
947 outb(0x01, ioaddr + RX_SKIP);
948
949 /* Enable Tx and Rx */
950 if( sram_config == 0 )
951 outb(CONFIG0_DFL, ioaddr + CONFIG_0);
952 else
953 outb(CONFIG0_DFL_1, ioaddr + CONFIG_0);
954
955 /* Init receive pointer ? */
956 inw(ioaddr + DATAPORT);
957 inw(ioaddr + DATAPORT);
958
959 /* Clear all status */
960 outb(0xff, ioaddr + TX_STATUS);
961 outb(0xff, ioaddr + RX_STATUS);
962
963 if (lp->cardtype == MBH10302)
964 outb(INTR_OFF, ioaddr + LAN_CTRL);
965
966 /* Turn on Rx interrupts */
967 outb(D_TX_INTR, ioaddr + TX_INTR);
968 outb(D_RX_INTR, ioaddr + RX_INTR);
969
970 /* Turn on interrupts from LAN card controller */
971 if (lp->cardtype == MBH10302)
972 outb(INTR_ON, ioaddr + LAN_CTRL);
973 } /* fjn_reset */
974
975 /*====================================================================*/
976
977 static void fjn_rx(struct net_device *dev)
978 {
979 struct local_info_t *lp = netdev_priv(dev);
980 kio_addr_t ioaddr = dev->base_addr;
981 int boguscount = 10; /* 5 -> 10: by agy 19940922 */
982
983 DEBUG(4, "%s: in rx_packet(), rx_status %02x.\n",
984 dev->name, inb(ioaddr + RX_STATUS));
985
986 while ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
987 u_short status = inw(ioaddr + DATAPORT);
988
989 DEBUG(4, "%s: Rxing packet mode %02x status %04x.\n",
990 dev->name, inb(ioaddr + RX_MODE), status);
991 #ifndef final_version
992 if (status == 0) {
993 outb(F_SKP_PKT, ioaddr + RX_SKIP);
994 break;
995 }
996 #endif
997 if ((status & 0xF0) != 0x20) { /* There was an error. */
998 lp->stats.rx_errors++;
999 if (status & F_LEN_ERR) lp->stats.rx_length_errors++;
1000 if (status & F_ALG_ERR) lp->stats.rx_frame_errors++;
1001 if (status & F_CRC_ERR) lp->stats.rx_crc_errors++;
1002 if (status & F_OVR_FLO) lp->stats.rx_over_errors++;
1003 } else {
1004 u_short pkt_len = inw(ioaddr + DATAPORT);
1005 /* Malloc up new buffer. */
1006 struct sk_buff *skb;
1007
1008 if (pkt_len > 1550) {
1009 printk(KERN_NOTICE "%s: The FMV-18x claimed a very "
1010 "large packet, size %d.\n", dev->name, pkt_len);
1011 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1012 lp->stats.rx_errors++;
1013 break;
1014 }
1015 skb = dev_alloc_skb(pkt_len+2);
1016 if (skb == NULL) {
1017 printk(KERN_NOTICE "%s: Memory squeeze, dropping "
1018 "packet (len %d).\n", dev->name, pkt_len);
1019 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1020 lp->stats.rx_dropped++;
1021 break;
1022 }
1023
1024 skb_reserve(skb, 2);
1025 insw(ioaddr + DATAPORT, skb_put(skb, pkt_len),
1026 (pkt_len + 1) >> 1);
1027 skb->protocol = eth_type_trans(skb, dev);
1028
1029 #ifdef PCMCIA_DEBUG
1030 if (pc_debug > 5) {
1031 int i;
1032 printk(KERN_DEBUG "%s: Rxed packet of length %d: ",
1033 dev->name, pkt_len);
1034 for (i = 0; i < 14; i++)
1035 printk(" %02x", skb->data[i]);
1036 printk(".\n");
1037 }
1038 #endif
1039
1040 netif_rx(skb);
1041 dev->last_rx = jiffies;
1042 lp->stats.rx_packets++;
1043 lp->stats.rx_bytes += pkt_len;
1044 }
1045 if (--boguscount <= 0)
1046 break;
1047 }
1048
1049 /* If any worth-while packets have been received, dev_rint()
1050 has done a netif_wake_queue() for us and will work on them
1051 when we get to the bottom-half routine. */
1052 /*
1053 if (lp->cardtype != TDK) {
1054 int i;
1055 for (i = 0; i < 20; i++) {
1056 if ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == F_BUF_EMP)
1057 break;
1058 (void)inw(ioaddr + DATAPORT); /+ dummy status read +/
1059 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1060 }
1061
1062 if (i > 0)
1063 DEBUG(5, "%s: Exint Rx packet with mode %02x after "
1064 "%d ticks.\n", dev->name, inb(ioaddr + RX_MODE), i);
1065 }
1066 */
1067
1068 return;
1069 } /* fjn_rx */
1070
1071 /*====================================================================*/
1072
1073 static void netdev_get_drvinfo(struct net_device *dev,
1074 struct ethtool_drvinfo *info)
1075 {
1076 strcpy(info->driver, DRV_NAME);
1077 strcpy(info->version, DRV_VERSION);
1078 sprintf(info->bus_info, "PCMCIA 0x%lx", dev->base_addr);
1079 }
1080
1081 #ifdef PCMCIA_DEBUG
1082 static u32 netdev_get_msglevel(struct net_device *dev)
1083 {
1084 return pc_debug;
1085 }
1086
1087 static void netdev_set_msglevel(struct net_device *dev, u32 level)
1088 {
1089 pc_debug = level;
1090 }
1091 #endif /* PCMCIA_DEBUG */
1092
1093 static const struct ethtool_ops netdev_ethtool_ops = {
1094 .get_drvinfo = netdev_get_drvinfo,
1095 #ifdef PCMCIA_DEBUG
1096 .get_msglevel = netdev_get_msglevel,
1097 .set_msglevel = netdev_set_msglevel,
1098 #endif /* PCMCIA_DEBUG */
1099 };
1100
1101 static int fjn_config(struct net_device *dev, struct ifmap *map){
1102 return 0;
1103 }
1104
1105 static int fjn_open(struct net_device *dev)
1106 {
1107 struct local_info_t *lp = netdev_priv(dev);
1108 struct pcmcia_device *link = lp->p_dev;
1109
1110 DEBUG(4, "fjn_open('%s').\n", dev->name);
1111
1112 if (!pcmcia_dev_present(link))
1113 return -ENODEV;
1114
1115 link->open++;
1116
1117 fjn_reset(dev);
1118
1119 lp->tx_started = 0;
1120 lp->tx_queue = 0;
1121 lp->tx_queue_len = 0;
1122 lp->open_time = jiffies;
1123 netif_start_queue(dev);
1124
1125 return 0;
1126 } /* fjn_open */
1127
1128 /*====================================================================*/
1129
1130 static int fjn_close(struct net_device *dev)
1131 {
1132 struct local_info_t *lp = netdev_priv(dev);
1133 struct pcmcia_device *link = lp->p_dev;
1134 kio_addr_t ioaddr = dev->base_addr;
1135
1136 DEBUG(4, "fjn_close('%s').\n", dev->name);
1137
1138 lp->open_time = 0;
1139 netif_stop_queue(dev);
1140
1141 /* Set configuration register 0 to disable Tx and Rx. */
1142 if( sram_config == 0 )
1143 outb(CONFIG0_RST ,ioaddr + CONFIG_0);
1144 else
1145 outb(CONFIG0_RST_1 ,ioaddr + CONFIG_0);
1146
1147 /* Update the statistics -- ToDo. */
1148
1149 /* Power-down the chip. Green, green, green! */
1150 outb(CHIP_OFF ,ioaddr + CONFIG_1);
1151
1152 /* Set the ethernet adaptor disable IRQ */
1153 if (lp->cardtype == MBH10302)
1154 outb(INTR_OFF, ioaddr + LAN_CTRL);
1155
1156 link->open--;
1157
1158 return 0;
1159 } /* fjn_close */
1160
1161 /*====================================================================*/
1162
1163 static struct net_device_stats *fjn_get_stats(struct net_device *dev)
1164 {
1165 local_info_t *lp = netdev_priv(dev);
1166 return &lp->stats;
1167 } /* fjn_get_stats */
1168
1169 /*====================================================================*/
1170
1171 /*
1172 Set the multicast/promiscuous mode for this adaptor.
1173 */
1174
1175 static void set_rx_mode(struct net_device *dev)
1176 {
1177 kio_addr_t ioaddr = dev->base_addr;
1178 u_char mc_filter[8]; /* Multicast hash filter */
1179 u_long flags;
1180 int i;
1181
1182 int saved_bank;
1183 int saved_config_0 = inb(ioaddr + CONFIG_0);
1184
1185 local_irq_save(flags);
1186
1187 /* Disable Tx and Rx */
1188 if (sram_config == 0)
1189 outb(CONFIG0_RST, ioaddr + CONFIG_0);
1190 else
1191 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
1192
1193 if (dev->flags & IFF_PROMISC) {
1194 memset(mc_filter, 0xff, sizeof(mc_filter));
1195 outb(3, ioaddr + RX_MODE); /* Enable promiscuous mode */
1196 } else if (dev->mc_count > MC_FILTERBREAK
1197 || (dev->flags & IFF_ALLMULTI)) {
1198 /* Too many to filter perfectly -- accept all multicasts. */
1199 memset(mc_filter, 0xff, sizeof(mc_filter));
1200 outb(2, ioaddr + RX_MODE); /* Use normal mode. */
1201 } else if (dev->mc_count == 0) {
1202 memset(mc_filter, 0x00, sizeof(mc_filter));
1203 outb(1, ioaddr + RX_MODE); /* Ignore almost all multicasts. */
1204 } else {
1205 struct dev_mc_list *mclist;
1206 int i;
1207
1208 memset(mc_filter, 0, sizeof(mc_filter));
1209 for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
1210 i++, mclist = mclist->next) {
1211 unsigned int bit =
1212 ether_crc_le(ETH_ALEN, mclist->dmi_addr) >> 26;
1213 mc_filter[bit >> 3] |= (1 << (bit & 7));
1214 }
1215 outb(2, ioaddr + RX_MODE); /* Use normal mode. */
1216 }
1217
1218 /* Switch to bank 1 and set the multicast table. */
1219 saved_bank = inb(ioaddr + CONFIG_1);
1220 outb(0xe4, ioaddr + CONFIG_1);
1221
1222 for (i = 0; i < 8; i++)
1223 outb(mc_filter[i], ioaddr + MAR_ADR + i);
1224 outb(saved_bank, ioaddr + CONFIG_1);
1225
1226 outb(saved_config_0, ioaddr + CONFIG_0);
1227
1228 local_irq_restore(flags);
1229 }
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree