]> pilppa.org Git - linux-2.6-omap-h63xx.git/blob - drivers/net/pcmcia/fmvj18x_cs.c
Merge branch 'task_killable' of git://git.kernel.org/pub/scm/linux/kernel/git/willy...
[linux-2.6-omap-h63xx.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 kio_addr_t serial_base[5] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, 0x0 };
302
303     for (i = 0; i < 5; i++) {
304         link->io.BasePort2 = serial_base[i];
305         link->io.Attributes2 = IO_DATA_PATH_WIDTH_8;
306         if (link->io.BasePort2 == 0) {
307             link->io.NumPorts2 = 0;
308             printk(KERN_NOTICE "fmvj18x_cs: out of resource for serial\n");
309         }
310         ret = pcmcia_request_io(link, &link->io);
311         if (ret == CS_SUCCESS) return ret;
312     }
313     return ret;
314 }
315
316 static int ungermann_try_io_port(struct pcmcia_device *link)
317 {
318     int ret;
319     kio_addr_t ioaddr;
320     /*
321         Ungermann-Bass Access/CARD accepts 0x300,0x320,0x340,0x360
322         0x380,0x3c0 only for ioport.
323     */
324     for (ioaddr = 0x300; ioaddr < 0x3e0; ioaddr += 0x20) {
325         link->io.BasePort1 = ioaddr;
326         ret = pcmcia_request_io(link, &link->io);
327         if (ret == CS_SUCCESS) {
328             /* calculate ConfigIndex value */
329             link->conf.ConfigIndex = 
330                 ((link->io.BasePort1 & 0x0f0) >> 3) | 0x22;
331             return ret;
332         }
333     }
334     return ret; /* RequestIO failed */
335 }
336
337 static int fmvj18x_config(struct pcmcia_device *link)
338 {
339     struct net_device *dev = link->priv;
340     local_info_t *lp = netdev_priv(dev);
341     tuple_t tuple;
342     cisparse_t parse;
343     u_short buf[32];
344     int i, last_fn = 0, last_ret = 0, ret;
345     kio_addr_t ioaddr;
346     cardtype_t cardtype;
347     char *card_name = "unknown";
348     u_char *node_id;
349     DECLARE_MAC_BUF(mac);
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, "
538            "hw_addr %s\n",
539            dev->name, card_name, sram_config == 0 ? "4K TX*2" : "8K TX*2", 
540            dev->base_addr, dev->irq, print_mac(mac, dev->dev_addr));
541
542     return 0;
543     
544 cs_failed:
545     /* All Card Services errors end up here */
546     cs_error(link, last_fn, last_ret);
547 failed:
548     fmvj18x_release(link);
549     return -ENODEV;
550 } /* fmvj18x_config */
551 /*====================================================================*/
552
553 static int fmvj18x_get_hwinfo(struct pcmcia_device *link, u_char *node_id)
554 {
555     win_req_t req;
556     memreq_t mem;
557     u_char __iomem *base;
558     int i, j;
559
560     /* Allocate a small memory window */
561     req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
562     req.Base = 0; req.Size = 0;
563     req.AccessSpeed = 0;
564     i = pcmcia_request_window(&link, &req, &link->win);
565     if (i != CS_SUCCESS) {
566         cs_error(link, RequestWindow, i);
567         return -1;
568     }
569
570     base = ioremap(req.Base, req.Size);
571     mem.Page = 0;
572     mem.CardOffset = 0;
573     pcmcia_map_mem_page(link->win, &mem);
574
575     /*
576      *  MBH10304 CISTPL_FUNCE_LAN_NODE_ID format
577      *  22 0d xx xx xx 04 06 yy yy yy yy yy yy ff
578      *  'xx' is garbage.
579      *  'yy' is MAC address.
580     */ 
581     for (i = 0; i < 0x200; i++) {
582         if (readb(base+i*2) == 0x22) {  
583             if (readb(base+(i-1)*2) == 0xff
584              && readb(base+(i+5)*2) == 0x04
585              && readb(base+(i+6)*2) == 0x06
586              && readb(base+(i+13)*2) == 0xff) 
587                 break;
588         }
589     }
590
591     if (i != 0x200) {
592         for (j = 0 ; j < 6; j++,i++) {
593             node_id[j] = readb(base+(i+7)*2);
594         }
595     }
596
597     iounmap(base);
598     j = pcmcia_release_window(link->win);
599     if (j != CS_SUCCESS)
600         cs_error(link, ReleaseWindow, j);
601     return (i != 0x200) ? 0 : -1;
602
603 } /* fmvj18x_get_hwinfo */
604 /*====================================================================*/
605
606 static int fmvj18x_setup_mfc(struct pcmcia_device *link)
607 {
608     win_req_t req;
609     memreq_t mem;
610     u_char __iomem *base;
611     int i, j;
612     struct net_device *dev = link->priv;
613     kio_addr_t ioaddr;
614
615     /* Allocate a small memory window */
616     req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
617     req.Base = 0; req.Size = 0;
618     req.AccessSpeed = 0;
619     i = pcmcia_request_window(&link, &req, &link->win);
620     if (i != CS_SUCCESS) {
621         cs_error(link, RequestWindow, i);
622         return -1;
623     }
624
625     base = ioremap(req.Base, req.Size);
626     mem.Page = 0;
627     mem.CardOffset = 0;
628     pcmcia_map_mem_page(link->win, &mem);
629
630     ioaddr = dev->base_addr;
631     writeb(0x47, base+0x800);   /* Config Option Register of LAN */
632     writeb(0x0, base+0x802);    /* Config and Status Register */
633
634     writeb(ioaddr & 0xff, base+0x80a);          /* I/O Base(Low) of LAN */
635     writeb((ioaddr >> 8) & 0xff, base+0x80c);   /* I/O Base(High) of LAN */
636    
637     writeb(0x45, base+0x820);   /* Config Option Register of Modem */
638     writeb(0x8, base+0x822);    /* Config and Status Register */
639
640     iounmap(base);
641     j = pcmcia_release_window(link->win);
642     if (j != CS_SUCCESS)
643         cs_error(link, ReleaseWindow, j);
644     return 0;
645
646 }
647 /*====================================================================*/
648
649 static void fmvj18x_release(struct pcmcia_device *link)
650 {
651         DEBUG(0, "fmvj18x_release(0x%p)\n", link);
652         pcmcia_disable_device(link);
653 }
654
655 static int fmvj18x_suspend(struct pcmcia_device *link)
656 {
657         struct net_device *dev = link->priv;
658
659         if (link->open)
660                 netif_device_detach(dev);
661
662         return 0;
663 }
664
665 static int fmvj18x_resume(struct pcmcia_device *link)
666 {
667         struct net_device *dev = link->priv;
668
669         if (link->open) {
670                 fjn_reset(dev);
671                 netif_device_attach(dev);
672         }
673
674         return 0;
675 }
676
677 /*====================================================================*/
678
679 static struct pcmcia_device_id fmvj18x_ids[] = {
680         PCMCIA_DEVICE_MANF_CARD(0x0004, 0x0004),
681         PCMCIA_DEVICE_PROD_ID12("EAGLE Technology", "NE200 ETHERNET LAN MBH10302 04", 0x528c88c4, 0x74f91e59),
682         PCMCIA_DEVICE_PROD_ID12("Eiger Labs,Inc", "EPX-10BT PC Card Ethernet 10BT", 0x53af556e, 0x877f9922),
683         PCMCIA_DEVICE_PROD_ID12("Eiger labs,Inc.", "EPX-10BT PC Card Ethernet 10BT", 0xf47e6c66, 0x877f9922),
684         PCMCIA_DEVICE_PROD_ID12("FUJITSU", "LAN Card(FMV-J182)", 0x6ee5a3d8, 0x5baf31db),
685         PCMCIA_DEVICE_PROD_ID12("FUJITSU", "MBH10308", 0x6ee5a3d8, 0x3f04875e),
686         PCMCIA_DEVICE_PROD_ID12("FUJITSU TOWA", "LA501", 0xb8451188, 0x12939ba2),
687         PCMCIA_DEVICE_PROD_ID12("HITACHI", "HT-4840-11", 0xf4f43949, 0x773910f4),
688         PCMCIA_DEVICE_PROD_ID12("NextComK.K.", "NC5310B Ver1.0       ", 0x8cef4d3a, 0x075fc7b6),
689         PCMCIA_DEVICE_PROD_ID12("NextComK.K.", "NC5310 Ver1.0        ", 0x8cef4d3a, 0xbccf43e6),
690         PCMCIA_DEVICE_PROD_ID12("RATOC System Inc.", "10BASE_T CARD R280", 0x85c10e17, 0xd9413666),
691         PCMCIA_DEVICE_PROD_ID12("TDK", "LAC-CD02x", 0x1eae9475, 0x8fa0ee70),
692         PCMCIA_DEVICE_PROD_ID12("TDK", "LAC-CF010", 0x1eae9475, 0x7683bc9a),
693         PCMCIA_DEVICE_PROD_ID1("CONTEC Co.,Ltd.", 0x58d8fee2),
694         PCMCIA_DEVICE_PROD_ID1("PCMCIA LAN MBH10304  ES", 0x2599f454),
695         PCMCIA_DEVICE_PROD_ID1("PCMCIA MBH10302", 0x8f4005da),
696         PCMCIA_DEVICE_PROD_ID1("UBKK,V2.0", 0x90888080),
697         PCMCIA_PFC_DEVICE_PROD_ID12(0, "TDK", "GlobalNetworker 3410/3412", 0x1eae9475, 0xd9a93bed),
698         PCMCIA_PFC_DEVICE_PROD_ID12(0, "NEC", "PK-UG-J001" ,0x18df0ba0 ,0x831b1064),
699         PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0105, 0x0d0a),
700         PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0105, 0x0e0a),
701         PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0032, 0x0a05),
702         PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0032, 0x1101),
703         PCMCIA_DEVICE_NULL,
704 };
705 MODULE_DEVICE_TABLE(pcmcia, fmvj18x_ids);
706
707 static struct pcmcia_driver fmvj18x_cs_driver = {
708         .owner          = THIS_MODULE,
709         .drv            = {
710                 .name   = "fmvj18x_cs",
711         },
712         .probe          = fmvj18x_probe,
713         .remove         = fmvj18x_detach,
714         .id_table       = fmvj18x_ids,
715         .suspend        = fmvj18x_suspend,
716         .resume         = fmvj18x_resume,
717 };
718
719 static int __init init_fmvj18x_cs(void)
720 {
721         return pcmcia_register_driver(&fmvj18x_cs_driver);
722 }
723
724 static void __exit exit_fmvj18x_cs(void)
725 {
726         pcmcia_unregister_driver(&fmvj18x_cs_driver);
727 }
728
729 module_init(init_fmvj18x_cs);
730 module_exit(exit_fmvj18x_cs);
731
732 /*====================================================================*/
733
734 static irqreturn_t fjn_interrupt(int dummy, void *dev_id)
735 {
736     struct net_device *dev = dev_id;
737     local_info_t *lp = netdev_priv(dev);
738     kio_addr_t ioaddr;
739     unsigned short tx_stat, rx_stat;
740
741     ioaddr = dev->base_addr;
742
743     /* avoid multiple interrupts */
744     outw(0x0000, ioaddr + TX_INTR);
745
746     /* wait for a while */
747     udelay(1);
748
749     /* get status */
750     tx_stat = inb(ioaddr + TX_STATUS);
751     rx_stat = inb(ioaddr + RX_STATUS);
752
753     /* clear status */
754     outb(tx_stat, ioaddr + TX_STATUS);
755     outb(rx_stat, ioaddr + RX_STATUS);
756     
757     DEBUG(4, "%s: interrupt, rx_status %02x.\n", dev->name, rx_stat);
758     DEBUG(4, "               tx_status %02x.\n", tx_stat);
759     
760     if (rx_stat || (inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
761         /* there is packet(s) in rx buffer */
762         fjn_rx(dev);
763     }
764     if (tx_stat & F_TMT_RDY) {
765         lp->stats.tx_packets += lp->sent ;
766         lp->sent = 0 ;
767         if (lp->tx_queue) {
768             outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
769             lp->sent = lp->tx_queue ;
770             lp->tx_queue = 0;
771             lp->tx_queue_len = 0;
772             dev->trans_start = jiffies;
773         } else {
774             lp->tx_started = 0;
775         }
776         netif_wake_queue(dev);
777     }
778     DEBUG(4, "%s: exiting interrupt,\n", dev->name);
779     DEBUG(4, "    tx_status %02x, rx_status %02x.\n", tx_stat, rx_stat);
780
781     outb(D_TX_INTR, ioaddr + TX_INTR);
782     outb(D_RX_INTR, ioaddr + RX_INTR);
783     return IRQ_HANDLED;
784
785 } /* fjn_interrupt */
786
787 /*====================================================================*/
788
789 static void fjn_tx_timeout(struct net_device *dev)
790 {
791     struct local_info_t *lp = netdev_priv(dev);
792     kio_addr_t ioaddr = dev->base_addr;
793
794     printk(KERN_NOTICE "%s: transmit timed out with status %04x, %s?\n",
795            dev->name, htons(inw(ioaddr + TX_STATUS)),
796            inb(ioaddr + TX_STATUS) & F_TMT_RDY
797            ? "IRQ conflict" : "network cable problem");
798     printk(KERN_NOTICE "%s: timeout registers: %04x %04x %04x "
799            "%04x %04x %04x %04x %04x.\n",
800            dev->name, htons(inw(ioaddr + 0)),
801            htons(inw(ioaddr + 2)), htons(inw(ioaddr + 4)),
802            htons(inw(ioaddr + 6)), htons(inw(ioaddr + 8)),
803            htons(inw(ioaddr +10)), htons(inw(ioaddr +12)),
804            htons(inw(ioaddr +14)));
805     lp->stats.tx_errors++;
806     /* ToDo: We should try to restart the adaptor... */
807     local_irq_disable();
808     fjn_reset(dev);
809
810     lp->tx_started = 0;
811     lp->tx_queue = 0;
812     lp->tx_queue_len = 0;
813     lp->sent = 0;
814     lp->open_time = jiffies;
815     local_irq_enable();
816     netif_wake_queue(dev);
817 }
818
819 static int fjn_start_xmit(struct sk_buff *skb, struct net_device *dev)
820 {
821     struct local_info_t *lp = netdev_priv(dev);
822     kio_addr_t ioaddr = dev->base_addr;
823     short length = skb->len;
824     
825     if (length < ETH_ZLEN)
826     {
827         if (skb_padto(skb, ETH_ZLEN))
828                 return 0;
829         length = ETH_ZLEN;
830     }
831
832     netif_stop_queue(dev);
833
834     {
835         unsigned char *buf = skb->data;
836
837         if (length > ETH_FRAME_LEN) {
838             printk(KERN_NOTICE "%s: Attempting to send a large packet"
839                    " (%d bytes).\n", dev->name, length);
840             return 1;
841         }
842
843         DEBUG(4, "%s: Transmitting a packet of length %lu.\n",
844               dev->name, (unsigned long)skb->len);
845         lp->stats.tx_bytes += skb->len;
846
847         /* Disable both interrupts. */
848         outw(0x0000, ioaddr + TX_INTR);
849
850         /* wait for a while */
851         udelay(1);
852
853         outw(length, ioaddr + DATAPORT);
854         outsw(ioaddr + DATAPORT, buf, (length + 1) >> 1);
855
856         lp->tx_queue++;
857         lp->tx_queue_len += ((length+3) & ~1);
858
859         if (lp->tx_started == 0) {
860             /* If the Tx is idle, always trigger a transmit. */
861             outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
862             lp->sent = lp->tx_queue ;
863             lp->tx_queue = 0;
864             lp->tx_queue_len = 0;
865             dev->trans_start = jiffies;
866             lp->tx_started = 1;
867             netif_start_queue(dev);
868         } else {
869             if( sram_config == 0 ) {
870                 if (lp->tx_queue_len < (4096 - (ETH_FRAME_LEN +2)) )
871                     /* Yes, there is room for one more packet. */
872                     netif_start_queue(dev);
873             } else {
874                 if (lp->tx_queue_len < (8192 - (ETH_FRAME_LEN +2)) && 
875                                                 lp->tx_queue < 127 )
876                     /* Yes, there is room for one more packet. */
877                     netif_start_queue(dev);
878             }
879         }
880
881         /* Re-enable interrupts */
882         outb(D_TX_INTR, ioaddr + TX_INTR);
883         outb(D_RX_INTR, ioaddr + RX_INTR);
884     }
885     dev_kfree_skb (skb);
886
887     return 0;
888 } /* fjn_start_xmit */
889
890 /*====================================================================*/
891
892 static void fjn_reset(struct net_device *dev)
893 {
894     struct local_info_t *lp = netdev_priv(dev);
895     kio_addr_t ioaddr = dev->base_addr;
896     int i;
897
898     DEBUG(4, "fjn_reset(%s) called.\n",dev->name);
899
900     /* Reset controller */
901     if( sram_config == 0 ) 
902         outb(CONFIG0_RST, ioaddr + CONFIG_0);
903     else
904         outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
905
906     /* Power On chip and select bank 0 */
907     if (lp->cardtype == MBH10302)
908         outb(BANK_0, ioaddr + CONFIG_1);
909     else
910         outb(BANK_0U, ioaddr + CONFIG_1);
911
912     /* Set Tx modes */
913     outb(D_TX_MODE, ioaddr + TX_MODE);
914     /* set Rx modes */
915     outb(ID_MATCHED, ioaddr + RX_MODE);
916
917     /* Set hardware address */
918     for (i = 0; i < 6; i++) 
919         outb(dev->dev_addr[i], ioaddr + NODE_ID + i);
920
921     /* (re)initialize the multicast table */
922     set_rx_mode(dev);
923
924     /* Switch to bank 2 (runtime mode) */
925     if (lp->cardtype == MBH10302)
926         outb(BANK_2, ioaddr + CONFIG_1);
927     else
928         outb(BANK_2U, ioaddr + CONFIG_1);
929
930     /* set 16col ctrl bits */
931     if( lp->cardtype == TDK || lp->cardtype == CONTEC) 
932         outb(TDK_AUTO_MODE, ioaddr + COL_CTRL);
933     else
934         outb(AUTO_MODE, ioaddr + COL_CTRL);
935
936     /* clear Reserved Regs */
937     outb(0x00, ioaddr + BMPR12);
938     outb(0x00, ioaddr + BMPR13);
939
940     /* reset Skip packet reg. */
941     outb(0x01, ioaddr + RX_SKIP);
942
943     /* Enable Tx and Rx */
944     if( sram_config == 0 )
945         outb(CONFIG0_DFL, ioaddr + CONFIG_0);
946     else
947         outb(CONFIG0_DFL_1, ioaddr + CONFIG_0);
948
949     /* Init receive pointer ? */
950     inw(ioaddr + DATAPORT);
951     inw(ioaddr + DATAPORT);
952
953     /* Clear all status */
954     outb(0xff, ioaddr + TX_STATUS);
955     outb(0xff, ioaddr + RX_STATUS);
956
957     if (lp->cardtype == MBH10302)
958         outb(INTR_OFF, ioaddr + LAN_CTRL);
959
960     /* Turn on Rx interrupts */
961     outb(D_TX_INTR, ioaddr + TX_INTR);
962     outb(D_RX_INTR, ioaddr + RX_INTR);
963
964     /* Turn on interrupts from LAN card controller */
965     if (lp->cardtype == MBH10302)
966         outb(INTR_ON, ioaddr + LAN_CTRL);
967 } /* fjn_reset */
968
969 /*====================================================================*/
970
971 static void fjn_rx(struct net_device *dev)
972 {
973     struct local_info_t *lp = netdev_priv(dev);
974     kio_addr_t ioaddr = dev->base_addr;
975     int boguscount = 10;        /* 5 -> 10: by agy 19940922 */
976
977     DEBUG(4, "%s: in rx_packet(), rx_status %02x.\n",
978           dev->name, inb(ioaddr + RX_STATUS));
979
980     while ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
981         u_short status = inw(ioaddr + DATAPORT);
982
983         DEBUG(4, "%s: Rxing packet mode %02x status %04x.\n",
984               dev->name, inb(ioaddr + RX_MODE), status);
985 #ifndef final_version
986         if (status == 0) {
987             outb(F_SKP_PKT, ioaddr + RX_SKIP);
988             break;
989         }
990 #endif
991         if ((status & 0xF0) != 0x20) {  /* There was an error. */
992             lp->stats.rx_errors++;
993             if (status & F_LEN_ERR) lp->stats.rx_length_errors++;
994             if (status & F_ALG_ERR) lp->stats.rx_frame_errors++;
995             if (status & F_CRC_ERR) lp->stats.rx_crc_errors++;
996             if (status & F_OVR_FLO) lp->stats.rx_over_errors++;
997         } else {
998             u_short pkt_len = inw(ioaddr + DATAPORT);
999             /* Malloc up new buffer. */
1000             struct sk_buff *skb;
1001
1002             if (pkt_len > 1550) {
1003                 printk(KERN_NOTICE "%s: The FMV-18x claimed a very "
1004                        "large packet, size %d.\n", dev->name, pkt_len);
1005                 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1006                 lp->stats.rx_errors++;
1007                 break;
1008             }
1009             skb = dev_alloc_skb(pkt_len+2);
1010             if (skb == NULL) {
1011                 printk(KERN_NOTICE "%s: Memory squeeze, dropping "
1012                        "packet (len %d).\n", dev->name, pkt_len);
1013                 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1014                 lp->stats.rx_dropped++;
1015                 break;
1016             }
1017
1018             skb_reserve(skb, 2);
1019             insw(ioaddr + DATAPORT, skb_put(skb, pkt_len),
1020                  (pkt_len + 1) >> 1);
1021             skb->protocol = eth_type_trans(skb, dev);
1022
1023 #ifdef PCMCIA_DEBUG
1024             if (pc_debug > 5) {
1025                 int i;
1026                 printk(KERN_DEBUG "%s: Rxed packet of length %d: ",
1027                        dev->name, pkt_len);
1028                 for (i = 0; i < 14; i++)
1029                     printk(" %02x", skb->data[i]);
1030                 printk(".\n");
1031             }
1032 #endif
1033
1034             netif_rx(skb);
1035             dev->last_rx = jiffies;
1036             lp->stats.rx_packets++;
1037             lp->stats.rx_bytes += pkt_len;
1038         }
1039         if (--boguscount <= 0)
1040             break;
1041     }
1042
1043     /* If any worth-while packets have been received, dev_rint()
1044            has done a netif_wake_queue() for us and will work on them
1045            when we get to the bottom-half routine. */
1046 /*
1047     if (lp->cardtype != TDK) {
1048         int i;
1049         for (i = 0; i < 20; i++) {
1050             if ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == F_BUF_EMP)
1051                 break;
1052             (void)inw(ioaddr + DATAPORT);  /+ dummy status read +/
1053             outb(F_SKP_PKT, ioaddr + RX_SKIP);
1054         }
1055
1056         if (i > 0)
1057             DEBUG(5, "%s: Exint Rx packet with mode %02x after "
1058                   "%d ticks.\n", dev->name, inb(ioaddr + RX_MODE), i);
1059     }
1060 */
1061
1062     return;
1063 } /* fjn_rx */
1064
1065 /*====================================================================*/
1066
1067 static void netdev_get_drvinfo(struct net_device *dev,
1068                                struct ethtool_drvinfo *info)
1069 {
1070         strcpy(info->driver, DRV_NAME);
1071         strcpy(info->version, DRV_VERSION);
1072         sprintf(info->bus_info, "PCMCIA 0x%lx", dev->base_addr);
1073 }
1074
1075 #ifdef PCMCIA_DEBUG
1076 static u32 netdev_get_msglevel(struct net_device *dev)
1077 {
1078         return pc_debug;
1079 }
1080
1081 static void netdev_set_msglevel(struct net_device *dev, u32 level)
1082 {
1083         pc_debug = level;
1084 }
1085 #endif /* PCMCIA_DEBUG */
1086
1087 static const struct ethtool_ops netdev_ethtool_ops = {
1088         .get_drvinfo            = netdev_get_drvinfo,
1089 #ifdef PCMCIA_DEBUG
1090         .get_msglevel           = netdev_get_msglevel,
1091         .set_msglevel           = netdev_set_msglevel,
1092 #endif /* PCMCIA_DEBUG */
1093 };
1094
1095 static int fjn_config(struct net_device *dev, struct ifmap *map){
1096     return 0;
1097 }
1098
1099 static int fjn_open(struct net_device *dev)
1100 {
1101     struct local_info_t *lp = netdev_priv(dev);
1102     struct pcmcia_device *link = lp->p_dev;
1103
1104     DEBUG(4, "fjn_open('%s').\n", dev->name);
1105
1106     if (!pcmcia_dev_present(link))
1107         return -ENODEV;
1108     
1109     link->open++;
1110     
1111     fjn_reset(dev);
1112     
1113     lp->tx_started = 0;
1114     lp->tx_queue = 0;
1115     lp->tx_queue_len = 0;
1116     lp->open_time = jiffies;
1117     netif_start_queue(dev);
1118     
1119     return 0;
1120 } /* fjn_open */
1121
1122 /*====================================================================*/
1123
1124 static int fjn_close(struct net_device *dev)
1125 {
1126     struct local_info_t *lp = netdev_priv(dev);
1127     struct pcmcia_device *link = lp->p_dev;
1128     kio_addr_t ioaddr = dev->base_addr;
1129
1130     DEBUG(4, "fjn_close('%s').\n", dev->name);
1131
1132     lp->open_time = 0;
1133     netif_stop_queue(dev);
1134
1135     /* Set configuration register 0 to disable Tx and Rx. */
1136     if( sram_config == 0 ) 
1137         outb(CONFIG0_RST ,ioaddr + CONFIG_0);
1138     else
1139         outb(CONFIG0_RST_1 ,ioaddr + CONFIG_0);
1140
1141     /* Update the statistics -- ToDo. */
1142
1143     /* Power-down the chip.  Green, green, green! */
1144     outb(CHIP_OFF ,ioaddr + CONFIG_1);
1145
1146     /* Set the ethernet adaptor disable IRQ */
1147     if (lp->cardtype == MBH10302)
1148         outb(INTR_OFF, ioaddr + LAN_CTRL);
1149
1150     link->open--;
1151
1152     return 0;
1153 } /* fjn_close */
1154
1155 /*====================================================================*/
1156
1157 static struct net_device_stats *fjn_get_stats(struct net_device *dev)
1158 {
1159     local_info_t *lp = netdev_priv(dev);
1160     return &lp->stats;
1161 } /* fjn_get_stats */
1162
1163 /*====================================================================*/
1164
1165 /*
1166   Set the multicast/promiscuous mode for this adaptor.
1167 */
1168
1169 static void set_rx_mode(struct net_device *dev)
1170 {
1171     kio_addr_t ioaddr = dev->base_addr;
1172     u_char mc_filter[8];                 /* Multicast hash filter */
1173     u_long flags;
1174     int i;
1175     
1176     int saved_bank;
1177     int saved_config_0 = inb(ioaddr + CONFIG_0);
1178      
1179     local_irq_save(flags); 
1180
1181     /* Disable Tx and Rx */
1182     if (sram_config == 0) 
1183         outb(CONFIG0_RST, ioaddr + CONFIG_0);
1184     else
1185         outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
1186
1187     if (dev->flags & IFF_PROMISC) {
1188         memset(mc_filter, 0xff, sizeof(mc_filter));
1189         outb(3, ioaddr + RX_MODE);      /* Enable promiscuous mode */
1190     } else if (dev->mc_count > MC_FILTERBREAK
1191                ||  (dev->flags & IFF_ALLMULTI)) {
1192         /* Too many to filter perfectly -- accept all multicasts. */
1193         memset(mc_filter, 0xff, sizeof(mc_filter));
1194         outb(2, ioaddr + RX_MODE);      /* Use normal mode. */
1195     } else if (dev->mc_count == 0) {
1196         memset(mc_filter, 0x00, sizeof(mc_filter));
1197         outb(1, ioaddr + RX_MODE);      /* Ignore almost all multicasts. */
1198     } else {
1199         struct dev_mc_list *mclist;
1200         int i;
1201         
1202         memset(mc_filter, 0, sizeof(mc_filter));
1203         for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
1204              i++, mclist = mclist->next) {
1205             unsigned int bit =
1206                 ether_crc_le(ETH_ALEN, mclist->dmi_addr) >> 26;
1207             mc_filter[bit >> 3] |= (1 << (bit & 7));
1208         }
1209         outb(2, ioaddr + RX_MODE);      /* Use normal mode. */
1210     }
1211
1212     /* Switch to bank 1 and set the multicast table. */
1213     saved_bank = inb(ioaddr + CONFIG_1);
1214     outb(0xe4, ioaddr + CONFIG_1);
1215
1216     for (i = 0; i < 8; i++)
1217         outb(mc_filter[i], ioaddr + MAR_ADR + i);
1218     outb(saved_bank, ioaddr + CONFIG_1);
1219
1220     outb(saved_config_0, ioaddr + CONFIG_0);
1221
1222     local_irq_restore(flags);
1223 }