?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
pcmcia: convert fmvj18x driver to internal net_device_stats
[linux-2.6/mini2440.git] / drivers / net / pcmcia / fmvj18x_cs.c
blob6715188319d95af699cc2cab75b448da7a17bd38
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 void set_rx_mode(struct net_device *dev);
104 static void fjn_tx_timeout(struct net_device *dev);
105 static const struct ethtool_ops netdev_ethtool_ops;
106
107 /*
108 card type
109 */
110 typedef enum { MBH10302, MBH10304, TDK, CONTEC, LA501, UNGERMANN,
111 XXX10304, NEC, KME
112 } cardtype_t;
113
114 /*
115 driver specific data structure
116 */
117 typedef struct local_info_t {
118 struct pcmcia_device *p_dev;
119 dev_node_t node;
120 long open_time;
121 uint tx_started:1;
122 uint tx_queue;
123 u_short tx_queue_len;
124 cardtype_t cardtype;
125 u_short sent;
126 u_char __iomem *base;
127 } local_info_t;
128
129 #define MC_FILTERBREAK 64
130
131 /*====================================================================*/
132 /*
133 ioport offset from the base address
134 */
135 #define TX_STATUS 0 /* transmit status register */
136 #define RX_STATUS 1 /* receive status register */
137 #define TX_INTR 2 /* transmit interrupt mask register */
138 #define RX_INTR 3 /* receive interrupt mask register */
139 #define TX_MODE 4 /* transmit mode register */
140 #define RX_MODE 5 /* receive mode register */
141 #define CONFIG_0 6 /* configuration register 0 */
142 #define CONFIG_1 7 /* configuration register 1 */
143
144 #define NODE_ID 8 /* node ID register (bank 0) */
145 #define MAR_ADR 8 /* multicast address registers (bank 1) */
146
147 #define DATAPORT 8 /* buffer mem port registers (bank 2) */
148 #define TX_START 10 /* transmit start register */
149 #define COL_CTRL 11 /* 16 collision control register */
150 #define BMPR12 12 /* reserved */
151 #define BMPR13 13 /* reserved */
152 #define RX_SKIP 14 /* skip received packet register */
153
154 #define LAN_CTRL 16 /* LAN card control register */
155
156 #define MAC_ID 0x1a /* hardware address */
157 #define UNGERMANN_MAC_ID 0x18 /* UNGERMANN-BASS hardware address */
158
159 /*
160 control bits
161 */
162 #define ENA_TMT_OK 0x80
163 #define ENA_TMT_REC 0x20
164 #define ENA_COL 0x04
165 #define ENA_16_COL 0x02
166 #define ENA_TBUS_ERR 0x01
167
168 #define ENA_PKT_RDY 0x80
169 #define ENA_BUS_ERR 0x40
170 #define ENA_LEN_ERR 0x08
171 #define ENA_ALG_ERR 0x04
172 #define ENA_CRC_ERR 0x02
173 #define ENA_OVR_FLO 0x01
174
175 /* flags */
176 #define F_TMT_RDY 0x80 /* can accept new packet */
177 #define F_NET_BSY 0x40 /* carrier is detected */
178 #define F_TMT_OK 0x20 /* send packet successfully */
179 #define F_SRT_PKT 0x10 /* short packet error */
180 #define F_COL_ERR 0x04 /* collision error */
181 #define F_16_COL 0x02 /* 16 collision error */
182 #define F_TBUS_ERR 0x01 /* bus read error */
183
184 #define F_PKT_RDY 0x80 /* packet(s) in buffer */
185 #define F_BUS_ERR 0x40 /* bus read error */
186 #define F_LEN_ERR 0x08 /* short packet */
187 #define F_ALG_ERR 0x04 /* frame error */
188 #define F_CRC_ERR 0x02 /* CRC error */
189 #define F_OVR_FLO 0x01 /* overflow error */
190
191 #define F_BUF_EMP 0x40 /* receive buffer is empty */
192
193 #define F_SKP_PKT 0x05 /* drop packet in buffer */
194
195 /* default bitmaps */
196 #define D_TX_INTR ( ENA_TMT_OK )
197 #define D_RX_INTR ( ENA_PKT_RDY | ENA_LEN_ERR \
198 | ENA_ALG_ERR | ENA_CRC_ERR | ENA_OVR_FLO )
199 #define TX_STAT_M ( F_TMT_RDY )
200 #define RX_STAT_M ( F_PKT_RDY | F_LEN_ERR \
201 | F_ALG_ERR | F_CRC_ERR | F_OVR_FLO )
202
203 /* commands */
204 #define D_TX_MODE 0x06 /* no tests, detect carrier */
205 #define ID_MATCHED 0x02 /* (RX_MODE) */
206 #define RECV_ALL 0x03 /* (RX_MODE) */
207 #define CONFIG0_DFL 0x5a /* 16bit bus, 4K x 2 Tx queues */
208 #define CONFIG0_DFL_1 0x5e /* 16bit bus, 8K x 2 Tx queues */
209 #define CONFIG0_RST 0xda /* Data Link Controller off (CONFIG_0) */
210 #define CONFIG0_RST_1 0xde /* Data Link Controller off (CONFIG_0) */
211 #define BANK_0 0xa0 /* bank 0 (CONFIG_1) */
212 #define BANK_1 0xa4 /* bank 1 (CONFIG_1) */
213 #define BANK_2 0xa8 /* bank 2 (CONFIG_1) */
214 #define CHIP_OFF 0x80 /* contrl chip power off (CONFIG_1) */
215 #define DO_TX 0x80 /* do transmit packet */
216 #define SEND_PKT 0x81 /* send a packet */
217 #define AUTO_MODE 0x07 /* Auto skip packet on 16 col detected */
218 #define MANU_MODE 0x03 /* Stop and skip packet on 16 col */
219 #define TDK_AUTO_MODE 0x47 /* Auto skip packet on 16 col detected */
220 #define TDK_MANU_MODE 0x43 /* Stop and skip packet on 16 col */
221 #define INTR_OFF 0x0d /* LAN controller ignores interrupts */
222 #define INTR_ON 0x1d /* LAN controller will catch interrupts */
223
224 #define TX_TIMEOUT ((400*HZ)/1000)
225
226 #define BANK_0U 0x20 /* bank 0 (CONFIG_1) */
227 #define BANK_1U 0x24 /* bank 1 (CONFIG_1) */
228 #define BANK_2U 0x28 /* bank 2 (CONFIG_1) */
229
230 static int fmvj18x_probe(struct pcmcia_device *link)
231 {
232 local_info_t *lp;
233 struct net_device *dev;
234
235 DEBUG(0, "fmvj18x_attach()\n");
236
237 /* Make up a FMVJ18x specific data structure */
238 dev = alloc_etherdev(sizeof(local_info_t));
239 if (!dev)
240 return -ENOMEM;
241 lp = netdev_priv(dev);
242 link->priv = dev;
243 lp->p_dev = link;
244 lp->base = NULL;
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_DYNAMIC_SHARING|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 dev->hard_start_xmit = &fjn_start_xmit;
263 dev->set_config = &fjn_config;
264 dev->set_multicast_list = &set_rx_mode;
265 dev->open = &fjn_open;
266 dev->stop = &fjn_close;
267 #ifdef HAVE_TX_TIMEOUT
268 dev->tx_timeout = fjn_tx_timeout;
269 dev->watchdog_timeo = TX_TIMEOUT;
270 #endif
271 SET_ETHTOOL_OPS(dev, &netdev_ethtool_ops);
272
273 return fmvj18x_config(link);
274 } /* fmvj18x_attach */
275
276 /*====================================================================*/
277
278 static void fmvj18x_detach(struct pcmcia_device *link)
279 {
280 struct net_device *dev = link->priv;
281
282 DEBUG(0, "fmvj18x_detach(0x%p)\n", link);
283
284 if (link->dev_node)
285 unregister_netdev(dev);
286
287 fmvj18x_release(link);
288
289 free_netdev(dev);
290 } /* fmvj18x_detach */
291
292 /*====================================================================*/
293
294 #define CS_CHECK(fn, ret) \
295 do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
296
297 static int mfc_try_io_port(struct pcmcia_device *link)
298 {
299 int i, ret;
300 static const unsigned int serial_base[5] =
301 { 0x3f8, 0x2f8, 0x3e8, 0x2e8, 0x0 };
302
303 for (i = 0; i < 5; i++) {
304 link->io.BasePort2 = serial_base[i];
305 link->io.Attributes2 = IO_DATA_PATH_WIDTH_8;
306 if (link->io.BasePort2 == 0) {
307 link->io.NumPorts2 = 0;
308 printk(KERN_NOTICE "fmvj18x_cs: out of resource for serial\n");
309 }
310 ret = pcmcia_request_io(link, &link->io);
311 if (ret == 0)
312 return ret;
313 }
314 return ret;
315 }
316
317 static int ungermann_try_io_port(struct pcmcia_device *link)
318 {
319 int ret;
320 unsigned int 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 == 0) {
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 unsigned int 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) == 0) {
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(&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->conf.ConfigBase == 0x0fe0)
394 cardtype = MBH10302;
395 else if (link->card_id == PRODID_FUJITSU_MBH10302)
396 /* RATOC REX-5588/9822/4886's PRODID are 0004(=MBH10302),
397 but these are MBH10304 based card. */
398 cardtype = MBH10304;
399 else if (link->card_id == PRODID_FUJITSU_MBH10304)
400 cardtype = MBH10304;
401 else
402 cardtype = LA501;
403 break;
404 default:
405 cardtype = MBH10304;
406 }
407 } else {
408 /* old type card */
409 switch (link->manf_id) {
410 case MANFID_FUJITSU:
411 if (link->card_id == PRODID_FUJITSU_MBH10304) {
412 cardtype = XXX10304; /* MBH10304 with buggy CIS */
413 link->conf.ConfigIndex = 0x20;
414 } else {
415 cardtype = MBH10302; /* NextCom NC5310, etc. */
416 link->conf.ConfigIndex = 1;
417 }
418 break;
419 case MANFID_UNGERMANN:
420 cardtype = UNGERMANN;
421 break;
422 default:
423 cardtype = MBH10302;
424 link->conf.ConfigIndex = 1;
425 }
426 }
427
428 if (link->io.NumPorts2 != 0) {
429 link->irq.Attributes =
430 IRQ_TYPE_DYNAMIC_SHARING|IRQ_FIRST_SHARED|IRQ_HANDLE_PRESENT;
431 ret = mfc_try_io_port(link);
432 if (ret != 0) goto cs_failed;
433 } else if (cardtype == UNGERMANN) {
434 ret = ungermann_try_io_port(link);
435 if (ret != 0) goto cs_failed;
436 } else {
437 CS_CHECK(RequestIO, pcmcia_request_io(link, &link->io));
438 }
439 CS_CHECK(RequestIRQ, pcmcia_request_irq(link, &link->irq));
440 CS_CHECK(RequestConfiguration, pcmcia_request_configuration(link, &link->conf));
441 dev->irq = link->irq.AssignedIRQ;
442 dev->base_addr = link->io.BasePort1;
443
444 if (link->io.BasePort2 != 0) {
445 ret = fmvj18x_setup_mfc(link);
446 if (ret != 0) goto failed;
447 }
448
449 ioaddr = dev->base_addr;
450
451 /* Reset controller */
452 if (sram_config == 0)
453 outb(CONFIG0_RST, ioaddr + CONFIG_0);
454 else
455 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
456
457 /* Power On chip and select bank 0 */
458 if (cardtype == MBH10302)
459 outb(BANK_0, ioaddr + CONFIG_1);
460 else
461 outb(BANK_0U, ioaddr + CONFIG_1);
462
463 /* Set hardware address */
464 switch (cardtype) {
465 case MBH10304:
466 case TDK:
467 case LA501:
468 case CONTEC:
469 case NEC:
470 case KME:
471 tuple.DesiredTuple = CISTPL_FUNCE;
472 tuple.TupleOffset = 0;
473 CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
474 tuple.TupleOffset = 0;
475 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
476 if (cardtype == MBH10304) {
477 /* MBH10304's CIS_FUNCE is corrupted */
478 node_id = &(tuple.TupleData[5]);
479 card_name = "FMV-J182";
480 } else {
481 while (tuple.TupleData[0] != CISTPL_FUNCE_LAN_NODE_ID ) {
482 CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(link, &tuple));
483 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
484 }
485 node_id = &(tuple.TupleData[2]);
486 if( cardtype == TDK ) {
487 card_name = "TDK LAK-CD021";
488 } else if( cardtype == LA501 ) {
489 card_name = "LA501";
490 } else if( cardtype == NEC ) {
491 card_name = "PK-UG-J001";
492 } else if( cardtype == KME ) {
493 card_name = "Panasonic";
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, "
542 "hw_addr %pM\n",
543 dev->name, card_name, sram_config == 0 ? "4K TX*2" : "8K TX*2",
544 dev->base_addr, dev->irq, dev->dev_addr);
545
546 return 0;
547
548 cs_failed:
549 /* All Card Services errors end up here */
550 cs_error(link, last_fn, last_ret);
551 failed:
552 fmvj18x_release(link);
553 return -ENODEV;
554 } /* fmvj18x_config */
555 /*====================================================================*/
556
557 static int fmvj18x_get_hwinfo(struct pcmcia_device *link, u_char *node_id)
558 {
559 win_req_t req;
560 memreq_t mem;
561 u_char __iomem *base;
562 int i, j;
563
564 /* Allocate a small memory window */
565 req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
566 req.Base = 0; req.Size = 0;
567 req.AccessSpeed = 0;
568 i = pcmcia_request_window(&link, &req, &link->win);
569 if (i != 0) {
570 cs_error(link, RequestWindow, i);
571 return -1;
572 }
573
574 base = ioremap(req.Base, req.Size);
575 mem.Page = 0;
576 mem.CardOffset = 0;
577 pcmcia_map_mem_page(link->win, &mem);
578
579 /*
580 * MBH10304 CISTPL_FUNCE_LAN_NODE_ID format
581 * 22 0d xx xx xx 04 06 yy yy yy yy yy yy ff
582 * 'xx' is garbage.
583 * 'yy' is MAC address.
584 */
585 for (i = 0; i < 0x200; i++) {
586 if (readb(base+i*2) == 0x22) {
587 if (readb(base+(i-1)*2) == 0xff
588 && readb(base+(i+5)*2) == 0x04
589 && readb(base+(i+6)*2) == 0x06
590 && readb(base+(i+13)*2) == 0xff)
591 break;
592 }
593 }
594
595 if (i != 0x200) {
596 for (j = 0 ; j < 6; j++,i++) {
597 node_id[j] = readb(base+(i+7)*2);
598 }
599 }
600
601 iounmap(base);
602 j = pcmcia_release_window(link->win);
603 if (j != 0)
604 cs_error(link, ReleaseWindow, j);
605 return (i != 0x200) ? 0 : -1;
606
607 } /* fmvj18x_get_hwinfo */
608 /*====================================================================*/
609
610 static int fmvj18x_setup_mfc(struct pcmcia_device *link)
611 {
612 win_req_t req;
613 memreq_t mem;
614 int i;
615 struct net_device *dev = link->priv;
616 unsigned int ioaddr;
617 local_info_t *lp = netdev_priv(dev);
618
619 /* Allocate a small memory window */
620 req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
621 req.Base = 0; req.Size = 0;
622 req.AccessSpeed = 0;
623 i = pcmcia_request_window(&link, &req, &link->win);
624 if (i != 0) {
625 cs_error(link, RequestWindow, i);
626 return -1;
627 }
628
629 lp->base = ioremap(req.Base, req.Size);
630 if (lp->base == NULL) {
631 printk(KERN_NOTICE "fmvj18x_cs: ioremap failed\n");
632 return -1;
633 }
634
635 mem.Page = 0;
636 mem.CardOffset = 0;
637 i = pcmcia_map_mem_page(link->win, &mem);
638 if (i != 0) {
639 iounmap(lp->base);
640 lp->base = NULL;
641 cs_error(link, MapMemPage, i);
642 return -1;
643 }
644
645 ioaddr = dev->base_addr;
646 writeb(0x47, lp->base+0x800); /* Config Option Register of LAN */
647 writeb(0x0, lp->base+0x802); /* Config and Status Register */
648
649 writeb(ioaddr & 0xff, lp->base+0x80a); /* I/O Base(Low) of LAN */
650 writeb((ioaddr >> 8) & 0xff, lp->base+0x80c); /* I/O Base(High) of LAN */
651
652 writeb(0x45, lp->base+0x820); /* Config Option Register of Modem */
653 writeb(0x8, lp->base+0x822); /* Config and Status Register */
654
655 return 0;
656
657 }
658 /*====================================================================*/
659
660 static void fmvj18x_release(struct pcmcia_device *link)
661 {
662
663 struct net_device *dev = link->priv;
664 local_info_t *lp = netdev_priv(dev);
665 u_char __iomem *tmp;
666 int j;
667
668 DEBUG(0, "fmvj18x_release(0x%p)\n", link);
669
670 if (lp->base != NULL) {
671 tmp = lp->base;
672 lp->base = NULL; /* set NULL before iounmap */
673 iounmap(tmp);
674 j = pcmcia_release_window(link->win);
675 if (j != 0)
676 cs_error(link, ReleaseWindow, j);
677 }
678
679 pcmcia_disable_device(link);
680
681 }
682
683 static int fmvj18x_suspend(struct pcmcia_device *link)
684 {
685 struct net_device *dev = link->priv;
686
687 if (link->open)
688 netif_device_detach(dev);
689
690 return 0;
691 }
692
693 static int fmvj18x_resume(struct pcmcia_device *link)
694 {
695 struct net_device *dev = link->priv;
696
697 if (link->open) {
698 fjn_reset(dev);
699 netif_device_attach(dev);
700 }
701
702 return 0;
703 }
704
705 /*====================================================================*/
706
707 static struct pcmcia_device_id fmvj18x_ids[] = {
708 PCMCIA_DEVICE_MANF_CARD(0x0004, 0x0004),
709 PCMCIA_DEVICE_PROD_ID12("EAGLE Technology", "NE200 ETHERNET LAN MBH10302 04", 0x528c88c4, 0x74f91e59),
710 PCMCIA_DEVICE_PROD_ID12("Eiger Labs,Inc", "EPX-10BT PC Card Ethernet 10BT", 0x53af556e, 0x877f9922),
711 PCMCIA_DEVICE_PROD_ID12("Eiger labs,Inc.", "EPX-10BT PC Card Ethernet 10BT", 0xf47e6c66, 0x877f9922),
712 PCMCIA_DEVICE_PROD_ID12("FUJITSU", "LAN Card(FMV-J182)", 0x6ee5a3d8, 0x5baf31db),
713 PCMCIA_DEVICE_PROD_ID12("FUJITSU", "MBH10308", 0x6ee5a3d8, 0x3f04875e),
714 PCMCIA_DEVICE_PROD_ID12("FUJITSU TOWA", "LA501", 0xb8451188, 0x12939ba2),
715 PCMCIA_DEVICE_PROD_ID12("HITACHI", "HT-4840-11", 0xf4f43949, 0x773910f4),
716 PCMCIA_DEVICE_PROD_ID12("NextComK.K.", "NC5310B Ver1.0 ", 0x8cef4d3a, 0x075fc7b6),
717 PCMCIA_DEVICE_PROD_ID12("NextComK.K.", "NC5310 Ver1.0 ", 0x8cef4d3a, 0xbccf43e6),
718 PCMCIA_DEVICE_PROD_ID12("RATOC System Inc.", "10BASE_T CARD R280", 0x85c10e17, 0xd9413666),
719 PCMCIA_DEVICE_PROD_ID12("TDK", "LAC-CD02x", 0x1eae9475, 0x8fa0ee70),
720 PCMCIA_DEVICE_PROD_ID12("TDK", "LAC-CF010", 0x1eae9475, 0x7683bc9a),
721 PCMCIA_DEVICE_PROD_ID1("CONTEC Co.,Ltd.", 0x58d8fee2),
722 PCMCIA_DEVICE_PROD_ID1("PCMCIA LAN MBH10304 ES", 0x2599f454),
723 PCMCIA_DEVICE_PROD_ID1("PCMCIA MBH10302", 0x8f4005da),
724 PCMCIA_DEVICE_PROD_ID1("UBKK,V2.0", 0x90888080),
725 PCMCIA_PFC_DEVICE_PROD_ID12(0, "TDK", "GlobalNetworker 3410/3412", 0x1eae9475, 0xd9a93bed),
726 PCMCIA_PFC_DEVICE_PROD_ID12(0, "NEC", "PK-UG-J001" ,0x18df0ba0 ,0x831b1064),
727 PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0105, 0x0d0a),
728 PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0105, 0x0e0a),
729 PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0032, 0x0a05),
730 PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0032, 0x1101),
731 PCMCIA_DEVICE_NULL,
732 };
733 MODULE_DEVICE_TABLE(pcmcia, fmvj18x_ids);
734
735 static struct pcmcia_driver fmvj18x_cs_driver = {
736 .owner = THIS_MODULE,
737 .drv = {
738 .name = "fmvj18x_cs",
739 },
740 .probe = fmvj18x_probe,
741 .remove = fmvj18x_detach,
742 .id_table = fmvj18x_ids,
743 .suspend = fmvj18x_suspend,
744 .resume = fmvj18x_resume,
745 };
746
747 static int __init init_fmvj18x_cs(void)
748 {
749 return pcmcia_register_driver(&fmvj18x_cs_driver);
750 }
751
752 static void __exit exit_fmvj18x_cs(void)
753 {
754 pcmcia_unregister_driver(&fmvj18x_cs_driver);
755 }
756
757 module_init(init_fmvj18x_cs);
758 module_exit(exit_fmvj18x_cs);
759
760 /*====================================================================*/
761
762 static irqreturn_t fjn_interrupt(int dummy, void *dev_id)
763 {
764 struct net_device *dev = dev_id;
765 local_info_t *lp = netdev_priv(dev);
766 unsigned int ioaddr;
767 unsigned short tx_stat, rx_stat;
768
769 ioaddr = dev->base_addr;
770
771 /* avoid multiple interrupts */
772 outw(0x0000, ioaddr + TX_INTR);
773
774 /* wait for a while */
775 udelay(1);
776
777 /* get status */
778 tx_stat = inb(ioaddr + TX_STATUS);
779 rx_stat = inb(ioaddr + RX_STATUS);
780
781 /* clear status */
782 outb(tx_stat, ioaddr + TX_STATUS);
783 outb(rx_stat, ioaddr + RX_STATUS);
784
785 DEBUG(4, "%s: interrupt, rx_status %02x.\n", dev->name, rx_stat);
786 DEBUG(4, " tx_status %02x.\n", tx_stat);
787
788 if (rx_stat || (inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
789 /* there is packet(s) in rx buffer */
790 fjn_rx(dev);
791 }
792 if (tx_stat & F_TMT_RDY) {
793 dev->stats.tx_packets += lp->sent ;
794 lp->sent = 0 ;
795 if (lp->tx_queue) {
796 outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
797 lp->sent = lp->tx_queue ;
798 lp->tx_queue = 0;
799 lp->tx_queue_len = 0;
800 dev->trans_start = jiffies;
801 } else {
802 lp->tx_started = 0;
803 }
804 netif_wake_queue(dev);
805 }
806 DEBUG(4, "%s: exiting interrupt,\n", dev->name);
807 DEBUG(4, " tx_status %02x, rx_status %02x.\n", tx_stat, rx_stat);
808
809 outb(D_TX_INTR, ioaddr + TX_INTR);
810 outb(D_RX_INTR, ioaddr + RX_INTR);
811
812 if (lp->base != NULL) {
813 /* Ack interrupt for multifunction card */
814 writeb(0x01, lp->base+0x802);
815 writeb(0x09, lp->base+0x822);
816 }
817
818 return IRQ_HANDLED;
819
820 } /* fjn_interrupt */
821
822 /*====================================================================*/
823
824 static void fjn_tx_timeout(struct net_device *dev)
825 {
826 struct local_info_t *lp = netdev_priv(dev);
827 unsigned int ioaddr = dev->base_addr;
828
829 printk(KERN_NOTICE "%s: transmit timed out with status %04x, %s?\n",
830 dev->name, htons(inw(ioaddr + TX_STATUS)),
831 inb(ioaddr + TX_STATUS) & F_TMT_RDY
832 ? "IRQ conflict" : "network cable problem");
833 printk(KERN_NOTICE "%s: timeout registers: %04x %04x %04x "
834 "%04x %04x %04x %04x %04x.\n",
835 dev->name, htons(inw(ioaddr + 0)),
836 htons(inw(ioaddr + 2)), htons(inw(ioaddr + 4)),
837 htons(inw(ioaddr + 6)), htons(inw(ioaddr + 8)),
838 htons(inw(ioaddr +10)), htons(inw(ioaddr +12)),
839 htons(inw(ioaddr +14)));
840 dev->stats.tx_errors++;
841 /* ToDo: We should try to restart the adaptor... */
842 local_irq_disable();
843 fjn_reset(dev);
844
845 lp->tx_started = 0;
846 lp->tx_queue = 0;
847 lp->tx_queue_len = 0;
848 lp->sent = 0;
849 lp->open_time = jiffies;
850 local_irq_enable();
851 netif_wake_queue(dev);
852 }
853
854 static int fjn_start_xmit(struct sk_buff *skb, struct net_device *dev)
855 {
856 struct local_info_t *lp = netdev_priv(dev);
857 unsigned int ioaddr = dev->base_addr;
858 short length = skb->len;
859
860 if (length < ETH_ZLEN)
861 {
862 if (skb_padto(skb, ETH_ZLEN))
863 return 0;
864 length = ETH_ZLEN;
865 }
866
867 netif_stop_queue(dev);
868
869 {
870 unsigned char *buf = skb->data;
871
872 if (length > ETH_FRAME_LEN) {
873 printk(KERN_NOTICE "%s: Attempting to send a large packet"
874 " (%d bytes).\n", dev->name, length);
875 return 1;
876 }
877
878 DEBUG(4, "%s: Transmitting a packet of length %lu.\n",
879 dev->name, (unsigned long)skb->len);
880 dev->stats.tx_bytes += skb->len;
881
882 /* Disable both interrupts. */
883 outw(0x0000, ioaddr + TX_INTR);
884
885 /* wait for a while */
886 udelay(1);
887
888 outw(length, ioaddr + DATAPORT);
889 outsw(ioaddr + DATAPORT, buf, (length + 1) >> 1);
890
891 lp->tx_queue++;
892 lp->tx_queue_len += ((length+3) & ~1);
893
894 if (lp->tx_started == 0) {
895 /* If the Tx is idle, always trigger a transmit. */
896 outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
897 lp->sent = lp->tx_queue ;
898 lp->tx_queue = 0;
899 lp->tx_queue_len = 0;
900 dev->trans_start = jiffies;
901 lp->tx_started = 1;
902 netif_start_queue(dev);
903 } else {
904 if( sram_config == 0 ) {
905 if (lp->tx_queue_len < (4096 - (ETH_FRAME_LEN +2)) )
906 /* Yes, there is room for one more packet. */
907 netif_start_queue(dev);
908 } else {
909 if (lp->tx_queue_len < (8192 - (ETH_FRAME_LEN +2)) &&
910 lp->tx_queue < 127 )
911 /* Yes, there is room for one more packet. */
912 netif_start_queue(dev);
913 }
914 }
915
916 /* Re-enable interrupts */
917 outb(D_TX_INTR, ioaddr + TX_INTR);
918 outb(D_RX_INTR, ioaddr + RX_INTR);
919 }
920 dev_kfree_skb (skb);
921
922 return 0;
923 } /* fjn_start_xmit */
924
925 /*====================================================================*/
926
927 static void fjn_reset(struct net_device *dev)
928 {
929 struct local_info_t *lp = netdev_priv(dev);
930 unsigned int ioaddr = dev->base_addr;
931 int i;
932
933 DEBUG(4, "fjn_reset(%s) called.\n",dev->name);
934
935 /* Reset controller */
936 if( sram_config == 0 )
937 outb(CONFIG0_RST, ioaddr + CONFIG_0);
938 else
939 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
940
941 /* Power On chip and select bank 0 */
942 if (lp->cardtype == MBH10302)
943 outb(BANK_0, ioaddr + CONFIG_1);
944 else
945 outb(BANK_0U, ioaddr + CONFIG_1);
946
947 /* Set Tx modes */
948 outb(D_TX_MODE, ioaddr + TX_MODE);
949 /* set Rx modes */
950 outb(ID_MATCHED, ioaddr + RX_MODE);
951
952 /* Set hardware address */
953 for (i = 0; i < 6; i++)
954 outb(dev->dev_addr[i], ioaddr + NODE_ID + i);
955
956 /* (re)initialize the multicast table */
957 set_rx_mode(dev);
958
959 /* Switch to bank 2 (runtime mode) */
960 if (lp->cardtype == MBH10302)
961 outb(BANK_2, ioaddr + CONFIG_1);
962 else
963 outb(BANK_2U, ioaddr + CONFIG_1);
964
965 /* set 16col ctrl bits */
966 if( lp->cardtype == TDK || lp->cardtype == CONTEC)
967 outb(TDK_AUTO_MODE, ioaddr + COL_CTRL);
968 else
969 outb(AUTO_MODE, ioaddr + COL_CTRL);
970
971 /* clear Reserved Regs */
972 outb(0x00, ioaddr + BMPR12);
973 outb(0x00, ioaddr + BMPR13);
974
975 /* reset Skip packet reg. */
976 outb(0x01, ioaddr + RX_SKIP);
977
978 /* Enable Tx and Rx */
979 if( sram_config == 0 )
980 outb(CONFIG0_DFL, ioaddr + CONFIG_0);
981 else
982 outb(CONFIG0_DFL_1, ioaddr + CONFIG_0);
983
984 /* Init receive pointer ? */
985 inw(ioaddr + DATAPORT);
986 inw(ioaddr + DATAPORT);
987
988 /* Clear all status */
989 outb(0xff, ioaddr + TX_STATUS);
990 outb(0xff, ioaddr + RX_STATUS);
991
992 if (lp->cardtype == MBH10302)
993 outb(INTR_OFF, ioaddr + LAN_CTRL);
994
995 /* Turn on Rx interrupts */
996 outb(D_TX_INTR, ioaddr + TX_INTR);
997 outb(D_RX_INTR, ioaddr + RX_INTR);
998
999 /* Turn on interrupts from LAN card controller */
1000 if (lp->cardtype == MBH10302)
1001 outb(INTR_ON, ioaddr + LAN_CTRL);
1002 } /* fjn_reset */
1003
1004 /*====================================================================*/
1005
1006 static void fjn_rx(struct net_device *dev)
1007 {
1008 unsigned int ioaddr = dev->base_addr;
1009 int boguscount = 10; /* 5 -> 10: by agy 19940922 */
1010
1011 DEBUG(4, "%s: in rx_packet(), rx_status %02x.\n",
1012 dev->name, inb(ioaddr + RX_STATUS));
1013
1014 while ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
1015 u_short status = inw(ioaddr + DATAPORT);
1016
1017 DEBUG(4, "%s: Rxing packet mode %02x status %04x.\n",
1018 dev->name, inb(ioaddr + RX_MODE), status);
1019 #ifndef final_version
1020 if (status == 0) {
1021 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1022 break;
1023 }
1024 #endif
1025 if ((status & 0xF0) != 0x20) { /* There was an error. */
1026 dev->stats.rx_errors++;
1027 if (status & F_LEN_ERR) dev->stats.rx_length_errors++;
1028 if (status & F_ALG_ERR) dev->stats.rx_frame_errors++;
1029 if (status & F_CRC_ERR) dev->stats.rx_crc_errors++;
1030 if (status & F_OVR_FLO) dev->stats.rx_over_errors++;
1031 } else {
1032 u_short pkt_len = inw(ioaddr + DATAPORT);
1033 /* Malloc up new buffer. */
1034 struct sk_buff *skb;
1035
1036 if (pkt_len > 1550) {
1037 printk(KERN_NOTICE "%s: The FMV-18x claimed a very "
1038 "large packet, size %d.\n", dev->name, pkt_len);
1039 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1040 dev->stats.rx_errors++;
1041 break;
1042 }
1043 skb = dev_alloc_skb(pkt_len+2);
1044 if (skb == NULL) {
1045 printk(KERN_NOTICE "%s: Memory squeeze, dropping "
1046 "packet (len %d).\n", dev->name, pkt_len);
1047 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1048 dev->stats.rx_dropped++;
1049 break;
1050 }
1051
1052 skb_reserve(skb, 2);
1053 insw(ioaddr + DATAPORT, skb_put(skb, pkt_len),
1054 (pkt_len + 1) >> 1);
1055 skb->protocol = eth_type_trans(skb, dev);
1056
1057 #ifdef PCMCIA_DEBUG
1058 if (pc_debug > 5) {
1059 int i;
1060 printk(KERN_DEBUG "%s: Rxed packet of length %d: ",
1061 dev->name, pkt_len);
1062 for (i = 0; i < 14; i++)
1063 printk(" %02x", skb->data[i]);
1064 printk(".\n");
1065 }
1066 #endif
1067
1068 netif_rx(skb);
1069 dev->stats.rx_packets++;
1070 dev->stats.rx_bytes += pkt_len;
1071 }
1072 if (--boguscount <= 0)
1073 break;
1074 }
1075
1076 /* If any worth-while packets have been received, dev_rint()
1077 has done a netif_wake_queue() for us and will work on them
1078 when we get to the bottom-half routine. */
1079 /*
1080 if (lp->cardtype != TDK) {
1081 int i;
1082 for (i = 0; i < 20; i++) {
1083 if ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == F_BUF_EMP)
1084 break;
1085 (void)inw(ioaddr + DATAPORT); /+ dummy status read +/
1086 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1087 }
1088
1089 if (i > 0)
1090 DEBUG(5, "%s: Exint Rx packet with mode %02x after "
1091 "%d ticks.\n", dev->name, inb(ioaddr + RX_MODE), i);
1092 }
1093 */
1094
1095 return;
1096 } /* fjn_rx */
1097
1098 /*====================================================================*/
1099
1100 static void netdev_get_drvinfo(struct net_device *dev,
1101 struct ethtool_drvinfo *info)
1102 {
1103 strcpy(info->driver, DRV_NAME);
1104 strcpy(info->version, DRV_VERSION);
1105 sprintf(info->bus_info, "PCMCIA 0x%lx", dev->base_addr);
1106 }
1107
1108 #ifdef PCMCIA_DEBUG
1109 static u32 netdev_get_msglevel(struct net_device *dev)
1110 {
1111 return pc_debug;
1112 }
1113
1114 static void netdev_set_msglevel(struct net_device *dev, u32 level)
1115 {
1116 pc_debug = level;
1117 }
1118 #endif /* PCMCIA_DEBUG */
1119
1120 static const struct ethtool_ops netdev_ethtool_ops = {
1121 .get_drvinfo = netdev_get_drvinfo,
1122 #ifdef PCMCIA_DEBUG
1123 .get_msglevel = netdev_get_msglevel,
1124 .set_msglevel = netdev_set_msglevel,
1125 #endif /* PCMCIA_DEBUG */
1126 };
1127
1128 static int fjn_config(struct net_device *dev, struct ifmap *map){
1129 return 0;
1130 }
1131
1132 static int fjn_open(struct net_device *dev)
1133 {
1134 struct local_info_t *lp = netdev_priv(dev);
1135 struct pcmcia_device *link = lp->p_dev;
1136
1137 DEBUG(4, "fjn_open('%s').\n", dev->name);
1138
1139 if (!pcmcia_dev_present(link))
1140 return -ENODEV;
1141
1142 link->open++;
1143
1144 fjn_reset(dev);
1145
1146 lp->tx_started = 0;
1147 lp->tx_queue = 0;
1148 lp->tx_queue_len = 0;
1149 lp->open_time = jiffies;
1150 netif_start_queue(dev);
1151
1152 return 0;
1153 } /* fjn_open */
1154
1155 /*====================================================================*/
1156
1157 static int fjn_close(struct net_device *dev)
1158 {
1159 struct local_info_t *lp = netdev_priv(dev);
1160 struct pcmcia_device *link = lp->p_dev;
1161 unsigned int ioaddr = dev->base_addr;
1162
1163 DEBUG(4, "fjn_close('%s').\n", dev->name);
1164
1165 lp->open_time = 0;
1166 netif_stop_queue(dev);
1167
1168 /* Set configuration register 0 to disable Tx and Rx. */
1169 if( sram_config == 0 )
1170 outb(CONFIG0_RST ,ioaddr + CONFIG_0);
1171 else
1172 outb(CONFIG0_RST_1 ,ioaddr + CONFIG_0);
1173
1174 /* Update the statistics -- ToDo. */
1175
1176 /* Power-down the chip. Green, green, green! */
1177 outb(CHIP_OFF ,ioaddr + CONFIG_1);
1178
1179 /* Set the ethernet adaptor disable IRQ */
1180 if (lp->cardtype == MBH10302)
1181 outb(INTR_OFF, ioaddr + LAN_CTRL);
1182
1183 link->open--;
1184
1185 return 0;
1186 } /* fjn_close */
1187
1188 /*====================================================================*/
1189
1190 /*
1191 Set the multicast/promiscuous mode for this adaptor.
1192 */
1193
1194 static void set_rx_mode(struct net_device *dev)
1195 {
1196 unsigned int ioaddr = dev->base_addr;
1197 u_char mc_filter[8]; /* Multicast hash filter */
1198 u_long flags;
1199 int i;
1200
1201 int saved_bank;
1202 int saved_config_0 = inb(ioaddr + CONFIG_0);
1203
1204 local_irq_save(flags);
1205
1206 /* Disable Tx and Rx */
1207 if (sram_config == 0)
1208 outb(CONFIG0_RST, ioaddr + CONFIG_0);
1209 else
1210 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
1211
1212 if (dev->flags & IFF_PROMISC) {
1213 memset(mc_filter, 0xff, sizeof(mc_filter));
1214 outb(3, ioaddr + RX_MODE); /* Enable promiscuous mode */
1215 } else if (dev->mc_count > MC_FILTERBREAK
1216 || (dev->flags & IFF_ALLMULTI)) {
1217 /* Too many to filter perfectly -- accept all multicasts. */
1218 memset(mc_filter, 0xff, sizeof(mc_filter));
1219 outb(2, ioaddr + RX_MODE); /* Use normal mode. */
1220 } else if (dev->mc_count == 0) {
1221 memset(mc_filter, 0x00, sizeof(mc_filter));
1222 outb(1, ioaddr + RX_MODE); /* Ignore almost all multicasts. */
1223 } else {
1224 struct dev_mc_list *mclist;
1225
1226 memset(mc_filter, 0, sizeof(mc_filter));
1227 for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
1228 i++, mclist = mclist->next) {
1229 unsigned int bit =
1230 ether_crc_le(ETH_ALEN, mclist->dmi_addr) >> 26;
1231 mc_filter[bit >> 3] |= (1 << (bit & 7));
1232 }
1233 outb(2, ioaddr + RX_MODE); /* Use normal mode. */
1234 }
1235
1236 /* Switch to bank 1 and set the multicast table. */
1237 saved_bank = inb(ioaddr + CONFIG_1);
1238 outb(0xe4, ioaddr + CONFIG_1);
1239
1240 for (i = 0; i < 8; i++)
1241 outb(mc_filter[i], ioaddr + MAR_ADR + i);
1242 outb(saved_bank, ioaddr + CONFIG_1);
1243
1244 outb(saved_config_0, ioaddr + CONFIG_0);
1245
1246 local_irq_restore(flags);
1247 }
Support for the Chinese Samsung S3C2440 based development boards