fmvj18x_cs.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:37k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

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