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