Merge branch 'devel' of master.kernel.org:/home/rmk/linux-2.6-arm
[powerpc.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_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 }