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