git.oblomov.eu Git - linux-2.6/blob - drivers/net/pcmcia/fmvj18x_cs.c

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