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