开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
fealnx.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：54k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

fealnx.c：源码内容
  1. /*
  2. Written 1998-2000 by Donald Becker.
  4. This software may be used and distributed according to the terms of
  5. the GNU General Public License (GPL), incorporated herein by reference.
  6. Drivers based on or derived from this code fall under the GPL and must
  7. retain the authorship, copyright and license notice.  This file is not
  8. a complete program and may only be used when the entire operating
  9. system is licensed under the GPL.
  11. The author may be reached as becker@scyld.com, or C/O
  12. Scyld Computing Corporation
  13. 410 Severn Ave., Suite 210
  14. Annapolis MD 21403
  16. Support information and updates available at
  17. http://www.scyld.com/network/pci-skeleton.html
  19. Linux kernel updates:
  21. Version 2.51, Nov 17, 2001 (jgarzik):
  22. - Add ethtool support
  23. - Replace some MII-related magic numbers with constants
  25. */
  27. #define DRV_NAME "fealnx"
  28. #define DRV_VERSION "2.51"
  29. #define DRV_RELDATE "Nov-17-2001"
  31. static int debug; /* 1-> print debug message */
  32. static int max_interrupt_work = 20;
  34. /* Maximum number of multicast addresses to filter (vs. Rx-all-multicast). */
  35. static int multicast_filter_limit = 32;
  37. /* Set the copy breakpoint for the copy-only-tiny-frames scheme. */
  38. /* Setting to > 1518 effectively disables this feature.          */
  39. static int rx_copybreak;
  41. /* Used to pass the media type, etc.                            */
  42. /* Both 'options[]' and 'full_duplex[]' should exist for driver */
  43. /* interoperability.                                            */
  44. /* The media type is usually passed in 'options[]'.             */
  45. #define MAX_UNITS 8 /* More are supported, limit only on options */
  46. static int options[MAX_UNITS] = { -1, -1, -1, -1, -1, -1, -1, -1 };
  47. static int full_duplex[MAX_UNITS] = { -1, -1, -1, -1, -1, -1, -1, -1 };
  49. /* Operational parameters that are set at compile time.                 */
  50. /* Keep the ring sizes a power of two for compile efficiency.           */
  51. /* The compiler will convert <unsigned>'%'<2^N> into a bit mask.        */
  52. /* Making the Tx ring too large decreases the effectiveness of channel  */
  53. /* bonding and packet priority.                                         */
  54. /* There are no ill effects from too-large receive rings.               */
  55. // 88-12-9 modify,
  56. // #define TX_RING_SIZE    16
  57. // #define RX_RING_SIZE    32
  58. #define TX_RING_SIZE    6
  59. #define RX_RING_SIZE    12
  60. #define TX_TOTAL_SIZE TX_RING_SIZE*sizeof(struct fealnx_desc)
  61. #define RX_TOTAL_SIZE RX_RING_SIZE*sizeof(struct fealnx_desc)
  63. /* Operational parameters that usually are not changed. */
  64. /* Time in jiffies before concluding the transmitter is hung. */
  65. #define TX_TIMEOUT      (2*HZ)
  67. #define PKT_BUF_SZ      1536 /* Size of each temporary Rx buffer. */
  70. /* Include files, designed to support most kernel versions 2.0.0 and later. */
  71. #include <linux/module.h>
  72. #include <linux/kernel.h>
  73. #include <linux/sched.h>
  74. #include <linux/string.h>
  75. #include <linux/timer.h>
  76. #include <linux/errno.h>
  77. #include <linux/ioport.h>
  78. #include <linux/slab.h>
  79. #include <linux/interrupt.h>
  80. #include <linux/pci.h>
  81. #include <linux/netdevice.h>
  82. #include <linux/etherdevice.h>
  83. #include <linux/skbuff.h>
  84. #include <linux/init.h>
  85. #include <linux/mii.h>
  86. #include <linux/ethtool.h>
  87. #include <asm/processor.h> /* Processor type for cache alignment. */
  88. #include <asm/bitops.h>
  89. #include <asm/io.h>
  90. #include <asm/uaccess.h>
  92. /* These identify the driver base version and may not be removed. */
  93. static char version[] __devinitdata =
  94. KERN_INFO DRV_NAME ".c:v" DRV_VERSION " " DRV_RELDATE "n";
  97. /* This driver was written to use PCI memory space, however some x86 systems
  98.    work only with I/O space accesses. */
  99. #ifndef __alpha__
  100. #define USE_IO_OPS
  101. #endif
  103. #ifdef USE_IO_OPS
  104. #undef readb
  105. #undef readw
  106. #undef readl
  107. #undef writeb
  108. #undef writew
  109. #undef writel
  110. #define readb inb
  111. #define readw inw
  112. #define readl inl
  113. #define writeb outb
  114. #define writew outw
  115. #define writel outl
  116. #endif
  118. /* Kernel compatibility defines, some common to David Hinds' PCMCIA package. */
  119. /* This is only in the support-all-kernels source code. */
  121. #define RUN_AT(x) (jiffies + (x))
  123. MODULE_AUTHOR("Myson or whoever");
  124. MODULE_DESCRIPTION("Myson MTD-8xx 100/10M Ethernet PCI Adapter Driver");
  125. MODULE_LICENSE("GPL");
  126. MODULE_PARM(max_interrupt_work, "i");
  127. //MODULE_PARM(min_pci_latency, "i");
  128. MODULE_PARM(debug, "i");
  129. MODULE_PARM(rx_copybreak, "i");
  130. MODULE_PARM(multicast_filter_limit, "i");
  131. MODULE_PARM(options, "1-" __MODULE_STRING(MAX_UNITS) "i");
  132. MODULE_PARM(full_duplex, "1-" __MODULE_STRING(MAX_UNITS) "i");
  133. MODULE_PARM_DESC(max_interrupt_work, "fealnx maximum events handled per interrupt");
  134. MODULE_PARM_DESC(debug, "fealnx enable debugging (0-1)");
  135. MODULE_PARM_DESC(rx_copybreak, "fealnx copy breakpoint for copy-only-tiny-frames");
  136. MODULE_PARM_DESC(multicast_filter_limit, "fealnx maximum number of filtered multicast addresses");
  137. MODULE_PARM_DESC(options, "fealnx: Bits 0-3: media type, bit 17: full duplex");
  138. MODULE_PARM_DESC(full_duplex, "fealnx full duplex setting(s) (1)");
  140. #define MIN_REGION_SIZE 136
  142. enum pci_flags_bit {
  143. PCI_USES_IO = 1,
  144. PCI_USES_MEM = 2,
  145. PCI_USES_MASTER = 4,
  146. PCI_ADDR0 = 0x10 << 0,
  147. PCI_ADDR1 = 0x10 << 1,
  148. PCI_ADDR2 = 0x10 << 2,
  149. PCI_ADDR3 = 0x10 << 3,
  150. };
  152. /* A chip capabilities table, matching the entries in pci_tbl[] above. */
  153. enum chip_capability_flags {
  154. HAS_MII_XCVR,
  155. HAS_CHIP_XCVR,
  156. };
  158. /* 89/6/13 add, */
  159. /* for different PHY */
  160. enum phy_type_flags {
  161. MysonPHY = 1,
  162. AhdocPHY = 2,
  163. SeeqPHY = 3,
  164. MarvellPHY = 4,
  165. Myson981 = 5,
  166. LevelOnePHY = 6,
  167. OtherPHY = 10,
  168. };
  170. struct chip_info {
  171. char *chip_name;
  172. int io_size;
  173. int flags;
  174. };
  176. static struct chip_info skel_netdrv_tbl[] = {
  177. {"100/10M Ethernet PCI Adapter", 136, HAS_MII_XCVR},
  178. {"100/10M Ethernet PCI Adapter", 136, HAS_CHIP_XCVR},
  179. {"1000/100/10M Ethernet PCI Adapter", 136, HAS_MII_XCVR},
  180. };
  182. /* Offsets to the Command and Status Registers. */
  183. enum fealnx_offsets {
  184. PAR0 = 0x0, /* physical address 0-3 */
  185. PAR1 = 0x04, /* physical address 4-5 */
  186. MAR0 = 0x08, /* multicast address 0-3 */
  187. MAR1 = 0x0C, /* multicast address 4-7 */
  188. FAR0 = 0x10, /* flow-control address 0-3 */
  189. FAR1 = 0x14, /* flow-control address 4-5 */
  190. TCRRCR = 0x18, /* receive & transmit configuration */
  191. BCR = 0x1C, /* bus command */
  192. TXPDR = 0x20, /* transmit polling demand */
  193. RXPDR = 0x24, /* receive polling demand */
  194. RXCWP = 0x28, /* receive current word pointer */
  195. TXLBA = 0x2C, /* transmit list base address */
  196. RXLBA = 0x30, /* receive list base address */
  197. ISR = 0x34, /* interrupt status */
  198. IMR = 0x38, /* interrupt mask */
  199. FTH = 0x3C, /* flow control high/low threshold */
  200. MANAGEMENT = 0x40, /* bootrom/eeprom and mii management */
  201. TALLY = 0x44, /* tally counters for crc and mpa */
  202. TSR = 0x48, /* tally counter for transmit status */
  203. BMCRSR = 0x4c, /* basic mode control and status */
  204. PHYIDENTIFIER = 0x50, /* phy identifier */
  205. ANARANLPAR = 0x54, /* auto-negotiation advertisement and link
  206.    partner ability */
  207. ANEROCR = 0x58, /* auto-negotiation expansion and pci conf. */
  208. BPREMRPSR = 0x5c, /* bypass & receive error mask and phy status */
  209. };
  211. /* Bits in the interrupt status/enable registers. */
  212. /* The bits in the Intr Status/Enable registers, mostly interrupt sources. */
  213. enum intr_status_bits {
  214. RFCON = 0x00020000, /* receive flow control xon packet */
  215. RFCOFF = 0x00010000, /* receive flow control xoff packet */
  216. LSCStatus = 0x00008000, /* link status change */
  217. ANCStatus = 0x00004000, /* autonegotiation completed */
  218. FBE = 0x00002000, /* fatal bus error */
  219. FBEMask = 0x00001800, /* mask bit12-11 */
  220. ParityErr = 0x00000000, /* parity error */
  221. TargetErr = 0x00001000, /* target abort */
  222. MasterErr = 0x00000800, /* master error */
  223. TUNF = 0x00000400, /* transmit underflow */
  224. ROVF = 0x00000200, /* receive overflow */
  225. ETI = 0x00000100, /* transmit early int */
  226. ERI = 0x00000080, /* receive early int */
  227. CNTOVF = 0x00000040, /* counter overflow */
  228. RBU = 0x00000020, /* receive buffer unavailable */
  229. TBU = 0x00000010, /* transmit buffer unavilable */
  230. TI = 0x00000008, /* transmit interrupt */
  231. RI = 0x00000004, /* receive interrupt */
  232. RxErr = 0x00000002, /* receive error */
  233. };
  235. /* Bits in the NetworkConfig register. */
  236. enum rx_mode_bits {
  237. RxModeMask = 0xe0,
  238. PROM = 0x80, /* promiscuous mode */
  239. AB = 0x40, /* accept broadcast */
  240. AM = 0x20, /* accept mutlicast */
  241. ARP = 0x08, /* receive runt pkt */
  242. ALP = 0x04, /* receive long pkt */
  243. SEP = 0x02, /* receive error pkt */
  244. };
  246. /* The Tulip Rx and Tx buffer descriptors. */
  247. struct fealnx_desc {
  248. s32 status;
  249. s32 control;
  250. u32 buffer;
  251. u32 next_desc;
  252. struct fealnx_desc *next_desc_logical;
  253. struct sk_buff *skbuff;
  254. u32 reserved1;
  255. u32 reserved2;
  256. };
  258. /* Bits in network_desc.status */
  259. enum rx_desc_status_bits {
  260. RXOWN = 0x80000000, /* own bit */
  261. FLNGMASK = 0x0fff0000, /* frame length */
  262. FLNGShift = 16,
  263. MARSTATUS = 0x00004000, /* multicast address received */
  264. BARSTATUS = 0x00002000, /* broadcast address received */
  265. PHYSTATUS = 0x00001000, /* physical address received */
  266. RXFSD = 0x00000800, /* first descriptor */
  267. RXLSD = 0x00000400, /* last descriptor */
  268. ErrorSummary = 0x80, /* error summary */
  269. RUNT = 0x40, /* runt packet received */
  270. LONG = 0x20, /* long packet received */
  271. FAE = 0x10, /* frame align error */
  272. CRC = 0x08, /* crc error */
  273. RXER = 0x04, /* receive error */
  274. };
  276. enum rx_desc_control_bits {
  277. RXIC = 0x00800000, /* interrupt control */
  278. RBSShift = 0,
  279. };
  281. enum tx_desc_status_bits {
  282. TXOWN = 0x80000000, /* own bit */
  283. JABTO = 0x00004000, /* jabber timeout */
  284. CSL = 0x00002000, /* carrier sense lost */
  285. LC = 0x00001000, /* late collision */
  286. EC = 0x00000800, /* excessive collision */
  287. UDF = 0x00000400, /* fifo underflow */
  288. DFR = 0x00000200, /* deferred */
  289. HF = 0x00000100, /* heartbeat fail */
  290. NCRMask = 0x000000ff, /* collision retry count */
  291. NCRShift = 0,
  292. };
  294. enum tx_desc_control_bits {
  295. TXIC = 0x80000000, /* interrupt control */
  296. ETIControl = 0x40000000, /* early transmit interrupt */
  297. TXLD = 0x20000000, /* last descriptor */
  298. TXFD = 0x10000000, /* first descriptor */
  299. CRCEnable = 0x08000000, /* crc control */
  300. PADEnable = 0x04000000, /* padding control */
  301. RetryTxLC = 0x02000000, /* retry late collision */
  302. PKTSMask = 0x3ff800, /* packet size bit21-11 */
  303. PKTSShift = 11,
  304. TBSMask = 0x000007ff, /* transmit buffer bit 10-0 */
  305. TBSShift = 0,
  306. };
  308. /* BootROM/EEPROM/MII Management Register */
  309. #define MASK_MIIR_MII_READ       0x00000000
  310. #define MASK_MIIR_MII_WRITE      0x00000008
  311. #define MASK_MIIR_MII_MDO        0x00000004
  312. #define MASK_MIIR_MII_MDI        0x00000002
  313. #define MASK_MIIR_MII_MDC        0x00000001
  315. /* ST+OP+PHYAD+REGAD+TA */
  316. #define OP_READ             0x6000 /* ST:01+OP:10+PHYAD+REGAD+TA:Z0 */
  317. #define OP_WRITE            0x5002 /* ST:01+OP:01+PHYAD+REGAD+TA:10 */
  319. /* ------------------------------------------------------------------------- */
  320. /*      Constants for Myson PHY                                              */
  321. /* ------------------------------------------------------------------------- */
  322. #define MysonPHYID      0xd0000302
  323. /* 89-7-27 add, (begin) */
  324. #define MysonPHYID0     0x0302
  325. #define StatusRegister  18
  326. #define SPEED100        0x0400 // bit10
  327. #define FULLMODE        0x0800 // bit11
  328. /* 89-7-27 add, (end) */
  330. /* ------------------------------------------------------------------------- */
  331. /*      Constants for Seeq 80225 PHY                                         */
  332. /* ------------------------------------------------------------------------- */
  333. #define SeeqPHYID0      0x0016
  335. #define MIIRegister18   18
  336. #define SPD_DET_100     0x80
  337. #define DPLX_DET_FULL   0x40
  339. /* ------------------------------------------------------------------------- */
  340. /*      Constants for Ahdoc 101 PHY                                          */
  341. /* ------------------------------------------------------------------------- */
  342. #define AhdocPHYID0     0x0022
  344. #define DiagnosticReg   18
  345. #define DPLX_FULL       0x0800
  346. #define Speed_100       0x0400
  348. /* 89/6/13 add, */
  349. /* -------------------------------------------------------------------------- */
  350. /*      Constants                                                             */
  351. /* -------------------------------------------------------------------------- */
  352. #define MarvellPHYID0           0x0141
  353. #define LevelOnePHYID0 0x0013
  355. #define MII1000BaseTControlReg  9
  356. #define MII1000BaseTStatusReg   10
  357. #define SpecificReg 17
  359. /* for 1000BaseT Control Register */
  360. #define PHYAbletoPerform1000FullDuplex  0x0200
  361. #define PHYAbletoPerform1000HalfDuplex  0x0100
  362. #define PHY1000AbilityMask              0x300
  364. // for phy specific status register, marvell phy.
  365. #define SpeedMask       0x0c000
  366. #define Speed_1000M     0x08000
  367. #define Speed_100M      0x4000
  368. #define Speed_10M       0
  369. #define Full_Duplex     0x2000
  371. // 89/12/29 add, for phy specific status register, levelone phy, (begin)
  372. #define LXT1000_100M    0x08000
  373. #define LXT1000_1000M   0x0c000
  374. #define LXT1000_Full    0x200
  375. // 89/12/29 add, for phy specific status register, levelone phy, (end)
  377. /* for 3-in-1 case */
  378. #define PS10            0x00080000
  379. #define FD              0x00100000
  380. #define PS1000          0x00010000
  381. #define LinkIsUp2 0x00040000
  383. /* for PHY */
  384. #define LinkIsUp        0x0004
  387. struct netdev_private {
  388. /* Descriptor rings first for alignment. */
  389. struct fealnx_desc *rx_ring;
  390. struct fealnx_desc *tx_ring;
  392. dma_addr_t rx_ring_dma;
  393. dma_addr_t tx_ring_dma;
  395. spinlock_t lock;
  397. struct net_device_stats stats;
  399. /* Media monitoring timer. */
  400. struct timer_list timer;
  402. /* Frequently used values: keep some adjacent for cache effect. */
  403. int flags;
  404. struct pci_dev *pci_dev;
  405. unsigned long crvalue;
  406. unsigned long bcrvalue;
  407. unsigned long imrvalue;
  408. struct fealnx_desc *cur_rx;
  409. struct fealnx_desc *lack_rxbuf;
  410. int really_rx_count;
  411. struct fealnx_desc *cur_tx;
  412. struct fealnx_desc *cur_tx_copy;
  413. int really_tx_count;
  414. int free_tx_count;
  415. unsigned int rx_buf_sz; /* Based on MTU+slack. */
  417. /* These values are keep track of the transceiver/media in use. */
  418. unsigned int linkok;
  419. unsigned int line_speed;
  420. unsigned int duplexmode;
  421. unsigned int default_port:4; /* Last dev->if_port value. */
  422. unsigned int PHYType;
  424. /* MII transceiver section. */
  425. int mii_cnt; /* MII device addresses. */
  426. unsigned char phys[2]; /* MII device addresses. */
  427. struct mii_if_info mii;
  428. };
  431. static int mdio_read(struct net_device *dev, int phy_id, int location);
  432. static void mdio_write(struct net_device *dev, int phy_id, int location, int value);
  433. static int netdev_open(struct net_device *dev);
  434. static void getlinktype(struct net_device *dev);
  435. static void getlinkstatus(struct net_device *dev);
  436. static void netdev_timer(unsigned long data);
  437. static void tx_timeout(struct net_device *dev);
  438. static void init_ring(struct net_device *dev);
  439. static int start_tx(struct sk_buff *skb, struct net_device *dev);
  440. static void intr_handler(int irq, void *dev_instance, struct pt_regs *regs);
  441. static int netdev_rx(struct net_device *dev);
  442. static inline unsigned ether_crc(int length, unsigned char *data);
  443. static void set_rx_mode(struct net_device *dev);
  444. static struct net_device_stats *get_stats(struct net_device *dev);
  445. static int mii_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
  446. static int netdev_close(struct net_device *dev);
  447. static void reset_rx_descriptors(struct net_device *dev);
  449. void stop_nic_tx(long ioaddr, long crvalue)
  450. {
  451. writel(crvalue & (~0x40000), ioaddr + TCRRCR);
  453. /* wait for tx stop */
  454. {
  455. int i = 0, delay = 0x1000;
  457. while ((!(readl(ioaddr + TCRRCR) & 0x04000000)) && (i < delay)) {
  458. ++i;
  459. }
  460. }
  461. }
  464. void stop_nic_rx(long ioaddr, long crvalue)
  465. {
  466. writel(crvalue & (~0x1), ioaddr + TCRRCR);
  468. /* wait for rx stop */
  469. {
  470. int i = 0, delay = 0x1000;
  472. while ((!(readl(ioaddr + TCRRCR) & 0x00008000)) && (i < delay)) {
  473. ++i;
  474. }
  475. }
  476. }
  480. static int __devinit fealnx_init_one(struct pci_dev *pdev,
  481.      const struct pci_device_id *ent)
  482. {
  483. struct netdev_private *np;
  484. int i, option, err, irq;
  485. static int card_idx = -1;
  486. char boardname[12];
  487. long ioaddr;
  488. unsigned int chip_id = ent->driver_data;
  489. struct net_device *dev;
  490. void *ring_space;
  491. dma_addr_t ring_dma;
  493. /* when built into the kernel, we only print version if device is found */
  494. #ifndef MODULE
  495. static int printed_version;
  496. if (!printed_version++)
  497. printk (version);
  498. #endif
  500. card_idx++;
  501. sprintf(boardname, "fealnx%d", card_idx);
  503. option = card_idx < MAX_UNITS ? options[card_idx] : 0;
  505. i = pci_enable_device(pdev);
  506. if (i) return i;
  507. pci_set_master(pdev);
  509. #ifdef USE_IO_OPS
  510. ioaddr = pci_resource_len(pdev, 0);
  511. #else
  512. ioaddr = pci_resource_len(pdev, 1);
  513. #endif
  514. if (ioaddr < MIN_REGION_SIZE) {
  515. printk(KERN_ERR "%s: region size %ld too small, abortingn",
  516.        boardname, ioaddr);
  517. return -ENODEV;
  518. }
  520. i = pci_request_regions(pdev, boardname);
  521. if (i) return i;
  523. irq = pdev->irq;
  525. #ifdef USE_IO_OPS
  526. ioaddr = pci_resource_start(pdev, 0);
  527. #else
  528. ioaddr = (long) ioremap(pci_resource_start(pdev, 1),
  529. pci_resource_len(pdev, 1));
  530. if (!ioaddr) {
  531. err = -ENOMEM;
  532. goto err_out_res;
  533. }
  534. #endif
  536. dev = alloc_etherdev(sizeof(struct netdev_private));
  537. if (!dev) {
  538. err = -ENOMEM;
  539. goto err_out_unmap;
  540. }
  541. SET_MODULE_OWNER(dev);
  543. /* read ethernet id */
  544. for (i = 0; i < 6; ++i)
  545. dev->dev_addr[i] = readb(ioaddr + PAR0 + i);
  547. /* Reset the chip to erase previous misconfiguration. */
  548. writel(0x00000001, ioaddr + BCR);
  550. dev->base_addr = ioaddr;
  551. dev->irq = irq;
  553. /* Make certain the descriptor lists are aligned. */
  554. np = dev->priv;
  555. spin_lock_init(&np->lock);
  556. np->pci_dev = pdev;
  557. np->flags = skel_netdrv_tbl[chip_id].flags;
  558. pci_set_drvdata(pdev, dev);
  559. np->mii.dev = dev;
  560. np->mii.mdio_read = mdio_read;
  561. np->mii.mdio_write = mdio_write;
  563. ring_space = pci_alloc_consistent(pdev, RX_TOTAL_SIZE, &ring_dma);
  564. if (!ring_space) {
  565. err = -ENOMEM;
  566. goto err_out_free_dev;
  567. }
  568. np->rx_ring = (struct fealnx_desc *)ring_space;
  569. np->rx_ring_dma = ring_dma;
  571. ring_space = pci_alloc_consistent(pdev, TX_TOTAL_SIZE, &ring_dma);
  572. if (!ring_space) {
  573. err = -ENOMEM;
  574. goto err_out_free_rx;
  575. }
  576. np->tx_ring = (struct fealnx_desc *)ring_space;
  577. np->tx_ring_dma = ring_dma;
  579. /* find the connected MII xcvrs */
  580. if (np->flags == HAS_MII_XCVR) {
  581. int phy, phy_idx = 0;
  583. for (phy = 1; phy < 32 && phy_idx < 4; phy++) {
  584. int mii_status = mdio_read(dev, phy, 1);
  586. if (mii_status != 0xffff && mii_status != 0x0000) {
  587. np->phys[phy_idx++] = phy;
  588. printk(KERN_INFO
  589.        "%s: MII PHY found at address %d, status "
  590.        "0x%4.4x.n", dev->name, phy, mii_status);
  591. /* get phy type */
  592. {
  593. unsigned int data;
  595. data = mdio_read(dev, np->phys[0], 2);
  596. if (data == SeeqPHYID0)
  597. np->PHYType = SeeqPHY;
  598. else if (data == AhdocPHYID0)
  599. np->PHYType = AhdocPHY;
  600. else if (data == MarvellPHYID0)
  601. np->PHYType = MarvellPHY;
  602. else if (data == MysonPHYID0)
  603. np->PHYType = Myson981;
  604. else if (data == LevelOnePHYID0)
  605. np->PHYType = LevelOnePHY;
  606. else
  607. np->PHYType = OtherPHY;
  608. }
  609. }
  610. }
  612. np->mii_cnt = phy_idx;
  613. if (phy_idx == 0) {
  614. printk(KERN_WARNING "%s: MII PHY not found -- this device may "
  615.        "not operate correctly.n", dev->name);
  616. }
  617. } else {
  618. np->phys[0] = 32;
  619. /* 89/6/23 add, (begin) */
  620. /* get phy type */
  621. if (readl(dev->base_addr + PHYIDENTIFIER) == MysonPHYID)
  622. np->PHYType = MysonPHY;
  623. else
  624. np->PHYType = OtherPHY;
  625. }
  626. np->mii.phy_id = np->phys[0];
  628. if (dev->mem_start)
  629. option = dev->mem_start;
  631. /* The lower four bits are the media type. */
  632. if (option > 0) {
  633. if (option & 0x200)
  634. np->mii.full_duplex = 1;
  635. np->default_port = option & 15;
  636. }
  638. if (card_idx < MAX_UNITS && full_duplex[card_idx] > 0)
  639. np->mii.full_duplex = full_duplex[card_idx];
  641. if (np->mii.full_duplex) {
  642. printk(KERN_INFO "%s: Media type forced to Full Duplex.n", dev->name);
  643. /* 89/6/13 add, (begin) */
  644. //      if (np->PHYType==MarvellPHY)
  645. if ((np->PHYType == MarvellPHY) || (np->PHYType == LevelOnePHY)) {
  646. unsigned int data;
  648. data = mdio_read(dev, np->phys[0], 9);
  649. data = (data & 0xfcff) | 0x0200;
  650. mdio_write(dev, np->phys[0], 9, data);
  651. }
  652. /* 89/6/13 add, (end) */
  653. if (np->flags == HAS_MII_XCVR)
  654. mdio_write(dev, np->phys[0], MII_ADVERTISE, ADVERTISE_FULL);
  655. else
  656. writel(ADVERTISE_FULL, dev->base_addr + ANARANLPAR);
  657. np->mii.duplex_lock = 1;
  658. }
  660. /* The chip-specific entries in the device structure. */
  661. dev->open = &netdev_open;
  662. dev->hard_start_xmit = &start_tx;
  663. dev->stop = &netdev_close;
  664. dev->get_stats = &get_stats;
  665. dev->set_multicast_list = &set_rx_mode;
  666. dev->do_ioctl = &mii_ioctl;
  667. dev->tx_timeout = tx_timeout;
  668. dev->watchdog_timeo = TX_TIMEOUT;
  670. err = register_netdev(dev);
  671. if (err)
  672. goto err_out_free_tx;
  674. printk(KERN_INFO "%s: %s at 0x%lx, ",
  675.        dev->name, skel_netdrv_tbl[chip_id].chip_name, ioaddr);
  676. for (i = 0; i < 5; i++)
  677. printk("%2.2x:", dev->dev_addr[i]);
  678. printk("%2.2x, IRQ %d.n", dev->dev_addr[i], irq);
  680. return 0;
  682. err_out_free_tx:
  683. pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, np->tx_ring_dma);
  684. err_out_free_rx:
  685. pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, np->rx_ring_dma);
  686. err_out_free_dev:
  687. kfree(dev);
  688. err_out_unmap:
  689. #ifndef USE_IO_OPS
  690. iounmap((void *)ioaddr);
  691. err_out_res:
  692. #endif
  693. pci_release_regions(pdev);
  694. return err;
  695. }
  697. static void __devexit fealnx_remove_one(struct pci_dev *pdev)
  698. {
  699. struct net_device *dev = pci_get_drvdata(pdev);
  701. if (dev) {
  702. struct netdev_private *np = dev->priv;
  704. pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring,
  705. np->tx_ring_dma);
  706. pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring,
  707. np->rx_ring_dma);
  708. unregister_netdev(dev);
  709. #ifndef USE_IO_OPS
  710. iounmap((void *)dev->base_addr);
  711. #endif
  712. kfree(dev);
  713. pci_release_regions(pdev);
  714. pci_set_drvdata(pdev, NULL);
  715. } else
  716. printk(KERN_ERR "fealnx: remove for unknown devicen");
  717. }
  719. unsigned int m80x_read_tick(void)
  720. /* function: Reads the Timer tick count register which decrements by 2 from  */
  721. /*           65536 to 0 every 1/36.414 of a second. Each 2 decrements of the *//*           count represents 838 nsec's.                                    */
  722. /* input   : none.                                                           */
  723. /* output  : none.                                                           */
  724. {
  725. unsigned char tmp;
  726. int value;
  728. writeb((char) 0x06, 0x43); // Command 8254 to latch T0's count
  730. // now read the count.
  731. tmp = (unsigned char) readb(0x40);
  732. value = ((int) tmp) << 8;
  733. tmp = (unsigned char) readb(0x40);
  734. value |= (((int) tmp) & 0xff);
  735. return (value);
  736. }
  739. void m80x_delay(unsigned int interval)
  740. /* function: to wait for a specified time.                                   */
  741. /* input   : interval ... the specified time.                                */
  742. /* output  : none.                                                           */
  743. {
  744. unsigned int interval1, interval2, i = 0;
  746. interval1 = m80x_read_tick(); // get initial value
  747. do {
  748. interval2 = m80x_read_tick();
  749. if (interval1 < interval2)
  750. interval1 = interval2;
  751. ++i;
  752. } while (((interval1 - interval2) < (ushort) interval) && (i < 65535));
  753. }
  756. static ulong m80x_send_cmd_to_phy(long miiport, int opcode, int phyad, int regad)
  757. {
  758. ulong miir;
  759. int i;
  760. unsigned int mask, data;
  762. /* enable MII output */
  763. miir = (ulong) readl(miiport);
  764. miir &= 0xfffffff0;
  766. miir |= MASK_MIIR_MII_WRITE + MASK_MIIR_MII_MDO;
  768. /* send 32 1's preamble */
  769. for (i = 0; i < 32; i++) {
  770. /* low MDC; MDO is already high (miir) */
  771. miir &= ~MASK_MIIR_MII_MDC;
  772. writel(miir, miiport);
  774. /* high MDC */
  775. miir |= MASK_MIIR_MII_MDC;
  776. writel(miir, miiport);
  777. }
  779. /* calculate ST+OP+PHYAD+REGAD+TA */
  780. data = opcode | (phyad << 7) | (regad << 2);
  782. /* sent out */
  783. mask = 0x8000;
  784. while (mask) {
  785. /* low MDC, prepare MDO */
  786. miir &= ~(MASK_MIIR_MII_MDC + MASK_MIIR_MII_MDO);
  787. if (mask & data)
  788. miir |= MASK_MIIR_MII_MDO;
  790. writel(miir, miiport);
  791. /* high MDC */
  792. miir |= MASK_MIIR_MII_MDC;
  793. writel(miir, miiport);
  794. m80x_delay(30);
  796. /* next */
  797. mask >>= 1;
  798. if (mask == 0x2 && opcode == OP_READ)
  799. miir &= ~MASK_MIIR_MII_WRITE;
  800. }
  801. return miir;
  802. }
  805. static int mdio_read(struct net_device *dev, int phyad, int regad)
  806. {
  807. long miiport = dev->base_addr + MANAGEMENT;
  808. ulong miir;
  809. unsigned int mask, data;
  811. miir = m80x_send_cmd_to_phy(miiport, OP_READ, phyad, regad);
  813. /* read data */
  814. mask = 0x8000;
  815. data = 0;
  816. while (mask) {
  817. /* low MDC */
  818. miir &= ~MASK_MIIR_MII_MDC;
  819. writel(miir, miiport);
  821. /* read MDI */
  822. miir = readl(miiport);
  823. if (miir & MASK_MIIR_MII_MDI)
  824. data |= mask;
  826. /* high MDC, and wait */
  827. miir |= MASK_MIIR_MII_MDC;
  828. writel(miir, miiport);
  829. m80x_delay((int) 30);
  831. /* next */
  832. mask >>= 1;
  833. }
  835. /* low MDC */
  836. miir &= ~MASK_MIIR_MII_MDC;
  837. writel(miir, miiport);
  839. return data & 0xffff;
  840. }
  843. static void mdio_write(struct net_device *dev, int phyad, int regad, int data)
  844. {
  845. long miiport = dev->base_addr + MANAGEMENT;
  846. ulong miir;
  847. unsigned int mask;
  849. miir = m80x_send_cmd_to_phy(miiport, OP_WRITE, phyad, regad);
  851. /* write data */
  852. mask = 0x8000;
  853. while (mask) {
  854. /* low MDC, prepare MDO */
  855. miir &= ~(MASK_MIIR_MII_MDC + MASK_MIIR_MII_MDO);
  856. if (mask & data)
  857. miir |= MASK_MIIR_MII_MDO;
  858. writel(miir, miiport);
  860. /* high MDC */
  861. miir |= MASK_MIIR_MII_MDC;
  862. writel(miir, miiport);
  864. /* next */
  865. mask >>= 1;
  866. }
  868. /* low MDC */
  869. miir &= ~MASK_MIIR_MII_MDC;
  870. writel(miir, miiport);
  872. return;
  873. }
  876. static int netdev_open(struct net_device *dev)
  877. {
  878. struct netdev_private *np = dev->priv;
  879. long ioaddr = dev->base_addr;
  881. writel(0x00000001, ioaddr + BCR); /* Reset */
  883. if (request_irq(dev->irq, &intr_handler, SA_SHIRQ, dev->name, dev))
  884. return -EAGAIN;
  886. init_ring(dev);
  888. writel(np->rx_ring_dma, ioaddr + RXLBA);
  889. writel(np->tx_ring_dma, ioaddr + TXLBA);
  891. /* Initialize other registers. */
  892. /* Configure the PCI bus bursts and FIFO thresholds.
  893.    486: Set 8 longword burst.
  894.    586: no burst limit.
  895.    Burst length 5:3
  896.    0 0 0   1
  897.    0 0 1   4
  898.    0 1 0   8
  899.    0 1 1   16
  900.    1 0 0   32
  901.    1 0 1   64
  902.    1 1 0   128
  903.    1 1 1   256
  904.    Wait the specified 50 PCI cycles after a reset by initializing
  905.    Tx and Rx queues and the address filter list.
  906.    FIXME (Ueimor): optimistic for alpha + posted writes ? */
  907. #if defined(__powerpc__) || defined(__sparc__)
  908. // 89/9/1 modify, 
  909. //   np->bcrvalue=0x04 | 0x0x38;  /* big-endian, 256 burst length */
  910. np->bcrvalue = 0x04 | 0x10; /* big-endian, tx 8 burst length */
  911. np->crvalue = 0xe00; /* rx 128 burst length */
  912. #elif defined(__alpha__) || defined(__x86_64__)
  913. // 89/9/1 modify, 
  914. //   np->bcrvalue=0x38;           /* little-endian, 256 burst length */
  915. np->bcrvalue = 0x10; /* little-endian, 8 burst length */
  916. np->crvalue = 0xe00; /* rx 128 burst length */
  917. #elif defined(__i386__)
  918. #if defined(MODULE)
  919. // 89/9/1 modify, 
  920. //   np->bcrvalue=0x38;           /* little-endian, 256 burst length */
  921. np->bcrvalue = 0x10; /* little-endian, 8 burst length */
  922. np->crvalue = 0xe00; /* rx 128 burst length */
  923. #else
  924. /* When not a module we can work around broken '486 PCI boards. */
  925. #define x86 boot_cpu_data.x86
  926. // 89/9/1 modify, 
  927. //   np->bcrvalue=(x86 <= 4 ? 0x10 : 0x38);
  928. np->bcrvalue = 0x10;
  929. np->crvalue = (x86 <= 4 ? 0xa00 : 0xe00);
  930. if (x86 <= 4)
  931. printk(KERN_INFO "%s: This is a 386/486 PCI system, setting burst "
  932.        "length to %x.n", dev->name, (x86 <= 4 ? 0x10 : 0x38));
  933. #endif
  934. #else
  935. // 89/9/1 modify,
  936. //   np->bcrvalue=0x38;
  937. np->bcrvalue = 0x10;
  938. np->cralue = 0xe00; /* rx 128 burst length */
  939. #warning Processor architecture undefined!
  940. #endif
  941. // 89/12/29 add,
  942. // 90/1/16 modify,
  943. //   np->imrvalue=FBE|TUNF|CNTOVF|RBU|TI|RI;
  944. np->imrvalue = TUNF | CNTOVF | RBU | TI | RI;
  945. if (np->pci_dev->device == 0x891) {
  946. np->bcrvalue |= 0x200; /* set PROG bit */
  947. np->crvalue |= 0x02000000; /* set enhanced bit */
  948. np->imrvalue |= ETI;
  949. }
  950. writel(np->bcrvalue, ioaddr + BCR);
  952. if (dev->if_port == 0)
  953. dev->if_port = np->default_port;
  955. writel(0, dev->base_addr + RXPDR);
  956. // 89/9/1 modify,
  957. //   np->crvalue = 0x00e40001;    /* tx store and forward, tx/rx enable */
  958. np->crvalue |= 0x00e40001; /* tx store and forward, tx/rx enable */
  959. np->mii.full_duplex = np->mii.duplex_lock;
  960. getlinkstatus(dev);
  961. if (np->linkok)
  962. getlinktype(dev);
  963. set_rx_mode(dev);
  965. netif_start_queue(dev);
  967. /* Clear and Enable interrupts by setting the interrupt mask. */
  968. writel(FBE | TUNF | CNTOVF | RBU | TI | RI, ioaddr + ISR);
  969. writel(np->imrvalue, ioaddr + IMR);
  971. if (debug)
  972. printk(KERN_DEBUG "%s: Done netdev_open().n", dev->name);
  974. /* Set the timer to check for link beat. */
  975. init_timer(&np->timer);
  976. np->timer.expires = RUN_AT(3 * HZ);
  977. np->timer.data = (unsigned long) dev;
  978. np->timer.function = &netdev_timer;
  980. /* timer handler */
  981. add_timer(&np->timer);
  983. return 0;
  984. }
  987. static void getlinkstatus(struct net_device *dev)
  988. /* function: Routine will read MII Status Register to get link status.       */
  989. /* input   : dev... pointer to the adapter block.                            */
  990. /* output  : none.                                                           */
  991. {
  992. struct netdev_private *np = dev->priv;
  993. unsigned int i, DelayTime = 0x1000;
  995. np->linkok = 0;
  997. if (np->PHYType == MysonPHY) {
  998. for (i = 0; i < DelayTime; ++i) {
  999. if (readl(dev->base_addr + BMCRSR) & LinkIsUp2) {
  1000. np->linkok = 1;
  1001. return;
  1002. }
  1003. // delay
  1004. m80x_delay(100);
  1005. }
  1006. } else {
  1007. for (i = 0; i < DelayTime; ++i) {
  1008. if (mdio_read(dev, np->phys[0], MII_BMSR) & BMSR_LSTATUS) {
  1009. np->linkok = 1;
  1010. return;
  1011. }
  1012. // delay
  1013. m80x_delay(100);
  1014. }
  1015. }
  1016. }
  1019. static void getlinktype(struct net_device *dev)
  1020. {
  1021. struct netdev_private *np = dev->priv;
  1023. if (np->PHYType == MysonPHY) { /* 3-in-1 case */
  1024. if (readl(dev->base_addr + TCRRCR) & FD)
  1025. np->duplexmode = 2; /* full duplex */
  1026. else
  1027. np->duplexmode = 1; /* half duplex */
  1028. if (readl(dev->base_addr + TCRRCR) & PS10)
  1029. np->line_speed = 1; /* 10M */
  1030. else
  1031. np->line_speed = 2; /* 100M */
  1032. } else {
  1033. if (np->PHYType == SeeqPHY) { /* this PHY is SEEQ 80225 */
  1034. unsigned int data;
  1036. data = mdio_read(dev, np->phys[0], MIIRegister18);
  1037. if (data & SPD_DET_100)
  1038. np->line_speed = 2; /* 100M */
  1039. else
  1040. np->line_speed = 1; /* 10M */
  1041. if (data & DPLX_DET_FULL)
  1042. np->duplexmode = 2; /* full duplex mode */
  1043. else
  1044. np->duplexmode = 1; /* half duplex mode */
  1045. } else if (np->PHYType == AhdocPHY) {
  1046. unsigned int data;
  1048. data = mdio_read(dev, np->phys[0], DiagnosticReg);
  1049. if (data & Speed_100)
  1050. np->line_speed = 2; /* 100M */
  1051. else
  1052. np->line_speed = 1; /* 10M */
  1053. if (data & DPLX_FULL)
  1054. np->duplexmode = 2; /* full duplex mode */
  1055. else
  1056. np->duplexmode = 1; /* half duplex mode */
  1057. }
  1058. /* 89/6/13 add, (begin) */
  1059. else if (np->PHYType == MarvellPHY) {
  1060. unsigned int data;
  1062. data = mdio_read(dev, np->phys[0], SpecificReg);
  1063. if (data & Full_Duplex)
  1064. np->duplexmode = 2; /* full duplex mode */
  1065. else
  1066. np->duplexmode = 1; /* half duplex mode */
  1067. data &= SpeedMask;
  1068. if (data == Speed_1000M)
  1069. np->line_speed = 3; /* 1000M */
  1070. else if (data == Speed_100M)
  1071. np->line_speed = 2; /* 100M */
  1072. else
  1073. np->line_speed = 1; /* 10M */
  1074. }
  1075. /* 89/6/13 add, (end) */
  1076. /* 89/7/27 add, (begin) */
  1077. else if (np->PHYType == Myson981) {
  1078. unsigned int data;
  1080. data = mdio_read(dev, np->phys[0], StatusRegister);
  1082. if (data & SPEED100)
  1083. np->line_speed = 2;
  1084. else
  1085. np->line_speed = 1;
  1087. if (data & FULLMODE)
  1088. np->duplexmode = 2;
  1089. else
  1090. np->duplexmode = 1;
  1091. }
  1092. /* 89/7/27 add, (end) */
  1093. /* 89/12/29 add */
  1094. else if (np->PHYType == LevelOnePHY) {
  1095. unsigned int data;
  1097. data = mdio_read(dev, np->phys[0], SpecificReg);
  1098. if (data & LXT1000_Full)
  1099. np->duplexmode = 2; /* full duplex mode */
  1100. else
  1101. np->duplexmode = 1; /* half duplex mode */
  1102. data &= SpeedMask;
  1103. if (data == LXT1000_1000M)
  1104. np->line_speed = 3; /* 1000M */
  1105. else if (data == LXT1000_100M)
  1106. np->line_speed = 2; /* 100M */
  1107. else
  1108. np->line_speed = 1; /* 10M */
  1109. }
  1110. // chage crvalue
  1111. // np->crvalue&=(~PS10)&(~FD);
  1112. np->crvalue &= (~PS10) & (~FD) & (~PS1000);
  1113. if (np->line_speed == 1)
  1114. np->crvalue |= PS10;
  1115. else if (np->line_speed == 3)
  1116. np->crvalue |= PS1000;
  1117. if (np->duplexmode == 2)
  1118. np->crvalue |= FD;
  1119. }
  1120. }
  1123. static void allocate_rx_buffers(struct net_device *dev)
  1124. {
  1125. struct netdev_private *np = dev->priv;
  1127. /*  allocate skb for rx buffers */
  1128. while (np->really_rx_count != RX_RING_SIZE) {
  1129. struct sk_buff *skb;
  1131. skb = dev_alloc_skb(np->rx_buf_sz);
  1132. np->lack_rxbuf->skbuff = skb;
  1134. if (skb == NULL)
  1135. break; /* Better luck next round. */
  1137. skb->dev = dev; /* Mark as being used by this device. */
  1138. np->lack_rxbuf->buffer = pci_map_single(np->pci_dev, skb->tail,
  1139. np->rx_buf_sz, PCI_DMA_FROMDEVICE);
  1140. np->lack_rxbuf = np->lack_rxbuf->next_desc_logical;
  1141. ++np->really_rx_count;
  1142. }
  1143. }
  1146. static void netdev_timer(unsigned long data)
  1147. {
  1148. struct net_device *dev = (struct net_device *) data;
  1149. struct netdev_private *np = dev->priv;
  1150. long ioaddr = dev->base_addr;
  1151. int next_tick = 10 * HZ;
  1152. int old_crvalue = np->crvalue;
  1153. unsigned int old_linkok = np->linkok;
  1155. if (debug)
  1156. printk(KERN_DEBUG "%s: Media selection timer tick, status %8.8x "
  1157.        "config %8.8x.n", dev->name, readl(ioaddr + ISR),
  1158.        readl(ioaddr + TCRRCR));
  1160. if (np->flags == HAS_MII_XCVR) {
  1161. getlinkstatus(dev);
  1162. if ((old_linkok == 0) && (np->linkok == 1)) { /* we need to detect the media type again */
  1163. getlinktype(dev);
  1164. if (np->crvalue != old_crvalue) {
  1165. stop_nic_tx(ioaddr, np->crvalue);
  1166. stop_nic_rx(ioaddr, np->crvalue & (~0x40000));
  1167. writel(np->crvalue, ioaddr + TCRRCR);
  1168. }
  1169. }
  1170. }
  1172. allocate_rx_buffers(dev);
  1174. np->timer.expires = RUN_AT(next_tick);
  1175. add_timer(&np->timer);
  1176. }
  1179. static void tx_timeout(struct net_device *dev)
  1180. {
  1181. struct netdev_private *np = dev->priv;
  1182. long ioaddr = dev->base_addr;
  1183. int i;
  1185. printk(KERN_WARNING "%s: Transmit timed out, status %8.8x,"
  1186.        " resetting...n", dev->name, readl(ioaddr + ISR));
  1188. {
  1190. printk(KERN_DEBUG "  Rx ring %p: ", np->rx_ring);
  1191. for (i = 0; i < RX_RING_SIZE; i++)
  1192. printk(" %8.8x", (unsigned int) np->rx_ring[i].status);
  1193. printk("n" KERN_DEBUG "  Tx ring %p: ", np->tx_ring);
  1194. for (i = 0; i < TX_RING_SIZE; i++)
  1195. printk(" %4.4x", np->tx_ring[i].status);
  1196. printk("n");
  1197. }
  1199.    + dev->if_port = np->default_port;
  1200. /* Reinit. Gross */
  1202. /* Reset the chip's Tx and Rx processes. */
  1203. stop_nic_tx(ioaddr, 0);
  1204. reset_rx_descriptors(dev);
  1206. /* Disable interrupts by clearing the interrupt mask. */
  1207. writel(0x0000, ioaddr + IMR);
  1209. /* Reset the chip to erase previous misconfiguration. */
  1210. writel(0x00000001, ioaddr + BCR);
  1212. /* Ueimor: wait for 50 PCI cycles (and flush posted writes btw). 
  1213.    We surely wait too long (address+data phase). Who cares ? */
  1214. for (i = 0; i < 50; i++) {
  1215. readl(ioaddr + BCR);
  1216. rmb();
  1217. }
  1219. writel((np->cur_tx - np->tx_ring)*sizeof(struct fealnx_desc) +
  1220. np->tx_ring_dma, ioaddr + TXLBA);
  1221. writel((np->cur_rx - np->rx_ring)*sizeof(struct fealnx_desc) +
  1222. np->rx_ring_dma, ioaddr + RXLBA);
  1224. writel(np->bcrvalue, ioaddr + BCR);
  1226. writel(0, dev->base_addr + RXPDR);
  1227. set_rx_mode(dev);
  1228. /* Clear and Enable interrupts by setting the interrupt mask. */
  1229. writel(FBE | TUNF | CNTOVF | RBU | TI | RI, ioaddr + ISR);
  1230. writel(np->imrvalue, ioaddr + IMR);
  1232. writel(0, dev->base_addr + TXPDR);
  1234. dev->trans_start = jiffies;
  1235. np->stats.tx_errors++;
  1237. return;
  1238. }
  1241. /* Initialize the Rx and Tx rings, along with various 'dev' bits. */
  1242. static void init_ring(struct net_device *dev)
  1243. {
  1244. struct netdev_private *np = dev->priv;
  1245. int i;
  1247. /* initialize rx variables */
  1248. np->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32);
  1249. np->cur_rx = &np->rx_ring[0];
  1250. np->lack_rxbuf = NULL;
  1251. np->really_rx_count = 0;
  1253. /* initial rx descriptors. */
  1254. for (i = 0; i < RX_RING_SIZE; i++) {
  1255. np->rx_ring[i].status = 0;
  1256. np->rx_ring[i].control = np->rx_buf_sz << RBSShift;
  1257. np->rx_ring[i].next_desc = np->rx_ring_dma +
  1258. (i + 1)*sizeof(struct fealnx_desc);
  1259. np->rx_ring[i].next_desc_logical = &np->rx_ring[i + 1];
  1260. np->rx_ring[i].skbuff = NULL;
  1261. }
  1263. /* for the last rx descriptor */
  1264. np->rx_ring[i - 1].next_desc = np->rx_ring_dma;
  1265. np->rx_ring[i - 1].next_desc_logical = np->rx_ring;
  1267. /* allocate skb for rx buffers */
  1268. for (i = 0; i < RX_RING_SIZE; i++) {
  1269. struct sk_buff *skb = dev_alloc_skb(np->rx_buf_sz);
  1271. if (skb == NULL) {
  1272. np->lack_rxbuf = &np->rx_ring[i];
  1273. break;
  1274. }
  1276. ++np->really_rx_count;
  1277. np->rx_ring[i].skbuff = skb;
  1278. skb->dev = dev; /* Mark as being used by this device. */
  1279. np->rx_ring[i].buffer = pci_map_single(np->pci_dev, skb->tail,
  1280. np->rx_buf_sz, PCI_DMA_FROMDEVICE);
  1281. np->rx_ring[i].status = RXOWN;
  1282. np->rx_ring[i].control |= RXIC;
  1283. }
  1285. /* initialize tx variables */
  1286. np->cur_tx = &np->tx_ring[0];
  1287. np->cur_tx_copy = &np->tx_ring[0];
  1288. np->really_tx_count = 0;
  1289. np->free_tx_count = TX_RING_SIZE;
  1291. for (i = 0; i < TX_RING_SIZE; i++) {
  1292. np->tx_ring[i].status = 0;
  1293. np->tx_ring[i].next_desc = np->tx_ring_dma +
  1294. (i + 1)*sizeof(struct fealnx_desc);
  1295. np->tx_ring[i].next_desc_logical = &np->tx_ring[i + 1];
  1296. np->tx_ring[i].skbuff = NULL;
  1297. }
  1299. /* for the last tx descriptor */
  1300. np->tx_ring[i - 1].next_desc = np->tx_ring_dma;
  1301. np->tx_ring[i - 1].next_desc_logical = &np->tx_ring[0];
  1303. return;
  1304. }
  1307. static int start_tx(struct sk_buff *skb, struct net_device *dev)
  1308. {
  1309. struct netdev_private *np = dev->priv;
  1311. np->cur_tx_copy->skbuff = skb;
  1313. #define one_buffer
  1314. #define BPT 1022
  1315. #if defined(one_buffer)
  1316. np->cur_tx_copy->buffer = pci_map_single(np->pci_dev, skb->data,
  1317. skb->len, PCI_DMA_TODEVICE);
  1318. np->cur_tx_copy->control = TXIC | TXLD | TXFD | CRCEnable | PADEnable;
  1319. np->cur_tx_copy->control |= (skb->len << PKTSShift); /* pkt size */
  1320. np->cur_tx_copy->control |= (skb->len << TBSShift); /* buffer size */
  1321. // 89/12/29 add,
  1322. if (np->pci_dev->device == 0x891)
  1323. np->cur_tx_copy->control |= ETIControl | RetryTxLC;
  1324. np->cur_tx_copy->status = TXOWN;
  1325. np->cur_tx_copy = np->cur_tx_copy->next_desc_logical;
  1326. --np->free_tx_count;
  1327. #elif defined(two_buffer)
  1328. if (skb->len > BPT) {
  1329. struct fealnx_desc *next;
  1331. /* for the first descriptor */
  1332. np->cur_tx_copy->buffer = pci_map_single(np->pci_dev, skb->data,
  1333. BPT, PCI_DMA_TODEVICE);
  1334. np->cur_tx_copy->control = TXIC | TXFD | CRCEnable | PADEnable;
  1335. np->cur_tx_copy->control |= (skb->len << PKTSShift); /* pkt size */
  1336. np->cur_tx_copy->control |= (BPT << TBSShift); /* buffer size */
  1338. /* for the last descriptor */
  1339. next = (struct fealnx *) np->cur_tx_copy.next_desc_logical;
  1340. next->skbuff = skb;
  1341. next->control = TXIC | TXLD | CRCEnable | PADEnable;
  1342. next->control |= (skb->len << PKTSShift); /* pkt size */
  1343. next->control |= ((skb->len - BPT) << TBSShift); /* buf size */
  1344. // 89/12/29 add,
  1345. if (np->pci_dev->device == 0x891)
  1346. np->cur_tx_copy->control |= ETIControl | RetryTxLC;
  1347. next->buffer = pci_map_single(ep->pci_dev, skb->data + BPT,
  1348.                                 skb->len - BPT, PCI_DMA_TODEVICE);
  1350. next->status = TXOWN;
  1351. np->cur_tx_copy->status = TXOWN;
  1353. np->cur_tx_copy = next->next_desc_logical;
  1354. np->free_tx_count -= 2;
  1355. } else {
  1356. np->cur_tx_copy->buffer = pci_map_single(np->pci_dev, skb->data,
  1357. skb->len, PCI_DMA_TODEVICE);
  1358. np->cur_tx_copy->control = TXIC | TXLD | TXFD | CRCEnable | PADEnable;
  1359. np->cur_tx_copy->control |= (skb->len << PKTSShift); /* pkt size */
  1360. np->cur_tx_copy->control |= (skb->len << TBSShift); /* buffer size */
  1361. // 89/12/29 add,
  1362. if (np->pci_dev->device == 0x891)
  1363. np->cur_tx_copy->control |= ETIControl | RetryTxLC;
  1364. np->cur_tx_copy->status = TXOWN;
  1365. np->cur_tx_copy = np->cur_tx_copy->next_desc_logical;
  1366. --np->free_tx_count;
  1367. }
  1368. #endif
  1370. if (np->free_tx_count < 2)
  1371. netif_stop_queue(dev);
  1372. ++np->really_tx_count;
  1373. writel(0, dev->base_addr + TXPDR);
  1374. dev->trans_start = jiffies;
  1376. return 0;
  1377. }
  1380. void free_one_rx_descriptor(struct netdev_private *np)
  1381. {
  1382. if (np->really_rx_count == RX_RING_SIZE)
  1383. np->cur_rx->status = RXOWN;
  1384. else {
  1385. np->lack_rxbuf->skbuff = np->cur_rx->skbuff;
  1386. np->lack_rxbuf->buffer = np->cur_rx->buffer;
  1387. np->lack_rxbuf->status = RXOWN;
  1388. ++np->really_rx_count;
  1389. np->lack_rxbuf = np->lack_rxbuf->next_desc_logical;
  1390. }
  1391. np->cur_rx = np->cur_rx->next_desc_logical;
  1392. }
  1395. void reset_rx_descriptors(struct net_device *dev)
  1396. {
  1397. struct netdev_private *np = dev->priv;
  1399. stop_nic_rx(dev->base_addr, np->crvalue);
  1401. while (!(np->cur_rx->status & RXOWN))
  1402. free_one_rx_descriptor(np);
  1404. allocate_rx_buffers(dev);
  1406. writel(np->rx_ring_dma + (np->cur_rx - np->rx_ring),
  1407. dev->base_addr + RXLBA);
  1408. writel(np->crvalue, dev->base_addr + TCRRCR);
  1409. }
  1412. /* The interrupt handler does all of the Rx thread work and cleans up
  1413.    after the Tx thread. */
  1414. static void intr_handler(int irq, void *dev_instance, struct pt_regs *rgs)
  1415. {
  1416. struct net_device *dev = (struct net_device *) dev_instance;
  1417. struct netdev_private *np = dev->priv;
  1418. long ioaddr, boguscnt = max_interrupt_work;
  1419. unsigned int num_tx = 0;
  1421. writel(0, dev->base_addr + IMR);
  1423. ioaddr = dev->base_addr;
  1424. np = (struct netdev_private *) dev->priv;
  1426. do {
  1427. u32 intr_status = readl(ioaddr + ISR);
  1429. /* Acknowledge all of the current interrupt sources ASAP. */
  1430. writel(intr_status, ioaddr + ISR);
  1432. if (debug)
  1433. printk(KERN_DEBUG "%s: Interrupt, status %4.4x.n", dev->name,
  1434.        intr_status);
  1436. if (!(intr_status & np->imrvalue))
  1437. break;
  1439. // 90/1/16 delete,
  1440. //
  1441. //      if (intr_status & FBE)
  1442. //      {   /* fatal error */
  1443. //          stop_nic_tx(ioaddr, 0);
  1444. //          stop_nic_rx(ioaddr, 0);
  1445. //          break;
  1446. //      };
  1448. if (intr_status & TUNF)
  1449. writel(0, ioaddr + TXPDR);
  1451. if (intr_status & CNTOVF) {
  1452. /* missed pkts */
  1453. np->stats.rx_missed_errors += readl(ioaddr + TALLY) & 0x7fff;
  1455. /* crc error */
  1456. np->stats.rx_crc_errors +=
  1457.     (readl(ioaddr + TALLY) & 0x7fff0000) >> 16;
  1458. }
  1460. if (intr_status & (RI | RBU)) {
  1461. if (intr_status & RI)
  1462. netdev_rx(dev);
  1463. else
  1464. reset_rx_descriptors(dev);
  1465. }
  1467. while (np->really_tx_count) {
  1468. long tx_status = np->cur_tx->status;
  1469. long tx_control = np->cur_tx->control;
  1471. if (!(tx_control & TXLD)) { /* this pkt is combined by two tx descriptors */
  1472. struct fealnx_desc *next;
  1474. next = np->cur_tx->next_desc_logical;
  1475. tx_status = next->status;
  1476. tx_control = next->control;
  1477. }
  1479. if (tx_status & TXOWN)
  1480. break;
  1482. if (!(np->crvalue & 0x02000000)) {
  1483. if (tx_status & (CSL | LC | EC | UDF | HF)) {
  1484. np->stats.tx_errors++;
  1485. if (tx_status & EC)
  1486. np->stats.tx_aborted_errors++;
  1487. if (tx_status & CSL)
  1488. np->stats.tx_carrier_errors++;
  1489. if (tx_status & LC)
  1490. np->stats.tx_window_errors++;
  1491. if (tx_status & UDF)
  1492. np->stats.tx_fifo_errors++;
  1493. if ((tx_status & HF) && np->mii.full_duplex == 0)
  1494. np->stats.tx_heartbeat_errors++;
  1496. #ifdef ETHER_STATS
  1497. if (tx_status & EC)
  1498. np->stats.collisions16++;
  1499. #endif
  1500. } else {
  1501. #ifdef ETHER_STATS
  1502. if (tx_status & DFR)
  1503. np->stats.tx_deferred++;
  1504. #endif
  1506. np->stats.tx_bytes +=
  1507.     ((tx_control & PKTSMask) >> PKTSShift);
  1509. np->stats.collisions +=
  1510.     ((tx_status & NCRMask) >> NCRShift);
  1511. np->stats.tx_packets++;
  1512. }
  1513. } else {
  1514. np->stats.tx_bytes +=
  1515.     ((tx_control & PKTSMask) >> PKTSShift);
  1516. np->stats.tx_packets++;
  1517. }
  1519. /* Free the original skb. */
  1520. pci_unmap_single(np->pci_dev, np->cur_tx->buffer,
  1521. np->cur_tx->skbuff->len, PCI_DMA_TODEVICE);
  1522. dev_kfree_skb_irq(np->cur_tx->skbuff);
  1523. np->cur_tx->skbuff = NULL;
  1524. --np->really_tx_count;
  1525. if (np->cur_tx->control & TXLD) {
  1526. np->cur_tx = np->cur_tx->next_desc_logical;
  1527. ++np->free_tx_count;
  1528. } else {
  1529. np->cur_tx = np->cur_tx->next_desc_logical;
  1530. np->cur_tx = np->cur_tx->next_desc_logical;
  1531. np->free_tx_count += 2;
  1532. }
  1533. num_tx++;
  1534. } /* end of for loop */
  1536. if (num_tx && np->free_tx_count >= 2)
  1537. netif_wake_queue(dev);
  1539. /* read transmit status for enhanced mode only */
  1540. if (np->crvalue & 0x02000000) {
  1541. long data;
  1543. data = readl(ioaddr + TSR);
  1544. np->stats.tx_errors += (data & 0xff000000) >> 24;
  1545. np->stats.tx_aborted_errors += (data & 0xff000000) >> 24;
  1546. np->stats.tx_window_errors += (data & 0x00ff0000) >> 16;
  1547. #ifdef ETHER_STATS
  1548. np->stats.collisions16 += (data & 0xff000000) >> 24;
  1549. #endif
  1550. np->stats.collisions += (data & 0x0000ffff);
  1551. }
  1553. if (--boguscnt < 0) {
  1554. printk(KERN_WARNING "%s: Too much work at interrupt, "
  1555.        "status=0x%4.4x.n", dev->name, intr_status);
  1556. break;
  1557. }
  1558. } while (1);
  1560. /* read the tally counters */
  1561. /* missed pkts */
  1562. np->stats.rx_missed_errors += readl(ioaddr + TALLY) & 0x7fff;
  1564. /* crc error */
  1565. np->stats.rx_crc_errors += (readl(ioaddr + TALLY) & 0x7fff0000) >> 16;
  1567. if (debug)
  1568. printk(KERN_DEBUG "%s: exiting interrupt, status=%#4.4x.n",
  1569.        dev->name, readl(ioaddr + ISR));
  1571. writel(np->imrvalue, ioaddr + IMR);
  1573. return;
  1574. }
  1577. /* This routine is logically part of the interrupt handler, but seperated
  1578.    for clarity and better register allocation. */
  1579. static int netdev_rx(struct net_device *dev)
  1580. {
  1581. struct netdev_private *np = dev->priv;
  1583. /* If EOP is set on the next entry, it's a new packet. Send it up. */
  1584. while (!(np->cur_rx->status & RXOWN)) {
  1585. s32 rx_status = np->cur_rx->status;
  1587. if (np->really_rx_count == 0)
  1588. break;
  1590. if (debug)
  1591. printk(KERN_DEBUG "  netdev_rx() status was %8.8x.n", rx_status);
  1593. if ((!((rx_status & RXFSD) && (rx_status & RXLSD)))
  1594.     || (rx_status & ErrorSummary)) {
  1595. if (rx_status & ErrorSummary) { /* there was a fatal error */
  1596. if (debug)
  1597. printk(KERN_DEBUG
  1598.        "%s: Receive error, Rx status %8.8x.n",
  1599.        dev->name, rx_status);
  1601. np->stats.rx_errors++; /* end of a packet. */
  1602. if (rx_status & (LONG | RUNT))
  1603. np->stats.rx_length_errors++;
  1604. if (rx_status & RXER)
  1605. np->stats.rx_frame_errors++;
  1606. if (rx_status & CRC)
  1607. np->stats.rx_crc_errors++;
  1608. } else {
  1609. int need_to_reset = 0;
  1610. int desno = 0;
  1612. if (rx_status & RXFSD) { /* this pkt is too long, over one rx buffer */
  1613. struct fealnx_desc *cur;
  1615. /* check this packet is received completely? */
  1616. cur = np->cur_rx;
  1617. while (desno <= np->really_rx_count) {
  1618. ++desno;
  1619. if ((!(cur->status & RXOWN))
  1620.     && (cur->status & RXLSD))
  1621. break;
  1622. /* goto next rx descriptor */
  1623. cur = cur->next_desc_logical;
  1624. }
  1625. if (desno > np->really_rx_count)
  1626. need_to_reset = 1;
  1627. } else /* RXLSD did not find, something error */
  1628. need_to_reset = 1;
  1630. if (need_to_reset == 0) {
  1631. int i;
  1633. np->stats.rx_length_errors++;
  1635. /* free all rx descriptors related this long pkt */
  1636. for (i = 0; i < desno; ++i)
  1637. free_one_rx_descriptor(np);
  1638. continue;
  1639. } else { /* something error, need to reset this chip */
  1640. reset_rx_descriptors(dev);
  1641. }
  1642. break; /* exit the while loop */
  1643. }
  1644. } else { /* this received pkt is ok */
  1646. struct sk_buff *skb;
  1647. /* Omit the four octet CRC from the length. */
  1648. short pkt_len = ((rx_status & FLNGMASK) >> FLNGShift) - 4;
  1650. #ifndef final_version
  1651. if (debug)
  1652. printk(KERN_DEBUG "  netdev_rx() normal Rx pkt length %d"
  1653.        " status %x.n", pkt_len, rx_status);
  1654. #endif
  1655. pci_dma_sync_single(np->pci_dev, np->cur_rx->buffer,
  1656. np->rx_buf_sz, PCI_DMA_FROMDEVICE);
  1657. pci_unmap_single(np->pci_dev, np->cur_rx->buffer,
  1658. np->rx_buf_sz, PCI_DMA_FROMDEVICE);
  1660. /* Check if the packet is long enough to accept without copying
  1661.    to a minimally-sized skbuff. */
  1662. if (pkt_len < rx_copybreak &&
  1663.     (skb = dev_alloc_skb(pkt_len + 2)) != NULL) {
  1664. skb->dev = dev;
  1665. skb_reserve(skb, 2); /* 16 byte align the IP header */
  1666. /* Call copy + cksum if available. */
  1668. #if ! defined(__alpha__)
  1669. eth_copy_and_sum(skb, 
  1670. np->cur_rx->skbuff->tail, pkt_len, 0);
  1671. skb_put(skb, pkt_len);
  1672. #else
  1673. memcpy(skb_put(skb, pkt_len),
  1674. np->cur_rx->skbuff->tail, pkt_len);
  1675. #endif
  1676. } else {
  1677. skb_put(skb = np->cur_rx->skbuff, pkt_len);
  1678. np->cur_rx->skbuff = NULL;
  1679. if (np->really_rx_count == RX_RING_SIZE)
  1680. np->lack_rxbuf = np->cur_rx;
  1681. --np->really_rx_count;
  1682. }
  1683. skb->protocol = eth_type_trans(skb, dev);
  1684. netif_rx(skb);
  1685. dev->last_rx = jiffies;
  1686. np->stats.rx_packets++;
  1687. np->stats.rx_bytes += pkt_len;
  1688. }
  1690. if (np->cur_rx->skbuff == NULL) {
  1691. struct sk_buff *skb;
  1693. skb = dev_alloc_skb(np->rx_buf_sz);
  1695. if (skb != NULL) {
  1696. skb->dev = dev; /* Mark as being used by this device. */
  1697. np->cur_rx->buffer = pci_map_single(np->pci_dev, skb->tail,
  1698. np->rx_buf_sz, PCI_DMA_FROMDEVICE);
  1699. np->cur_rx->skbuff = skb;
  1700. ++np->really_rx_count;
  1701. }
  1702. }
  1704. if (np->cur_rx->skbuff != NULL)
  1705. free_one_rx_descriptor(np);
  1706. } /* end of while loop */
  1708. /*  allocate skb for rx buffers */
  1709. allocate_rx_buffers(dev);
  1711. return 0;
  1712. }
  1715. static struct net_device_stats *get_stats(struct net_device *dev)
  1716. {
  1717. long ioaddr = dev->base_addr;
  1718. struct netdev_private *np = dev->priv;
  1720. /* The chip only need report frame silently dropped. */
  1721. if (netif_running(dev)) {
  1722. np->stats.rx_missed_errors += readl(ioaddr + TALLY) & 0x7fff;
  1723. np->stats.rx_crc_errors += (readl(ioaddr + TALLY) & 0x7fff0000) >> 16;
  1724. }
  1726. return &np->stats;
  1727. }
  1730. static unsigned const ethernet_polynomial = 0x04c11db7U;
  1731. static inline u32 ether_crc(int length, unsigned char *data)
  1732. {
  1733. int crc = -1;
  1735. while (--length >= 0) {
  1736. unsigned char current_octet = *data++;
  1737. int bit;
  1739. for (bit = 0; bit < 8; bit++, current_octet >>= 1) {
  1740. crc = (crc << 1) ^
  1741.     ((crc < 0) ^ (current_octet & 1) ? ethernet_polynomial : 0);
  1742. }
  1743. }
  1745. return crc;
  1746. }
  1749. static void set_rx_mode(struct net_device *dev)
  1750. {
  1751. struct netdev_private *np = dev->priv;
  1752. long ioaddr = dev->base_addr;
  1753. u32 mc_filter[2]; /* Multicast hash filter */
  1754. u32 rx_mode;
  1756. if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */
  1757. /* Unconditionally log net taps. */
  1758. printk(KERN_NOTICE "%s: Promiscuous mode enabled.n", dev->name);
  1759. memset(mc_filter, 0xff, sizeof(mc_filter));
  1760. rx_mode = PROM | AB | AM;
  1761. } else if ((dev->mc_count > multicast_filter_limit)
  1762.    || (dev->flags & IFF_ALLMULTI)) {
  1763. /* Too many to match, or accept all multicasts. */
  1764. memset(mc_filter, 0xff, sizeof(mc_filter));
  1765. rx_mode = AB | AM;
  1766. } else {
  1767. struct dev_mc_list *mclist;
  1768. int i;
  1770. memset(mc_filter, 0, sizeof(mc_filter));
  1771. for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
  1772.      i++, mclist = mclist->next) {
  1773. set_bit((ether_crc(ETH_ALEN, mclist->dmi_addr) >> 26) ^ 0x3F,
  1774. mc_filter);
  1775. }
  1776. rx_mode = AB | AM;
  1777. }
  1779. stop_nic_tx(ioaddr, np->crvalue);
  1780. stop_nic_rx(ioaddr, np->crvalue & (~0x40000));
  1782. writel(mc_filter[0], ioaddr + MAR0);
  1783. writel(mc_filter[1], ioaddr + MAR1);
  1784. np->crvalue &= ~RxModeMask;
  1785. np->crvalue |= rx_mode;
  1786. writel(np->crvalue, ioaddr + TCRRCR);
  1787. }
  1789. static int netdev_ethtool_ioctl (struct net_device *dev, void *useraddr)
  1790. {
  1791. struct netdev_private *np = dev->priv;
  1792. u32 ethcmd;
  1794. if (copy_from_user (&ethcmd, useraddr, sizeof (ethcmd)))
  1795. return -EFAULT;
  1797. switch (ethcmd) {
  1798. case ETHTOOL_GDRVINFO: {
  1799. struct ethtool_drvinfo info = { ETHTOOL_GDRVINFO };
  1800. strcpy (info.driver, DRV_NAME);
  1801. strcpy (info.version, DRV_VERSION);
  1802. strcpy (info.bus_info, np->pci_dev->slot_name);
  1803. if (copy_to_user (useraddr, &info, sizeof (info)))
  1804. return -EFAULT;
  1805. return 0;
  1806. }
  1808. /* get settings */
  1809. case ETHTOOL_GSET: {
  1810. struct ethtool_cmd ecmd = { ETHTOOL_GSET };
  1811. spin_lock_irq(&np->lock);
  1812. mii_ethtool_gset(&np->mii, &ecmd);
  1813. spin_unlock_irq(&np->lock);
  1814. if (copy_to_user(useraddr, &ecmd, sizeof(ecmd)))
  1815. return -EFAULT;
  1816. return 0;
  1817. }
  1818. /* set settings */
  1819. case ETHTOOL_SSET: {
  1820. int r;
  1821. struct ethtool_cmd ecmd;
  1822. if (copy_from_user(&ecmd, useraddr, sizeof(ecmd)))
  1823. return -EFAULT;
  1824. spin_lock_irq(&np->lock);
  1825. r = mii_ethtool_sset(&np->mii, &ecmd);
  1826. spin_unlock_irq(&np->lock);
  1827. return r;
  1828. }
  1829. /* restart autonegotiation */
  1830. case ETHTOOL_NWAY_RST: {
  1831. return mii_nway_restart(&np->mii);
  1832. }
  1833. /* get link status */
  1834. case ETHTOOL_GLINK: {
  1835. struct ethtool_value edata = {ETHTOOL_GLINK};
  1836. edata.data = mii_link_ok(&np->mii);
  1837. if (copy_to_user(useraddr, &edata, sizeof(edata)))
  1838. return -EFAULT;
  1839. return 0;
  1840. }
  1842. /* get message-level */
  1843. case ETHTOOL_GMSGLVL: {
  1844. struct ethtool_value edata = {ETHTOOL_GMSGLVL};
  1845. edata.data = debug;
  1846. if (copy_to_user(useraddr, &edata, sizeof(edata)))
  1847. return -EFAULT;
  1848. return 0;
  1849. }
  1850. /* set message-level */
  1851. case ETHTOOL_SMSGLVL: {
  1852. struct ethtool_value edata;
  1853. if (copy_from_user(&edata, useraddr, sizeof(edata)))
  1854. return -EFAULT;
  1855. debug = edata.data;
  1856. return 0;
  1857. }
  1858. default:
  1859. break;
  1860. }
  1862. return -EOPNOTSUPP;
  1863. }
  1866. static int mii_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
  1867. {
  1868. struct mii_ioctl_data *data = (struct mii_ioctl_data *) & rq->ifr_data;
  1870. switch (cmd) {
  1871. case SIOCETHTOOL:
  1872. return netdev_ethtool_ioctl(dev, (void *) rq->ifr_data);
  1874. case SIOCGMIIPHY: /* Get address of MII PHY in use. */
  1875. case SIOCDEVPRIVATE: /* for binary compat, remove in 2.5 */
  1876. data->phy_id = ((struct netdev_private *) dev->priv)->phys[0] & 0x1f;
  1877. /* Fall Through */
  1879. case SIOCGMIIREG: /* Read MII PHY register. */
  1880. case SIOCDEVPRIVATE+1: /* for binary compat, remove in 2.5 */
  1881. data->val_out = mdio_read(dev, data->phy_id & 0x1f, data->reg_num & 0x1f);
  1882. return 0;
  1884. case SIOCSMIIREG: /* Write MII PHY register. */
  1885. case SIOCDEVPRIVATE+2: /* for binary compat, remove in 2.5 */
  1886. if (!capable(CAP_NET_ADMIN))
  1887. return -EPERM;
  1888. mdio_write(dev, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in);
  1889. return 0;
  1890. default:
  1891. return -EOPNOTSUPP;
  1892. }
  1893. }
  1896. static int netdev_close(struct net_device *dev)
  1897. {
  1898. long ioaddr = dev->base_addr;
  1899. struct netdev_private *np = dev->priv;
  1900. int i;
  1902. netif_stop_queue(dev);
  1904. /* Disable interrupts by clearing the interrupt mask. */
  1905. writel(0x0000, ioaddr + IMR);
  1907. /* Stop the chip's Tx and Rx processes. */
  1908. stop_nic_tx(ioaddr, 0);
  1909. stop_nic_rx(ioaddr, 0);
  1911. del_timer_sync(&np->timer);
  1913. free_irq(dev->irq, dev);
  1915. /* Free all the skbuffs in the Rx queue. */
  1916. for (i = 0; i < RX_RING_SIZE; i++) {
  1917. struct sk_buff *skb = np->rx_ring[i].skbuff;
  1919. np->rx_ring[i].status = 0;
  1920. if (skb) {
  1921. pci_unmap_single(np->pci_dev, np->rx_ring[i].buffer,
  1922. np->rx_buf_sz, PCI_DMA_FROMDEVICE);
  1923. dev_kfree_skb(skb);
  1924. np->rx_ring[i].skbuff = NULL;
  1925. }
  1926. }
  1928. for (i = 0; i < TX_RING_SIZE; i++) {
  1929. struct sk_buff *skb = np->tx_ring[i].skbuff;
  1931. if (skb) {
  1932. pci_unmap_single(np->pci_dev, np->tx_ring[i].buffer,
  1933. skb->len, PCI_DMA_TODEVICE);
  1934. dev_kfree_skb(skb);
  1935. np->tx_ring[i].skbuff = NULL;
  1936. }
  1937. }
  1939. return 0;
  1940. }
  1942. static struct pci_device_id fealnx_pci_tbl[] __devinitdata = {
  1943. {0x1516, 0x0800, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1944. {0x1516, 0x0803, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1},
  1945. {0x1516, 0x0891, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2},
  1946. {} /* terminate list */
  1947. };
  1948. MODULE_DEVICE_TABLE(pci, fealnx_pci_tbl);
  1951. static struct pci_driver fealnx_driver = {
  1952. name: "fealnx",
  1953. id_table: fealnx_pci_tbl,
  1954. probe: fealnx_init_one,
  1955. remove: __devexit_p(fealnx_remove_one),
  1956. };
  1958. static int __init fealnx_init(void)
  1959. {
  1960. /* when a module, this is printed whether or not devices are found in probe */
  1961. #ifdef MODULE
  1962. printk (version);
  1963. #endif
  1965. return pci_module_init(&fealnx_driver);
  1966. }
  1968. static void __exit fealnx_exit(void)
  1969. {
  1970. pci_unregister_driver(&fealnx_driver);
  1971. }
  1973. module_init(fealnx_init);
  1974. module_exit(fealnx_exit);