IRQ: Maintain regs pointer globally rather than passing to IRQ handlers
[linux-2.6.git] / drivers / net / pcmcia / fmvj18x_cs.c
1 /*======================================================================
2     fmvj18x_cs.c 2.8 2002/03/23
3
4     A fmvj18x (and its compatibles) PCMCIA client driver
5
6     Contributed by Shingo Fujimoto, shingo@flab.fujitsu.co.jp
7
8     TDK LAK-CD021 and CONTEC C-NET(PC)C support added by 
9     Nobuhiro Katayama, kata-n@po.iijnet.or.jp
10
11     The PCMCIA client code is based on code written by David Hinds.
12     Network code is based on the "FMV-18x driver" by Yutaka TAMIYA
13     but is actually largely Donald Becker's AT1700 driver, which
14     carries the following attribution:
15
16     Written 1993-94 by Donald Becker.
17
18     Copyright 1993 United States Government as represented by the
19     Director, National Security Agency.
20     
21     This software may be used and distributed according to the terms
22     of the GNU General Public License, incorporated herein by reference.
23     
24     The author may be reached as becker@scyld.com, or C/O
25     Scyld Computing Corporation
26     410 Severn Ave., Suite 210
27     Annapolis MD 21403
28    
29 ======================================================================*/
30
31 #define DRV_NAME        "fmvj18x_cs"
32 #define DRV_VERSION     "2.9"
33
34 #include <linux/module.h>
35 #include <linux/kernel.h>
36 #include <linux/init.h>
37 #include <linux/ptrace.h>
38 #include <linux/slab.h>
39 #include <linux/string.h>
40 #include <linux/timer.h>
41 #include <linux/interrupt.h>
42 #include <linux/in.h>
43 #include <linux/delay.h>
44 #include <linux/ethtool.h>
45 #include <linux/netdevice.h>
46 #include <linux/etherdevice.h>
47 #include <linux/skbuff.h>
48 #include <linux/if_arp.h>
49 #include <linux/ioport.h>
50 #include <linux/crc32.h>
51
52 #include <pcmcia/cs_types.h>
53 #include <pcmcia/cs.h>
54 #include <pcmcia/cistpl.h>
55 #include <pcmcia/ciscode.h>
56 #include <pcmcia/ds.h>
57
58 #include <asm/uaccess.h>
59 #include <asm/io.h>
60 #include <asm/system.h>
61
62 /*====================================================================*/
63
64 /* Module parameters */
65
66 MODULE_DESCRIPTION("fmvj18x and compatible PCMCIA ethernet driver");
67 MODULE_LICENSE("GPL");
68
69 #define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0)
70
71 /* SRAM configuration */
72 /* 0:4KB*2 TX buffer   else:8KB*2 TX buffer */
73 INT_MODULE_PARM(sram_config, 0);
74
75 #ifdef PCMCIA_DEBUG
76 INT_MODULE_PARM(pc_debug, PCMCIA_DEBUG);
77 #define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args)
78 static char *version = DRV_NAME ".c " DRV_VERSION " 2002/03/23";
79 #else
80 #define DEBUG(n, args...)
81 #endif
82
83 /*====================================================================*/
84 /*
85     PCMCIA event handlers
86  */
87 static int fmvj18x_config(struct pcmcia_device *link);
88 static int fmvj18x_get_hwinfo(struct pcmcia_device *link, u_char *node_id);
89 static int fmvj18x_setup_mfc(struct pcmcia_device *link);
90 static void fmvj18x_release(struct pcmcia_device *link);
91 static void fmvj18x_detach(struct pcmcia_device *p_dev);
92
93 /*
94     LAN controller(MBH86960A) specific routines
95  */
96 static int fjn_config(struct net_device *dev, struct ifmap *map);
97 static int fjn_open(struct net_device *dev);
98 static int fjn_close(struct net_device *dev);
99 static int fjn_start_xmit(struct sk_buff *skb, struct net_device *dev);
100 static irqreturn_t fjn_interrupt(int irq, void *dev_id);
101 static void fjn_rx(struct net_device *dev);
102 static void fjn_reset(struct net_device *dev);
103 static struct net_device_stats *fjn_get_stats(struct net_device *dev);
104 static void set_rx_mode(struct net_device *dev);
105 static void fjn_tx_timeout(struct net_device *dev);
106 static const struct ethtool_ops netdev_ethtool_ops;
107
108 /*
109     card type
110  */
111 typedef enum { MBH10302, MBH10304, TDK, CONTEC, LA501, UNGERMANN, 
112                XXX10304
113 } cardtype_t;
114
115 /*
116     driver specific data structure
117 */
118 typedef struct local_info_t {
119         struct pcmcia_device    *p_dev;
120     dev_node_t node;
121     struct net_device_stats stats;
122     long open_time;
123     uint tx_started:1;
124     uint tx_queue;
125     u_short tx_queue_len;
126     cardtype_t cardtype;
127     u_short sent;
128 } local_info_t;
129
130 #define MC_FILTERBREAK 64
131
132 /*====================================================================*/
133 /* 
134     ioport offset from the base address 
135  */
136 #define TX_STATUS               0 /* transmit status register */
137 #define RX_STATUS               1 /* receive status register */
138 #define TX_INTR                 2 /* transmit interrupt mask register */
139 #define RX_INTR                 3 /* receive interrupt mask register */
140 #define TX_MODE                 4 /* transmit mode register */
141 #define RX_MODE                 5 /* receive mode register */
142 #define CONFIG_0                6 /* configuration register 0 */
143 #define CONFIG_1                7 /* configuration register 1 */
144
145 #define NODE_ID                 8 /* node ID register            (bank 0) */
146 #define MAR_ADR                 8 /* multicast address registers (bank 1) */
147
148 #define DATAPORT                8 /* buffer mem port registers   (bank 2) */
149 #define TX_START               10 /* transmit start register */
150 #define COL_CTRL               11 /* 16 collision control register */
151 #define BMPR12                 12 /* reserved */
152 #define BMPR13                 13 /* reserved */
153 #define RX_SKIP                14 /* skip received packet register */
154
155 #define LAN_CTRL               16 /* LAN card control register */
156
157 #define MAC_ID               0x1a /* hardware address */
158 #define UNGERMANN_MAC_ID     0x18 /* UNGERMANN-BASS hardware address */
159
160 /* 
161     control bits 
162  */
163 #define ENA_TMT_OK           0x80
164 #define ENA_TMT_REC          0x20
165 #define ENA_COL              0x04
166 #define ENA_16_COL           0x02
167 #define ENA_TBUS_ERR         0x01
168
169 #define ENA_PKT_RDY          0x80
170 #define ENA_BUS_ERR          0x40
171 #define ENA_LEN_ERR          0x08
172 #define ENA_ALG_ERR          0x04
173 #define ENA_CRC_ERR          0x02
174 #define ENA_OVR_FLO          0x01
175
176 /* flags */
177 #define F_TMT_RDY            0x80 /* can accept new packet */
178 #define F_NET_BSY            0x40 /* carrier is detected */
179 #define F_TMT_OK             0x20 /* send packet successfully */
180 #define F_SRT_PKT            0x10 /* short packet error */
181 #define F_COL_ERR            0x04 /* collision error */
182 #define F_16_COL             0x02 /* 16 collision error */
183 #define F_TBUS_ERR           0x01 /* bus read error */
184
185 #define F_PKT_RDY            0x80 /* packet(s) in buffer */
186 #define F_BUS_ERR            0x40 /* bus read error */
187 #define F_LEN_ERR            0x08 /* short packet */
188 #define F_ALG_ERR            0x04 /* frame error */
189 #define F_CRC_ERR            0x02 /* CRC error */
190 #define F_OVR_FLO            0x01 /* overflow error */
191
192 #define F_BUF_EMP            0x40 /* receive buffer is empty */
193
194 #define F_SKP_PKT            0x05 /* drop packet in buffer */
195
196 /* default bitmaps */
197 #define D_TX_INTR  ( ENA_TMT_OK )
198 #define D_RX_INTR  ( ENA_PKT_RDY | ENA_LEN_ERR \
199                    | ENA_ALG_ERR | ENA_CRC_ERR | ENA_OVR_FLO )
200 #define TX_STAT_M  ( F_TMT_RDY )
201 #define RX_STAT_M  ( F_PKT_RDY | F_LEN_ERR \
202                    | F_ALG_ERR | F_CRC_ERR | F_OVR_FLO )
203
204 /* commands */
205 #define D_TX_MODE            0x06 /* no tests, detect carrier */
206 #define ID_MATCHED           0x02 /* (RX_MODE) */
207 #define RECV_ALL             0x03 /* (RX_MODE) */
208 #define CONFIG0_DFL          0x5a /* 16bit bus, 4K x 2 Tx queues */
209 #define CONFIG0_DFL_1        0x5e /* 16bit bus, 8K x 2 Tx queues */
210 #define CONFIG0_RST          0xda /* Data Link Controller off (CONFIG_0) */
211 #define CONFIG0_RST_1        0xde /* Data Link Controller off (CONFIG_0) */
212 #define BANK_0               0xa0 /* bank 0 (CONFIG_1) */
213 #define BANK_1               0xa4 /* bank 1 (CONFIG_1) */
214 #define BANK_2               0xa8 /* bank 2 (CONFIG_1) */
215 #define CHIP_OFF             0x80 /* contrl chip power off (CONFIG_1) */
216 #define DO_TX                0x80 /* do transmit packet */
217 #define SEND_PKT             0x81 /* send a packet */
218 #define AUTO_MODE            0x07 /* Auto skip packet on 16 col detected */
219 #define MANU_MODE            0x03 /* Stop and skip packet on 16 col */
220 #define TDK_AUTO_MODE        0x47 /* Auto skip packet on 16 col detected */
221 #define TDK_MANU_MODE        0x43 /* Stop and skip packet on 16 col */
222 #define INTR_OFF             0x0d /* LAN controller ignores interrupts */
223 #define INTR_ON              0x1d /* LAN controller will catch interrupts */
224
225 #define TX_TIMEOUT              ((400*HZ)/1000)
226
227 #define BANK_0U              0x20 /* bank 0 (CONFIG_1) */
228 #define BANK_1U              0x24 /* bank 1 (CONFIG_1) */
229 #define BANK_2U              0x28 /* bank 2 (CONFIG_1) */
230
231 static int fmvj18x_probe(struct pcmcia_device *link)
232 {
233     local_info_t *lp;
234     struct net_device *dev;
235
236     DEBUG(0, "fmvj18x_attach()\n");
237
238     /* Make up a FMVJ18x specific data structure */
239     dev = alloc_etherdev(sizeof(local_info_t));
240     if (!dev)
241         return -ENOMEM;
242     lp = netdev_priv(dev);
243     link->priv = dev;
244     lp->p_dev = link;
245
246     /* The io structure describes IO port mapping */
247     link->io.NumPorts1 = 32;
248     link->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
249     link->io.IOAddrLines = 5;
250
251     /* Interrupt setup */
252     link->irq.Attributes = IRQ_TYPE_EXCLUSIVE | IRQ_HANDLE_PRESENT;
253     link->irq.IRQInfo1 = IRQ_LEVEL_ID;
254     link->irq.Handler = &fjn_interrupt;
255     link->irq.Instance = dev;
256
257     /* General socket configuration */
258     link->conf.Attributes = CONF_ENABLE_IRQ;
259     link->conf.IntType = INT_MEMORY_AND_IO;
260
261     /* The FMVJ18x specific entries in the device structure. */
262     SET_MODULE_OWNER(dev);
263     dev->hard_start_xmit = &fjn_start_xmit;
264     dev->set_config = &fjn_config;
265     dev->get_stats = &fjn_get_stats;
266     dev->set_multicast_list = &set_rx_mode;
267     dev->open = &fjn_open;
268     dev->stop = &fjn_close;
269 #ifdef HAVE_TX_TIMEOUT
270     dev->tx_timeout = fjn_tx_timeout;
271     dev->watchdog_timeo = TX_TIMEOUT;
272 #endif
273     SET_ETHTOOL_OPS(dev, &netdev_ethtool_ops);
274
275     return fmvj18x_config(link);
276 } /* fmvj18x_attach */
277
278 /*====================================================================*/
279
280 static void fmvj18x_detach(struct pcmcia_device *link)
281 {
282     struct net_device *dev = link->priv;
283
284     DEBUG(0, "fmvj18x_detach(0x%p)\n", link);
285
286     if (link->dev_node)
287         unregister_netdev(dev);
288
289     fmvj18x_release(link);
290
291     free_netdev(dev);
292 } /* fmvj18x_detach */
293
294 /*====================================================================*/
295
296 #define CS_CHECK(fn, ret) \
297 do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
298
299 static int mfc_try_io_port(struct pcmcia_device *link)
300 {
301     int i, ret;
302     static const kio_addr_t serial_base[5] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, 0x0 };
303
304     for (i = 0; i < 5; i++) {
305         link->io.BasePort2 = serial_base[i];
306         link->io.Attributes2 = IO_DATA_PATH_WIDTH_8;
307         if (link->io.BasePort2 == 0) {
308             link->io.NumPorts2 = 0;
309             printk(KERN_NOTICE "fmvj18x_cs: out of resource for serial\n");
310         }
311         ret = pcmcia_request_io(link, &link->io);
312         if (ret == CS_SUCCESS) return ret;
313     }
314     return ret;
315 }
316
317 static int ungermann_try_io_port(struct pcmcia_device *link)
318 {
319     int ret;
320     kio_addr_t ioaddr;
321     /*
322         Ungermann-Bass Access/CARD accepts 0x300,0x320,0x340,0x360
323         0x380,0x3c0 only for ioport.
324     */
325     for (ioaddr = 0x300; ioaddr < 0x3e0; ioaddr += 0x20) {
326         link->io.BasePort1 = ioaddr;
327         ret = pcmcia_request_io(link, &link->io);
328         if (ret == CS_SUCCESS) {
329             /* calculate ConfigIndex value */
330             link->conf.ConfigIndex = 
331                 ((link->io.BasePort1 & 0x0f0) >> 3) | 0x22;
332             return ret;
333         }
334     }
335     return ret; /* RequestIO failed */
336 }
337
338 static int fmvj18x_config(struct pcmcia_device *link)
339 {
340     struct net_device *dev = link->priv;
341     local_info_t *lp = netdev_priv(dev);
342     tuple_t tuple;
343     cisparse_t parse;
344     u_short buf[32];
345     int i, last_fn, last_ret, ret;
346     kio_addr_t ioaddr;
347     cardtype_t cardtype;
348     char *card_name = "unknown";
349     u_char *node_id;
350
351     DEBUG(0, "fmvj18x_config(0x%p)\n", link);
352
353     /*
354        This reads the card's CONFIG tuple to find its configuration
355        registers.
356     */
357     tuple.DesiredTuple = CISTPL_CONFIG;
358     CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
359     tuple.TupleData = (u_char *)buf;
360     tuple.TupleDataMax = 64;
361     tuple.TupleOffset = 0;
362     CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
363     CS_CHECK(ParseTuple, pcmcia_parse_tuple(link, &tuple, &parse));
364
365     link->conf.ConfigBase = parse.config.base; 
366     link->conf.Present = parse.config.rmask[0];
367
368     tuple.DesiredTuple = CISTPL_FUNCE;
369     tuple.TupleOffset = 0;
370     if (pcmcia_get_first_tuple(link, &tuple) == CS_SUCCESS) {
371         /* Yes, I have CISTPL_FUNCE. Let's check CISTPL_MANFID */
372         tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
373         CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
374         CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
375         CS_CHECK(ParseTuple, pcmcia_parse_tuple(link, &tuple, &parse));
376         link->conf.ConfigIndex = parse.cftable_entry.index;
377         tuple.DesiredTuple = CISTPL_MANFID;
378         if (pcmcia_get_first_tuple(link, &tuple) == CS_SUCCESS)
379             CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
380         else
381             buf[0] = 0xffff;
382         switch (le16_to_cpu(buf[0])) {
383         case MANFID_TDK:
384             cardtype = TDK;
385             if (le16_to_cpu(buf[1]) == PRODID_TDK_GN3410
386                         || le16_to_cpu(buf[1]) == PRODID_TDK_NP9610
387                         || le16_to_cpu(buf[1]) == PRODID_TDK_MN3200) {
388                 /* MultiFunction Card */
389                 link->conf.ConfigBase = 0x800;
390                 link->conf.ConfigIndex = 0x47;
391                 link->io.NumPorts2 = 8;
392             }
393             break;
394         case MANFID_CONTEC:
395             cardtype = CONTEC;
396             break;
397         case MANFID_FUJITSU:
398             if (le16_to_cpu(buf[1]) == PRODID_FUJITSU_MBH10302)
399                 /* RATOC REX-5588/9822/4886's PRODID are 0004(=MBH10302),
400                    but these are MBH10304 based card. */ 
401                 cardtype = MBH10304;
402             else if (le16_to_cpu(buf[1]) == PRODID_FUJITSU_MBH10304)
403                 cardtype = MBH10304;
404             else
405                 cardtype = LA501;
406             break;
407         default:
408             cardtype = MBH10304;
409         }
410     } else {
411         /* old type card */
412         tuple.DesiredTuple = CISTPL_MANFID;
413         if (pcmcia_get_first_tuple(link, &tuple) == CS_SUCCESS)
414             CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
415         else
416             buf[0] = 0xffff;
417         switch (le16_to_cpu(buf[0])) {
418         case MANFID_FUJITSU:
419             if (le16_to_cpu(buf[1]) == PRODID_FUJITSU_MBH10304) {
420                 cardtype = XXX10304;    /* MBH10304 with buggy CIS */
421                 link->conf.ConfigIndex = 0x20;
422             } else {
423                 cardtype = MBH10302;    /* NextCom NC5310, etc. */
424                 link->conf.ConfigIndex = 1;
425             }
426             break;
427         case MANFID_UNGERMANN:
428             cardtype = UNGERMANN;
429             break;
430         default:
431             cardtype = MBH10302;
432             link->conf.ConfigIndex = 1;
433         }
434     }
435
436     if (link->io.NumPorts2 != 0) {
437         link->irq.Attributes =
438                 IRQ_TYPE_DYNAMIC_SHARING|IRQ_FIRST_SHARED|IRQ_HANDLE_PRESENT;
439         ret = mfc_try_io_port(link);
440         if (ret != CS_SUCCESS) goto cs_failed;
441     } else if (cardtype == UNGERMANN) {
442         ret = ungermann_try_io_port(link);
443         if (ret != CS_SUCCESS) goto cs_failed;
444     } else { 
445         CS_CHECK(RequestIO, pcmcia_request_io(link, &link->io));
446     }
447     CS_CHECK(RequestIRQ, pcmcia_request_irq(link, &link->irq));
448     CS_CHECK(RequestConfiguration, pcmcia_request_configuration(link, &link->conf));
449     dev->irq = link->irq.AssignedIRQ;
450     dev->base_addr = link->io.BasePort1;
451
452     if (link->io.BasePort2 != 0)
453         fmvj18x_setup_mfc(link);
454
455     ioaddr = dev->base_addr;
456
457     /* Reset controller */
458     if (sram_config == 0) 
459         outb(CONFIG0_RST, ioaddr + CONFIG_0);
460     else
461         outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
462
463     /* Power On chip and select bank 0 */
464     if (cardtype == MBH10302)
465         outb(BANK_0, ioaddr + CONFIG_1);
466     else
467         outb(BANK_0U, ioaddr + CONFIG_1);
468     
469     /* Set hardware address */
470     switch (cardtype) {
471     case MBH10304:
472     case TDK:
473     case LA501:
474     case CONTEC:
475         tuple.DesiredTuple = CISTPL_FUNCE;
476         tuple.TupleOffset = 0;
477         CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
478         tuple.TupleOffset = 0;
479         CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
480         if (cardtype == MBH10304) {
481             /* MBH10304's CIS_FUNCE is corrupted */
482             node_id = &(tuple.TupleData[5]);
483             card_name = "FMV-J182";
484         } else {
485             while (tuple.TupleData[0] != CISTPL_FUNCE_LAN_NODE_ID ) {
486                 CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(link, &tuple));
487                 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
488             }
489             node_id = &(tuple.TupleData[2]);
490             if( cardtype == TDK ) {
491                 card_name = "TDK LAK-CD021";
492             } else if( cardtype == LA501 ) {
493                 card_name = "LA501";
494             } else {
495                 card_name = "C-NET(PC)C";
496             }
497         }
498         /* Read MACID from CIS */
499         for (i = 0; i < 6; i++)
500             dev->dev_addr[i] = node_id[i];
501         break;
502     case UNGERMANN:
503         /* Read MACID from register */
504         for (i = 0; i < 6; i++) 
505             dev->dev_addr[i] = inb(ioaddr + UNGERMANN_MAC_ID + i);
506         card_name = "Access/CARD";
507         break;
508     case XXX10304:
509         /* Read MACID from Buggy CIS */
510         if (fmvj18x_get_hwinfo(link, tuple.TupleData) == -1) {
511             printk(KERN_NOTICE "fmvj18x_cs: unable to read hardware net address.\n");
512             goto failed;
513         }
514         for (i = 0 ; i < 6; i++) {
515             dev->dev_addr[i] = tuple.TupleData[i];
516         }
517         card_name = "FMV-J182";
518         break;
519     case MBH10302:
520     default:
521         /* Read MACID from register */
522         for (i = 0; i < 6; i++) 
523             dev->dev_addr[i] = inb(ioaddr + MAC_ID + i);
524         card_name = "FMV-J181";
525         break;
526     }
527
528     lp->cardtype = cardtype;
529     link->dev_node = &lp->node;
530     SET_NETDEV_DEV(dev, &handle_to_dev(link));
531
532     if (register_netdev(dev) != 0) {
533         printk(KERN_NOTICE "fmvj18x_cs: register_netdev() failed\n");
534         link->dev_node = NULL;
535         goto failed;
536     }
537
538     strcpy(lp->node.dev_name, dev->name);
539
540     /* print current configuration */
541     printk(KERN_INFO "%s: %s, sram %s, port %#3lx, irq %d, hw_addr ", 
542            dev->name, card_name, sram_config == 0 ? "4K TX*2" : "8K TX*2", 
543            dev->base_addr, dev->irq);
544     for (i = 0; i < 6; i++)
545         printk("%02X%s", dev->dev_addr[i], ((i<5) ? ":" : "\n"));
546
547     return 0;
548     
549 cs_failed:
550     /* All Card Services errors end up here */
551     cs_error(link, last_fn, last_ret);
552 failed:
553     fmvj18x_release(link);
554     return -ENODEV;
555 } /* fmvj18x_config */
556 /*====================================================================*/
557
558 static int fmvj18x_get_hwinfo(struct pcmcia_device *link, u_char *node_id)
559 {
560     win_req_t req;
561     memreq_t mem;
562     u_char __iomem *base;
563     int i, j;
564
565     /* Allocate a small memory window */
566     req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
567     req.Base = 0; req.Size = 0;
568     req.AccessSpeed = 0;
569     i = pcmcia_request_window(&link, &req, &link->win);
570     if (i != CS_SUCCESS) {
571         cs_error(link, RequestWindow, i);
572         return -1;
573     }
574
575     base = ioremap(req.Base, req.Size);
576     mem.Page = 0;
577     mem.CardOffset = 0;
578     pcmcia_map_mem_page(link->win, &mem);
579
580     /*
581      *  MBH10304 CISTPL_FUNCE_LAN_NODE_ID format
582      *  22 0d xx xx xx 04 06 yy yy yy yy yy yy ff
583      *  'xx' is garbage.
584      *  'yy' is MAC address.
585     */ 
586     for (i = 0; i < 0x200; i++) {
587         if (readb(base+i*2) == 0x22) {  
588             if (readb(base+(i-1)*2) == 0xff
589              && readb(base+(i+5)*2) == 0x04
590              && readb(base+(i+6)*2) == 0x06
591              && readb(base+(i+13)*2) == 0xff) 
592                 break;
593         }
594     }
595
596     if (i != 0x200) {
597         for (j = 0 ; j < 6; j++,i++) {
598             node_id[j] = readb(base+(i+7)*2);
599         }
600     }
601
602     iounmap(base);
603     j = pcmcia_release_window(link->win);
604     if (j != CS_SUCCESS)
605         cs_error(link, ReleaseWindow, j);
606     return (i != 0x200) ? 0 : -1;
607
608 } /* fmvj18x_get_hwinfo */
609 /*====================================================================*/
610
611 static int fmvj18x_setup_mfc(struct pcmcia_device *link)
612 {
613     win_req_t req;
614     memreq_t mem;
615     u_char __iomem *base;
616     int i, j;
617     struct net_device *dev = link->priv;
618     kio_addr_t ioaddr;
619
620     /* Allocate a small memory window */
621     req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
622     req.Base = 0; req.Size = 0;
623     req.AccessSpeed = 0;
624     i = pcmcia_request_window(&link, &req, &link->win);
625     if (i != CS_SUCCESS) {
626         cs_error(link, RequestWindow, i);
627         return -1;
628     }
629
630     base = ioremap(req.Base, req.Size);
631     mem.Page = 0;
632     mem.CardOffset = 0;
633     pcmcia_map_mem_page(link->win, &mem);
634
635     ioaddr = dev->base_addr;
636     writeb(0x47, base+0x800);   /* Config Option Register of LAN */
637     writeb(0x0, base+0x802);    /* Config and Status Register */
638
639     writeb(ioaddr & 0xff, base+0x80a);          /* I/O Base(Low) of LAN */
640     writeb((ioaddr >> 8) & 0xff, base+0x80c);   /* I/O Base(High) of LAN */
641    
642     writeb(0x45, base+0x820);   /* Config Option Register of Modem */
643     writeb(0x8, base+0x822);    /* Config and Status Register */
644
645     iounmap(base);
646     j = pcmcia_release_window(link->win);
647     if (j != CS_SUCCESS)
648         cs_error(link, ReleaseWindow, j);
649     return 0;
650
651 }
652 /*====================================================================*/
653
654 static void fmvj18x_release(struct pcmcia_device *link)
655 {
656         DEBUG(0, "fmvj18x_release(0x%p)\n", link);
657         pcmcia_disable_device(link);
658 }
659
660 static int fmvj18x_suspend(struct pcmcia_device *link)
661 {
662         struct net_device *dev = link->priv;
663
664         if (link->open)
665                 netif_device_detach(dev);
666
667         return 0;
668 }
669
670 static int fmvj18x_resume(struct pcmcia_device *link)
671 {
672         struct net_device *dev = link->priv;
673
674         if (link->open) {
675                 fjn_reset(dev);
676                 netif_device_attach(dev);
677         }
678
679         return 0;
680 }
681
682 /*====================================================================*/
683
684 static struct pcmcia_device_id fmvj18x_ids[] = {
685         PCMCIA_DEVICE_MANF_CARD(0x0004, 0x0004),
686         PCMCIA_DEVICE_PROD_ID12("EAGLE Technology", "NE200 ETHERNET LAN MBH10302 04", 0x528c88c4, 0x74f91e59),
687         PCMCIA_DEVICE_PROD_ID12("Eiger Labs,Inc", "EPX-10BT PC Card Ethernet 10BT", 0x53af556e, 0x877f9922),
688         PCMCIA_DEVICE_PROD_ID12("Eiger labs,Inc.", "EPX-10BT PC Card Ethernet 10BT", 0xf47e6c66, 0x877f9922),
689         PCMCIA_DEVICE_PROD_ID12("FUJITSU", "LAN Card(FMV-J182)", 0x6ee5a3d8, 0x5baf31db),
690         PCMCIA_DEVICE_PROD_ID12("FUJITSU", "MBH10308", 0x6ee5a3d8, 0x3f04875e),
691         PCMCIA_DEVICE_PROD_ID12("FUJITSU TOWA", "LA501", 0xb8451188, 0x12939ba2),
692         PCMCIA_DEVICE_PROD_ID12("HITACHI", "HT-4840-11", 0xf4f43949, 0x773910f4),
693         PCMCIA_DEVICE_PROD_ID12("NextComK.K.", "NC5310B Ver1.0       ", 0x8cef4d3a, 0x075fc7b6),
694         PCMCIA_DEVICE_PROD_ID12("NextComK.K.", "NC5310 Ver1.0        ", 0x8cef4d3a, 0xbccf43e6),
695         PCMCIA_DEVICE_PROD_ID12("RATOC System Inc.", "10BASE_T CARD R280", 0x85c10e17, 0xd9413666),
696         PCMCIA_DEVICE_PROD_ID12("TDK", "LAC-CD02x", 0x1eae9475, 0x8fa0ee70),
697         PCMCIA_DEVICE_PROD_ID12("TDK", "LAC-CF010", 0x1eae9475, 0x7683bc9a),
698         PCMCIA_DEVICE_PROD_ID1("CONTEC Co.,Ltd.", 0x58d8fee2),
699         PCMCIA_DEVICE_PROD_ID1("PCMCIA LAN MBH10304  ES", 0x2599f454),
700         PCMCIA_DEVICE_PROD_ID1("PCMCIA MBH10302", 0x8f4005da),
701         PCMCIA_DEVICE_PROD_ID1("UBKK,V2.0", 0x90888080),
702         PCMCIA_PFC_DEVICE_PROD_ID12(0, "TDK", "GlobalNetworker 3410/3412", 0x1eae9475, 0xd9a93bed),
703         PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0105, 0x0d0a),
704         PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0105, 0x0e0a),
705         PCMCIA_DEVICE_NULL,
706 };
707 MODULE_DEVICE_TABLE(pcmcia, fmvj18x_ids);
708
709 static struct pcmcia_driver fmvj18x_cs_driver = {
710         .owner          = THIS_MODULE,
711         .drv            = {
712                 .name   = "fmvj18x_cs",
713         },
714         .probe          = fmvj18x_probe,
715         .remove         = fmvj18x_detach,
716         .id_table       = fmvj18x_ids,
717         .suspend        = fmvj18x_suspend,
718         .resume         = fmvj18x_resume,
719 };
720
721 static int __init init_fmvj18x_cs(void)
722 {
723         return pcmcia_register_driver(&fmvj18x_cs_driver);
724 }
725
726 static void __exit exit_fmvj18x_cs(void)
727 {
728         pcmcia_unregister_driver(&fmvj18x_cs_driver);
729 }
730
731 module_init(init_fmvj18x_cs);
732 module_exit(exit_fmvj18x_cs);
733
734 /*====================================================================*/
735
736 static irqreturn_t fjn_interrupt(int irq, void *dev_id)
737 {
738     struct net_device *dev = dev_id;
739     local_info_t *lp = netdev_priv(dev);
740     kio_addr_t ioaddr;
741     unsigned short tx_stat, rx_stat;
742
743     if (lp == NULL) {
744         printk(KERN_NOTICE "fjn_interrupt(): irq %d for "
745                "unknown device.\n", irq);
746         return IRQ_NONE;
747     }
748     ioaddr = dev->base_addr;
749
750     /* avoid multiple interrupts */
751     outw(0x0000, ioaddr + TX_INTR);
752
753     /* wait for a while */
754     udelay(1);
755
756     /* get status */
757     tx_stat = inb(ioaddr + TX_STATUS);
758     rx_stat = inb(ioaddr + RX_STATUS);
759
760     /* clear status */
761     outb(tx_stat, ioaddr + TX_STATUS);
762     outb(rx_stat, ioaddr + RX_STATUS);
763     
764     DEBUG(4, "%s: interrupt, rx_status %02x.\n", dev->name, rx_stat);
765     DEBUG(4, "               tx_status %02x.\n", tx_stat);
766     
767     if (rx_stat || (inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
768         /* there is packet(s) in rx buffer */
769         fjn_rx(dev);
770     }
771     if (tx_stat & F_TMT_RDY) {
772         lp->stats.tx_packets += lp->sent ;
773         lp->sent = 0 ;
774         if (lp->tx_queue) {
775             outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
776             lp->sent = lp->tx_queue ;
777             lp->tx_queue = 0;
778             lp->tx_queue_len = 0;
779             dev->trans_start = jiffies;
780         } else {
781             lp->tx_started = 0;
782         }
783         netif_wake_queue(dev);
784     }
785     DEBUG(4, "%s: exiting interrupt,\n", dev->name);
786     DEBUG(4, "    tx_status %02x, rx_status %02x.\n", tx_stat, rx_stat);
787
788     outb(D_TX_INTR, ioaddr + TX_INTR);
789     outb(D_RX_INTR, ioaddr + RX_INTR);
790     return IRQ_HANDLED;
791
792 } /* fjn_interrupt */
793
794 /*====================================================================*/
795
796 static void fjn_tx_timeout(struct net_device *dev)
797 {
798     struct local_info_t *lp = netdev_priv(dev);
799     kio_addr_t ioaddr = dev->base_addr;
800
801     printk(KERN_NOTICE "%s: transmit timed out with status %04x, %s?\n",
802            dev->name, htons(inw(ioaddr + TX_STATUS)),
803            inb(ioaddr + TX_STATUS) & F_TMT_RDY
804            ? "IRQ conflict" : "network cable problem");
805     printk(KERN_NOTICE "%s: timeout registers: %04x %04x %04x "
806            "%04x %04x %04x %04x %04x.\n",
807            dev->name, htons(inw(ioaddr + 0)),
808            htons(inw(ioaddr + 2)), htons(inw(ioaddr + 4)),
809            htons(inw(ioaddr + 6)), htons(inw(ioaddr + 8)),
810            htons(inw(ioaddr +10)), htons(inw(ioaddr +12)),
811            htons(inw(ioaddr +14)));
812     lp->stats.tx_errors++;
813     /* ToDo: We should try to restart the adaptor... */
814     local_irq_disable();
815     fjn_reset(dev);
816
817     lp->tx_started = 0;
818     lp->tx_queue = 0;
819     lp->tx_queue_len = 0;
820     lp->sent = 0;
821     lp->open_time = jiffies;
822     local_irq_enable();
823     netif_wake_queue(dev);
824 }
825
826 static int fjn_start_xmit(struct sk_buff *skb, struct net_device *dev)
827 {
828     struct local_info_t *lp = netdev_priv(dev);
829     kio_addr_t ioaddr = dev->base_addr;
830     short length = skb->len;
831     
832     if (length < ETH_ZLEN)
833     {
834         if (skb_padto(skb, ETH_ZLEN))
835                 return 0;
836         length = ETH_ZLEN;
837     }
838
839     netif_stop_queue(dev);
840
841     {
842         unsigned char *buf = skb->data;
843
844         if (length > ETH_FRAME_LEN) {
845             printk(KERN_NOTICE "%s: Attempting to send a large packet"
846                    " (%d bytes).\n", dev->name, length);
847             return 1;
848         }
849
850         DEBUG(4, "%s: Transmitting a packet of length %lu.\n",
851               dev->name, (unsigned long)skb->len);
852         lp->stats.tx_bytes += skb->len;
853
854         /* Disable both interrupts. */
855         outw(0x0000, ioaddr + TX_INTR);
856
857         /* wait for a while */
858         udelay(1);
859
860         outw(length, ioaddr + DATAPORT);
861         outsw(ioaddr + DATAPORT, buf, (length + 1) >> 1);
862
863         lp->tx_queue++;
864         lp->tx_queue_len += ((length+3) & ~1);
865
866         if (lp->tx_started == 0) {
867             /* If the Tx is idle, always trigger a transmit. */
868             outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
869             lp->sent = lp->tx_queue ;
870             lp->tx_queue = 0;
871             lp->tx_queue_len = 0;
872             dev->trans_start = jiffies;
873             lp->tx_started = 1;
874             netif_start_queue(dev);
875         } else {
876             if( sram_config == 0 ) {
877                 if (lp->tx_queue_len < (4096 - (ETH_FRAME_LEN +2)) )
878                     /* Yes, there is room for one more packet. */
879                     netif_start_queue(dev);
880             } else {
881                 if (lp->tx_queue_len < (8192 - (ETH_FRAME_LEN +2)) && 
882                                                 lp->tx_queue < 127 )
883                     /* Yes, there is room for one more packet. */
884                     netif_start_queue(dev);
885             }
886         }
887
888         /* Re-enable interrupts */
889         outb(D_TX_INTR, ioaddr + TX_INTR);
890         outb(D_RX_INTR, ioaddr + RX_INTR);
891     }
892     dev_kfree_skb (skb);
893
894     return 0;
895 } /* fjn_start_xmit */
896
897 /*====================================================================*/
898
899 static void fjn_reset(struct net_device *dev)
900 {
901     struct local_info_t *lp = netdev_priv(dev);
902     kio_addr_t ioaddr = dev->base_addr;
903     int i;
904
905     DEBUG(4, "fjn_reset(%s) called.\n",dev->name);
906
907     /* Reset controller */
908     if( sram_config == 0 ) 
909         outb(CONFIG0_RST, ioaddr + CONFIG_0);
910     else
911         outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
912
913     /* Power On chip and select bank 0 */
914     if (lp->cardtype == MBH10302)
915         outb(BANK_0, ioaddr + CONFIG_1);
916     else
917         outb(BANK_0U, ioaddr + CONFIG_1);
918
919     /* Set Tx modes */
920     outb(D_TX_MODE, ioaddr + TX_MODE);
921     /* set Rx modes */
922     outb(ID_MATCHED, ioaddr + RX_MODE);
923
924     /* Set hardware address */
925     for (i = 0; i < 6; i++) 
926         outb(dev->dev_addr[i], ioaddr + NODE_ID + i);
927
928     /* (re)initialize the multicast table */
929     set_rx_mode(dev);
930
931     /* Switch to bank 2 (runtime mode) */
932     if (lp->cardtype == MBH10302)
933         outb(BANK_2, ioaddr + CONFIG_1);
934     else
935         outb(BANK_2U, ioaddr + CONFIG_1);
936
937     /* set 16col ctrl bits */
938     if( lp->cardtype == TDK || lp->cardtype == CONTEC) 
939         outb(TDK_AUTO_MODE, ioaddr + COL_CTRL);
940     else
941         outb(AUTO_MODE, ioaddr + COL_CTRL);
942
943     /* clear Reserved Regs */
944     outb(0x00, ioaddr + BMPR12);
945     outb(0x00, ioaddr + BMPR13);
946
947     /* reset Skip packet reg. */
948     outb(0x01, ioaddr + RX_SKIP);
949
950     /* Enable Tx and Rx */
951     if( sram_config == 0 )
952         outb(CONFIG0_DFL, ioaddr + CONFIG_0);
953     else
954         outb(CONFIG0_DFL_1, ioaddr + CONFIG_0);
955
956     /* Init receive pointer ? */
957     inw(ioaddr + DATAPORT);
958     inw(ioaddr + DATAPORT);
959
960     /* Clear all status */
961     outb(0xff, ioaddr + TX_STATUS);
962     outb(0xff, ioaddr + RX_STATUS);
963
964     if (lp->cardtype == MBH10302)
965         outb(INTR_OFF, ioaddr + LAN_CTRL);
966
967     /* Turn on Rx interrupts */
968     outb(D_TX_INTR, ioaddr + TX_INTR);
969     outb(D_RX_INTR, ioaddr + RX_INTR);
970
971     /* Turn on interrupts from LAN card controller */
972     if (lp->cardtype == MBH10302)
973         outb(INTR_ON, ioaddr + LAN_CTRL);
974 } /* fjn_reset */
975
976 /*====================================================================*/
977
978 static void fjn_rx(struct net_device *dev)
979 {
980     struct local_info_t *lp = netdev_priv(dev);
981     kio_addr_t ioaddr = dev->base_addr;
982     int boguscount = 10;        /* 5 -> 10: by agy 19940922 */
983
984     DEBUG(4, "%s: in rx_packet(), rx_status %02x.\n",
985           dev->name, inb(ioaddr + RX_STATUS));
986
987     while ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
988         u_short status = inw(ioaddr + DATAPORT);
989
990         DEBUG(4, "%s: Rxing packet mode %02x status %04x.\n",
991               dev->name, inb(ioaddr + RX_MODE), status);
992 #ifndef final_version
993         if (status == 0) {
994             outb(F_SKP_PKT, ioaddr + RX_SKIP);
995             break;
996         }
997 #endif
998         if ((status & 0xF0) != 0x20) {  /* There was an error. */
999             lp->stats.rx_errors++;
1000             if (status & F_LEN_ERR) lp->stats.rx_length_errors++;
1001             if (status & F_ALG_ERR) lp->stats.rx_frame_errors++;
1002             if (status & F_CRC_ERR) lp->stats.rx_crc_errors++;
1003             if (status & F_OVR_FLO) lp->stats.rx_over_errors++;
1004         } else {
1005             u_short pkt_len = inw(ioaddr + DATAPORT);
1006             /* Malloc up new buffer. */
1007             struct sk_buff *skb;
1008
1009             if (pkt_len > 1550) {
1010                 printk(KERN_NOTICE "%s: The FMV-18x claimed a very "
1011                        "large packet, size %d.\n", dev->name, pkt_len);
1012                 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1013                 lp->stats.rx_errors++;
1014                 break;
1015             }
1016             skb = dev_alloc_skb(pkt_len+2);
1017             if (skb == NULL) {
1018                 printk(KERN_NOTICE "%s: Memory squeeze, dropping "
1019                        "packet (len %d).\n", dev->name, pkt_len);
1020                 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1021                 lp->stats.rx_dropped++;
1022                 break;
1023             }
1024             skb->dev = dev;
1025
1026             skb_reserve(skb, 2);
1027             insw(ioaddr + DATAPORT, skb_put(skb, pkt_len),
1028                  (pkt_len + 1) >> 1);
1029             skb->protocol = eth_type_trans(skb, dev);
1030
1031 #ifdef PCMCIA_DEBUG
1032             if (pc_debug > 5) {
1033                 int i;
1034                 printk(KERN_DEBUG "%s: Rxed packet of length %d: ",
1035                        dev->name, pkt_len);
1036                 for (i = 0; i < 14; i++)
1037                     printk(" %02x", skb->data[i]);
1038                 printk(".\n");
1039             }
1040 #endif
1041
1042             netif_rx(skb);
1043             dev->last_rx = jiffies;
1044             lp->stats.rx_packets++;
1045             lp->stats.rx_bytes += pkt_len;
1046         }
1047         if (--boguscount <= 0)
1048             break;
1049     }
1050
1051     /* If any worth-while packets have been received, dev_rint()
1052            has done a netif_wake_queue() for us and will work on them
1053            when we get to the bottom-half routine. */
1054 /*
1055     if (lp->cardtype != TDK) {
1056         int i;
1057         for (i = 0; i < 20; i++) {
1058             if ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == F_BUF_EMP)
1059                 break;
1060             (void)inw(ioaddr + DATAPORT);  /+ dummy status read +/
1061             outb(F_SKP_PKT, ioaddr + RX_SKIP);
1062         }
1063
1064         if (i > 0)
1065             DEBUG(5, "%s: Exint Rx packet with mode %02x after "
1066                   "%d ticks.\n", dev->name, inb(ioaddr + RX_MODE), i);
1067     }
1068 */
1069
1070     return;
1071 } /* fjn_rx */
1072
1073 /*====================================================================*/
1074
1075 static void netdev_get_drvinfo(struct net_device *dev,
1076                                struct ethtool_drvinfo *info)
1077 {
1078         strcpy(info->driver, DRV_NAME);
1079         strcpy(info->version, DRV_VERSION);
1080         sprintf(info->bus_info, "PCMCIA 0x%lx", dev->base_addr);
1081 }
1082
1083 #ifdef PCMCIA_DEBUG
1084 static u32 netdev_get_msglevel(struct net_device *dev)
1085 {
1086         return pc_debug;
1087 }
1088
1089 static void netdev_set_msglevel(struct net_device *dev, u32 level)
1090 {
1091         pc_debug = level;
1092 }
1093 #endif /* PCMCIA_DEBUG */
1094
1095 static const struct ethtool_ops netdev_ethtool_ops = {
1096         .get_drvinfo            = netdev_get_drvinfo,
1097 #ifdef PCMCIA_DEBUG
1098         .get_msglevel           = netdev_get_msglevel,
1099         .set_msglevel           = netdev_set_msglevel,
1100 #endif /* PCMCIA_DEBUG */
1101 };
1102
1103 static int fjn_config(struct net_device *dev, struct ifmap *map){
1104     return 0;
1105 }
1106
1107 static int fjn_open(struct net_device *dev)
1108 {
1109     struct local_info_t *lp = netdev_priv(dev);
1110     struct pcmcia_device *link = lp->p_dev;
1111
1112     DEBUG(4, "fjn_open('%s').\n", dev->name);
1113
1114     if (!pcmcia_dev_present(link))
1115         return -ENODEV;
1116     
1117     link->open++;
1118     
1119     fjn_reset(dev);
1120     
1121     lp->tx_started = 0;
1122     lp->tx_queue = 0;
1123     lp->tx_queue_len = 0;
1124     lp->open_time = jiffies;
1125     netif_start_queue(dev);
1126     
1127     return 0;
1128 } /* fjn_open */
1129
1130 /*====================================================================*/
1131
1132 static int fjn_close(struct net_device *dev)
1133 {
1134     struct local_info_t *lp = netdev_priv(dev);
1135     struct pcmcia_device *link = lp->p_dev;
1136     kio_addr_t ioaddr = dev->base_addr;
1137
1138     DEBUG(4, "fjn_close('%s').\n", dev->name);
1139
1140     lp->open_time = 0;
1141     netif_stop_queue(dev);
1142
1143     /* Set configuration register 0 to disable Tx and Rx. */
1144     if( sram_config == 0 ) 
1145         outb(CONFIG0_RST ,ioaddr + CONFIG_0);
1146     else
1147         outb(CONFIG0_RST_1 ,ioaddr + CONFIG_0);
1148
1149     /* Update the statistics -- ToDo. */
1150
1151     /* Power-down the chip.  Green, green, green! */
1152     outb(CHIP_OFF ,ioaddr + CONFIG_1);
1153
1154     /* Set the ethernet adaptor disable IRQ */
1155     if (lp->cardtype == MBH10302)
1156         outb(INTR_OFF, ioaddr + LAN_CTRL);
1157
1158     link->open--;
1159
1160     return 0;
1161 } /* fjn_close */
1162
1163 /*====================================================================*/
1164
1165 static struct net_device_stats *fjn_get_stats(struct net_device *dev)
1166 {
1167     local_info_t *lp = netdev_priv(dev);
1168     return &lp->stats;
1169 } /* fjn_get_stats */
1170
1171 /*====================================================================*/
1172
1173 /*
1174   Set the multicast/promiscuous mode for this adaptor.
1175 */
1176
1177 static void set_rx_mode(struct net_device *dev)
1178 {
1179     kio_addr_t ioaddr = dev->base_addr;
1180     u_char mc_filter[8];                 /* Multicast hash filter */
1181     u_long flags;
1182     int i;
1183     
1184     int saved_bank;
1185     int saved_config_0 = inb(ioaddr + CONFIG_0);
1186      
1187     local_irq_save(flags); 
1188
1189     /* Disable Tx and Rx */
1190     if (sram_config == 0) 
1191         outb(CONFIG0_RST, ioaddr + CONFIG_0);
1192     else
1193         outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
1194
1195     if (dev->flags & IFF_PROMISC) {
1196         memset(mc_filter, 0xff, sizeof(mc_filter));
1197         outb(3, ioaddr + RX_MODE);      /* Enable promiscuous mode */
1198     } else if (dev->mc_count > MC_FILTERBREAK
1199                ||  (dev->flags & IFF_ALLMULTI)) {
1200         /* Too many to filter perfectly -- accept all multicasts. */
1201         memset(mc_filter, 0xff, sizeof(mc_filter));
1202         outb(2, ioaddr + RX_MODE);      /* Use normal mode. */
1203     } else if (dev->mc_count == 0) {
1204         memset(mc_filter, 0x00, sizeof(mc_filter));
1205         outb(1, ioaddr + RX_MODE);      /* Ignore almost all multicasts. */
1206     } else {
1207         struct dev_mc_list *mclist;
1208         int i;
1209         
1210         memset(mc_filter, 0, sizeof(mc_filter));
1211         for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
1212              i++, mclist = mclist->next) {
1213             unsigned int bit =
1214                 ether_crc_le(ETH_ALEN, mclist->dmi_addr) >> 26;
1215             mc_filter[bit >> 3] |= (1 << (bit & 7));
1216         }
1217         outb(2, ioaddr + RX_MODE);      /* Use normal mode. */
1218     }
1219
1220     /* Switch to bank 1 and set the multicast table. */
1221     saved_bank = inb(ioaddr + CONFIG_1);
1222     outb(0xe4, ioaddr + CONFIG_1);
1223
1224     for (i = 0; i < 8; i++)
1225         outb(mc_filter[i], ioaddr + MAR_ADR + i);
1226     outb(saved_bank, ioaddr + CONFIG_1);
1227
1228     outb(saved_config_0, ioaddr + CONFIG_0);
1229
1230     local_irq_restore(flags);
1231 }