sundance.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:46k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /* sundance.c: A Linux device driver for the Sundance ST201 "Alta". */
  2. /*
  3. Written 1999-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.
  10. The author may be reached as becker@scyld.com, or C/O
  11. Scyld Computing Corporation
  12. 410 Severn Ave., Suite 210
  13. Annapolis MD 21403
  14. Support and updates available at
  15. http://www.scyld.com/network/sundance.html
  16. Version 1.01a (jgarzik):
  17. - Replace some MII-related magic numbers with constants
  18. Version 1.01b (D-Link):
  19. - Add new board to PCI ID list
  20. */
  21. #define DRV_NAME "sundance"
  22. #define DRV_VERSION "1.01b"
  23. #define DRV_RELDATE "17-Jan-2002"
  24. /* The user-configurable values.
  25.    These may be modified when a driver module is loaded.*/
  26. static int debug = 1; /* 1 normal messages, 0 quiet .. 7 verbose. */
  27. /* Maximum events (Rx packets, etc.) to handle at each interrupt. */
  28. static int max_interrupt_work = 30;
  29. static int mtu;
  30. /* Maximum number of multicast addresses to filter (vs. rx-all-multicast).
  31.    Typical is a 64 element hash table based on the Ethernet CRC.  */
  32. static int multicast_filter_limit = 32;
  33. /* Set the copy breakpoint for the copy-only-tiny-frames scheme.
  34.    Setting to > 1518 effectively disables this feature.
  35.    This chip can receive into offset buffers, so the Alpha does not
  36.    need a copy-align. */
  37. static int rx_copybreak;
  38. /* media[] specifies the media type the NIC operates at.
  39.  autosense Autosensing active media.
  40.  10mbps_hd  10Mbps half duplex.
  41.  10mbps_fd  10Mbps full duplex.
  42.  100mbps_hd  100Mbps half duplex.
  43.  100mbps_fd  100Mbps full duplex.
  44.  0 Autosensing active media.
  45.  1   10Mbps half duplex.
  46.  2   10Mbps full duplex.
  47.  3   100Mbps half duplex.
  48.  4   100Mbps full duplex.
  49. */
  50. #define MAX_UNITS 8
  51. static char *media[MAX_UNITS];
  52. /* Operational parameters that are set at compile time. */
  53. /* Keep the ring sizes a power of two for compile efficiency.
  54.    The compiler will convert <unsigned>'%'<2^N> into a bit mask.
  55.    Making the Tx ring too large decreases the effectiveness of channel
  56.    bonding and packet priority, and more than 128 requires modifying the
  57.    Tx error recovery.
  58.    Large receive rings merely waste memory. */
  59. #define TX_RING_SIZE 16
  60. #define TX_QUEUE_LEN 10 /* Limit ring entries actually used.  */
  61. #define RX_RING_SIZE 32
  62. #define TX_TOTAL_SIZE TX_RING_SIZE*sizeof(struct netdev_desc)
  63. #define RX_TOTAL_SIZE RX_RING_SIZE*sizeof(struct netdev_desc)
  64. /* Operational parameters that usually are not changed. */
  65. /* Time in jiffies before concluding the transmitter is hung. */
  66. #define TX_TIMEOUT  (4*HZ)
  67. #define PKT_BUF_SZ 1536 /* Size of each temporary Rx buffer.*/
  68. #ifndef __KERNEL__
  69. #define __KERNEL__
  70. #endif
  71. #if !defined(__OPTIMIZE__)
  72. #warning  You must compile this file with the correct options!
  73. #warning  See the last lines of the source file.
  74. #error You must compile this driver with "-O".
  75. #endif
  76. /* Include files, designed to support most kernel versions 2.0.0 and later. */
  77. #include <linux/module.h>
  78. #include <linux/kernel.h>
  79. #include <linux/string.h>
  80. #include <linux/timer.h>
  81. #include <linux/errno.h>
  82. #include <linux/ioport.h>
  83. #include <linux/slab.h>
  84. #include <linux/interrupt.h>
  85. #include <linux/pci.h>
  86. #include <linux/netdevice.h>
  87. #include <linux/etherdevice.h>
  88. #include <linux/skbuff.h>
  89. #include <linux/init.h>
  90. #include <linux/ethtool.h>
  91. #include <linux/mii.h>
  92. #include <asm/uaccess.h>
  93. #include <asm/processor.h> /* Processor type for cache alignment. */
  94. #include <asm/bitops.h>
  95. #include <asm/io.h>
  96. #include <linux/delay.h>
  97. #include <linux/spinlock.h>
  98. /* These identify the driver base version and may not be removed. */
  99. static char version[] __devinitdata =
  100. KERN_INFO DRV_NAME ".c:v" DRV_VERSION " " DRV_RELDATE "  Written by Donald Beckern"
  101. KERN_INFO "  http://www.scyld.com/network/sundance.htmln";
  102. MODULE_AUTHOR("Donald Becker <becker@scyld.com>");
  103. MODULE_DESCRIPTION("Sundance Alta Ethernet driver");
  104. MODULE_LICENSE("GPL");
  105. MODULE_PARM(max_interrupt_work, "i");
  106. MODULE_PARM(mtu, "i");
  107. MODULE_PARM(debug, "i");
  108. MODULE_PARM(rx_copybreak, "i");
  109. MODULE_PARM(media, "1-" __MODULE_STRING(MAX_UNITS) "s");
  110. MODULE_PARM_DESC(max_interrupt_work, "Sundance Alta maximum events handled per interrupt");
  111. MODULE_PARM_DESC(mtu, "Sundance Alta MTU (all boards)");
  112. MODULE_PARM_DESC(debug, "Sundance Alta debug level (0-5)");
  113. MODULE_PARM_DESC(rx_copybreak, "Sundance Alta copy breakpoint for copy-only-tiny-frames");
  114. /*
  115. Theory of Operation
  116. I. Board Compatibility
  117. This driver is designed for the Sundance Technologies "Alta" ST201 chip.
  118. II. Board-specific settings
  119. III. Driver operation
  120. IIIa. Ring buffers
  121. This driver uses two statically allocated fixed-size descriptor lists
  122. formed into rings by a branch from the final descriptor to the beginning of
  123. the list.  The ring sizes are set at compile time by RX/TX_RING_SIZE.
  124. Some chips explicitly use only 2^N sized rings, while others use a
  125. 'next descriptor' pointer that the driver forms into rings.
  126. IIIb/c. Transmit/Receive Structure
  127. This driver uses a zero-copy receive and transmit scheme.
  128. The driver allocates full frame size skbuffs for the Rx ring buffers at
  129. open() time and passes the skb->data field to the chip as receive data
  130. buffers.  When an incoming frame is less than RX_COPYBREAK bytes long,
  131. a fresh skbuff is allocated and the frame is copied to the new skbuff.
  132. When the incoming frame is larger, the skbuff is passed directly up the
  133. protocol stack.  Buffers consumed this way are replaced by newly allocated
  134. skbuffs in a later phase of receives.
  135. The RX_COPYBREAK value is chosen to trade-off the memory wasted by
  136. using a full-sized skbuff for small frames vs. the copying costs of larger
  137. frames.  New boards are typically used in generously configured machines
  138. and the underfilled buffers have negligible impact compared to the benefit of
  139. a single allocation size, so the default value of zero results in never
  140. copying packets.  When copying is done, the cost is usually mitigated by using
  141. a combined copy/checksum routine.  Copying also preloads the cache, which is
  142. most useful with small frames.
  143. A subtle aspect of the operation is that the IP header at offset 14 in an
  144. ethernet frame isn't longword aligned for further processing.
  145. Unaligned buffers are permitted by the Sundance hardware, so
  146. frames are received into the skbuff at an offset of "+2", 16-byte aligning
  147. the IP header.
  148. IIId. Synchronization
  149. The driver runs as two independent, single-threaded flows of control.  One
  150. is the send-packet routine, which enforces single-threaded use by the
  151. dev->tbusy flag.  The other thread is the interrupt handler, which is single
  152. threaded by the hardware and interrupt handling software.
  153. The send packet thread has partial control over the Tx ring and 'dev->tbusy'
  154. flag.  It sets the tbusy flag whenever it's queuing a Tx packet. If the next
  155. queue slot is empty, it clears the tbusy flag when finished otherwise it sets
  156. the 'lp->tx_full' flag.
  157. The interrupt handler has exclusive control over the Rx ring and records stats
  158. from the Tx ring.  After reaping the stats, it marks the Tx queue entry as
  159. empty by incrementing the dirty_tx mark. Iff the 'lp->tx_full' flag is set, it
  160. clears both the tx_full and tbusy flags.
  161. IV. Notes
  162. IVb. References
  163. The Sundance ST201 datasheet, preliminary version.
  164. http://cesdis.gsfc.nasa.gov/linux/misc/100mbps.html
  165. http://cesdis.gsfc.nasa.gov/linux/misc/NWay.html
  166. IVc. Errata
  167. */
  168. enum pci_id_flags_bits {
  169.         /* Set PCI command register bits before calling probe1(). */
  170.         PCI_USES_IO=1, PCI_USES_MEM=2, PCI_USES_MASTER=4,
  171.         /* Read and map the single following PCI BAR. */
  172.         PCI_ADDR0=0<<4, PCI_ADDR1=1<<4, PCI_ADDR2=2<<4, PCI_ADDR3=3<<4,
  173.         PCI_ADDR_64BITS=0x100, PCI_NO_ACPI_WAKE=0x200, PCI_NO_MIN_LATENCY=0x400,
  174. };
  175. enum chip_capability_flags {CanHaveMII=1, };
  176. #ifdef USE_IO_OPS
  177. #define PCI_IOTYPE (PCI_USES_MASTER | PCI_USES_IO  | PCI_ADDR0)
  178. #else
  179. #define PCI_IOTYPE (PCI_USES_MASTER | PCI_USES_MEM | PCI_ADDR1)
  180. #endif
  181. static struct pci_device_id sundance_pci_tbl[] __devinitdata = {
  182. {0x1186, 0x1002, 0x1186, 0x1002, 0, 0, 0},
  183. {0x1186, 0x1002, 0x1186, 0x1003, 0, 0, 1},
  184. {0x1186, 0x1002, 0x1186, 0x1012, 0, 0, 2},
  185. {0x1186, 0x1002, 0x1186, 0x1040, 0, 0, 3},
  186. {0x1186, 0x1002, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 4},
  187. {0x13F0, 0x0201, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 5},
  188. {0,}
  189. };
  190. MODULE_DEVICE_TABLE(pci, sundance_pci_tbl);
  191. struct pci_id_info {
  192.         const char *name;
  193.         struct match_info {
  194.                 int     pci, pci_mask, subsystem, subsystem_mask;
  195.                 int revision, revision_mask;                            /* Only 8 bits. */
  196.         } id;
  197.         enum pci_id_flags_bits pci_flags;
  198.         int io_size;                            /* Needed for I/O region check or ioremap(). */
  199.         int drv_flags;                          /* Driver use, intended as capability flags. */
  200. };
  201. static struct pci_id_info pci_id_tbl[] = {
  202. {"D-Link DFE-550TX FAST Ethernet Adapter", {0x10021186, 0xffffffff,},
  203.  PCI_IOTYPE, 128, CanHaveMII},
  204. {"D-Link DFE-550FX 100Mbps Fiber-optics Adapter",
  205.  {0x10031186, 0xffffffff,},
  206.  PCI_IOTYPE, 128, CanHaveMII},
  207. {"D-Link DFE-580TX 4 port Server Adapter", {0x10121186, 0xffffffff,},
  208.  PCI_IOTYPE, 128, CanHaveMII},
  209. {"D-Link DFE-530TXS FAST Ethernet Adapter", {0x10021186, 0xffffffff,},
  210.  PCI_IOTYPE, 128, CanHaveMII},
  211. {"D-Link DL10050-based FAST Ethernet Adapter",
  212.  {0x10021186, 0xffffffff,},
  213.  PCI_IOTYPE, 128, CanHaveMII},
  214. {"Sundance Technology Alta", {0x020113F0, 0xffffffff,},
  215.  PCI_IOTYPE, 128, CanHaveMII},
  216. {0,}, /* 0 terminated list. */
  217. };
  218. /* This driver was written to use PCI memory space, however x86-oriented
  219.    hardware often uses I/O space accesses. */
  220. #ifdef USE_IO_OPS
  221. #undef readb
  222. #undef readw
  223. #undef readl
  224. #undef writeb
  225. #undef writew
  226. #undef writel
  227. #define readb inb
  228. #define readw inw
  229. #define readl inl
  230. #define writeb outb
  231. #define writew outw
  232. #define writel outl
  233. #endif
  234. /* Offsets to the device registers.
  235.    Unlike software-only systems, device drivers interact with complex hardware.
  236.    It's not useful to define symbolic names for every register bit in the
  237.    device.  The name can only partially document the semantics and make
  238.    the driver longer and more difficult to read.
  239.    In general, only the important configuration values or bits changed
  240.    multiple times should be defined symbolically.
  241. */
  242. enum alta_offsets {
  243. DMACtrl = 0x00,
  244. TxListPtr = 0x04,
  245. TxDMACtrl = 0x08,
  246. TxDescPoll = 0x0a,
  247. RxDMAStatus = 0x0c,
  248. RxListPtr = 0x10,
  249. RxDMACtrl = 0x14,
  250. RxDescPoll = 0x16,
  251. LEDCtrl = 0x1a,
  252. ASICCtrl = 0x30,
  253. EEData = 0x34,
  254. EECtrl = 0x36,
  255. TxThreshold = 0x3c,
  256. FlashAddr = 0x40,
  257. FlashData = 0x44,
  258. TxStatus = 0x46,
  259. DownCounter = 0x18,
  260. IntrClear = 0x4a,
  261. IntrEnable = 0x4c,
  262. IntrStatus = 0x4e,
  263. MACCtrl0 = 0x50,
  264. MACCtrl1 = 0x52,
  265. StationAddr = 0x54,
  266. MaxTxSize = 0x5A,
  267. RxMode = 0x5c,
  268. MIICtrl = 0x5e,
  269. MulticastFilter0 = 0x60,
  270. MulticastFilter1 = 0x64,
  271. RxOctetsLow = 0x68,
  272. RxOctetsHigh = 0x6a,
  273. TxOctetsLow = 0x6c,
  274. TxOctetsHigh = 0x6e,
  275. TxFramesOK = 0x70,
  276. RxFramesOK = 0x72,
  277. StatsCarrierError = 0x74,
  278. StatsLateColl = 0x75,
  279. StatsMultiColl = 0x76,
  280. StatsOneColl = 0x77,
  281. StatsTxDefer = 0x78,
  282. RxMissed = 0x79,
  283. StatsTxXSDefer = 0x7a,
  284. StatsTxAbort = 0x7b,
  285. StatsBcastTx = 0x7c,
  286. StatsBcastRx = 0x7d,
  287. StatsMcastTx = 0x7e,
  288. StatsMcastRx = 0x7f,
  289. /* Aliased and bogus values! */
  290. RxStatus = 0x0c,
  291. };
  292. /* Bits in the interrupt status/mask registers. */
  293. enum intr_status_bits {
  294. IntrSummary=0x0001, IntrPCIErr=0x0002, IntrMACCtrl=0x0008,
  295. IntrTxDone=0x0004, IntrRxDone=0x0010, IntrRxStart=0x0020,
  296. IntrDrvRqst=0x0040,
  297. StatsMax=0x0080, LinkChange=0x0100,
  298. IntrTxDMADone=0x0200, IntrRxDMADone=0x0400,
  299. };
  300. /* Bits in the RxMode register. */
  301. enum rx_mode_bits {
  302. AcceptAllIPMulti=0x20, AcceptMultiHash=0x10, AcceptAll=0x08,
  303. AcceptBroadcast=0x04, AcceptMulticast=0x02, AcceptMyPhys=0x01,
  304. };
  305. /* Bits in MACCtrl. */
  306. enum mac_ctrl0_bits {
  307. EnbFullDuplex=0x20, EnbRcvLargeFrame=0x40,
  308. EnbFlowCtrl=0x100, EnbPassRxCRC=0x200,
  309. };
  310. enum mac_ctrl1_bits {
  311. StatsEnable=0x0020, StatsDisable=0x0040, StatsEnabled=0x0080,
  312. TxEnable=0x0100, TxDisable=0x0200, TxEnabled=0x0400,
  313. RxEnable=0x0800, RxDisable=0x1000, RxEnabled=0x2000,
  314. };
  315. /* The Rx and Tx buffer descriptors. */
  316. /* Note that using only 32 bit fields simplifies conversion to big-endian
  317.    architectures. */
  318. struct netdev_desc {
  319. u32 next_desc;
  320. u32 status;
  321. struct desc_frag { u32 addr, length; } frag[1];
  322. };
  323. /* Bits in netdev_desc.status */
  324. enum desc_status_bits {
  325. DescOwn=0x8000,
  326. DescEndPacket=0x4000,
  327. DescEndRing=0x2000,
  328. LastFrag=0x80000000,
  329. DescIntrOnTx=0x8000,
  330. DescIntrOnDMADone=0x80000000,
  331. DisableAlign = 0x00000001,
  332. };
  333. #define PRIV_ALIGN 15  /* Required alignment mask */
  334. /* Use  __attribute__((aligned (L1_CACHE_BYTES)))  to maintain alignment
  335.    within the structure. */
  336. #define MII_CNT 4
  337. struct netdev_private {
  338. /* Descriptor rings first for alignment. */
  339. struct netdev_desc *rx_ring;
  340. struct netdev_desc *tx_ring;
  341. struct sk_buff* rx_skbuff[RX_RING_SIZE];
  342. struct sk_buff* tx_skbuff[TX_RING_SIZE];
  343.         dma_addr_t tx_ring_dma;
  344.         dma_addr_t rx_ring_dma;
  345. struct net_device_stats stats;
  346. struct timer_list timer; /* Media monitoring timer. */
  347. /* Frequently used values: keep some adjacent for cache effect. */
  348. spinlock_t lock;
  349. int chip_id, drv_flags;
  350. unsigned int cur_rx, dirty_rx; /* Producer/consumer ring indices */
  351. unsigned int rx_buf_sz; /* Based on MTU+slack. */
  352. spinlock_t txlock; /* Group with Tx control cache line. */
  353. struct netdev_desc *last_tx; /* Last Tx descriptor used. */
  354. unsigned int cur_tx, dirty_tx;
  355. unsigned int tx_full:1; /* The Tx queue is full. */
  356. /* These values are keep track of the transceiver/media in use. */
  357. unsigned int full_duplex:1; /* Full-duplex operation requested. */
  358. unsigned int medialock:1; /* Do not sense media. */
  359. unsigned int default_port:4; /* Last dev->if_port value. */
  360. unsigned int an_enable:1;
  361. unsigned int speed;
  362. /* Multicast and receive mode. */
  363. spinlock_t mcastlock; /* SMP lock multicast updates. */
  364. u16 mcast_filter[4];
  365. /* MII transceiver section. */
  366. int mii_cnt; /* MII device addresses. */
  367. u16 advertising; /* NWay media advertisement */
  368. unsigned char phys[MII_CNT]; /* MII device addresses, only first one used. */
  369. struct pci_dev *pci_dev;
  370. };
  371. /* The station address location in the EEPROM. */
  372. #define EEPROM_SA_OFFSET 0x10
  373. static int  eeprom_read(long ioaddr, int location);
  374. static int  mdio_read(struct net_device *dev, int phy_id, int location);
  375. static void mdio_write(struct net_device *dev, int phy_id, int location, int value);
  376. static int  netdev_open(struct net_device *dev);
  377. static void check_duplex(struct net_device *dev);
  378. static void netdev_timer(unsigned long data);
  379. static void tx_timeout(struct net_device *dev);
  380. static void init_ring(struct net_device *dev);
  381. static int  start_tx(struct sk_buff *skb, struct net_device *dev);
  382. static void intr_handler(int irq, void *dev_instance, struct pt_regs *regs);
  383. static void netdev_error(struct net_device *dev, int intr_status);
  384. static int  netdev_rx(struct net_device *dev);
  385. static void netdev_error(struct net_device *dev, int intr_status);
  386. static void set_rx_mode(struct net_device *dev);
  387. static struct net_device_stats *get_stats(struct net_device *dev);
  388. static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
  389. static int  netdev_close(struct net_device *dev);
  390. static int __devinit sundance_probe1 (struct pci_dev *pdev,
  391.       const struct pci_device_id *ent)
  392. {
  393. struct net_device *dev;
  394. struct netdev_private *np;
  395. static int card_idx;
  396. int chip_idx = ent->driver_data;
  397. int irq;
  398. int i;
  399. long ioaddr;
  400. u16 mii_ctl;
  401. void *ring_space;
  402. dma_addr_t ring_dma;
  403. /* when built into the kernel, we only print version if device is found */
  404. #ifndef MODULE
  405. static int printed_version;
  406. if (!printed_version++)
  407. printk(version);
  408. #endif
  409. if (pci_enable_device(pdev))
  410. return -EIO;
  411. pci_set_master(pdev);
  412. irq = pdev->irq;
  413. dev = alloc_etherdev(sizeof(*np));
  414. if (!dev)
  415. return -ENOMEM;
  416. SET_MODULE_OWNER(dev);
  417. if (pci_request_regions(pdev, DRV_NAME))
  418. goto err_out_netdev;
  419. #ifdef USE_IO_OPS
  420. ioaddr = pci_resource_start(pdev, 0);
  421. #else
  422. ioaddr = pci_resource_start(pdev, 1);
  423. ioaddr = (long) ioremap (ioaddr, pci_id_tbl[chip_idx].io_size);
  424. if (!ioaddr)
  425. goto err_out_res;
  426. #endif
  427. for (i = 0; i < 3; i++)
  428. ((u16 *)dev->dev_addr)[i] =
  429. le16_to_cpu(eeprom_read(ioaddr, i + EEPROM_SA_OFFSET));
  430. dev->base_addr = ioaddr;
  431. dev->irq = irq;
  432. np = dev->priv;
  433. np->chip_id = chip_idx;
  434. np->drv_flags = pci_id_tbl[chip_idx].drv_flags;
  435. np->pci_dev = pdev;
  436. spin_lock_init(&np->lock);
  437. ring_space = pci_alloc_consistent(pdev, TX_TOTAL_SIZE, &ring_dma);
  438. if (!ring_space)
  439. goto err_out_cleardev;
  440. np->tx_ring = (struct netdev_desc *)ring_space;
  441. np->tx_ring_dma = ring_dma;
  442. ring_space = pci_alloc_consistent(pdev, RX_TOTAL_SIZE, &ring_dma);
  443. if (!ring_space)
  444. goto err_out_unmap_tx;
  445. np->rx_ring = (struct netdev_desc *)ring_space;
  446. np->rx_ring_dma = ring_dma;
  447. /* The chip-specific entries in the device structure. */
  448. dev->open = &netdev_open;
  449. dev->hard_start_xmit = &start_tx;
  450. dev->stop = &netdev_close;
  451. dev->get_stats = &get_stats;
  452. dev->set_multicast_list = &set_rx_mode;
  453. dev->do_ioctl = &netdev_ioctl;
  454. dev->tx_timeout = &tx_timeout;
  455. dev->watchdog_timeo = TX_TIMEOUT;
  456. pci_set_drvdata(pdev, dev);
  457. if (mtu)
  458. dev->mtu = mtu;
  459. i = register_netdev(dev);
  460. if (i)
  461. goto err_out_unmap_rx;
  462. printk(KERN_INFO "%s: %s at 0x%lx, ",
  463.    dev->name, pci_id_tbl[chip_idx].name, ioaddr);
  464. for (i = 0; i < 5; i++)
  465. printk("%2.2x:", dev->dev_addr[i]);
  466. printk("%2.2x, IRQ %d.n", dev->dev_addr[i], irq);
  467. if (1) {
  468. int phy, phy_idx = 0;
  469. np->phys[0] = 1; /* Default setting */
  470. for (phy = 0; phy < 32 && phy_idx < MII_CNT; phy++) {
  471. int mii_status = mdio_read(dev, phy, 1);
  472. if (mii_status != 0xffff  &&  mii_status != 0x0000) {
  473. np->phys[phy_idx++] = phy;
  474. np->advertising = mdio_read(dev, phy, 4);
  475. printk(KERN_INFO "%s: MII PHY found at address %d, status "
  476.    "0x%4.4x advertising %4.4x.n",
  477.    dev->name, phy, mii_status, np->advertising);
  478. }
  479. }
  480. np->mii_cnt = phy_idx;
  481. if (phy_idx == 0)
  482. printk(KERN_INFO "%s: No MII transceiver found!, ASIC status %xn",
  483.    dev->name, readl(ioaddr + ASICCtrl));
  484. }
  485. /* Parse override configuration */
  486. np->an_enable = 1;
  487. if (card_idx < MAX_UNITS) {
  488. if (media[card_idx] != NULL) {
  489. np->an_enable = 0;
  490. if (strcmp (media[card_idx], "100mbps_fd") == 0 ||
  491.     strcmp (media[card_idx], "4") == 0) {
  492. np->speed = 100;
  493. np->full_duplex = 1;
  494. } else if (strcmp (media[card_idx], "100mbps_hd") == 0
  495.    || strcmp (media[card_idx], "3") == 0) {
  496. np->speed = 100;
  497. np->full_duplex = 0;
  498. } else if (strcmp (media[card_idx], "10mbps_fd") == 0 ||
  499.    strcmp (media[card_idx], "2") == 0) {
  500. np->speed = 10;
  501. np->full_duplex = 1;
  502. } else if (strcmp (media[card_idx], "10mbps_hd") == 0 ||
  503.    strcmp (media[card_idx], "1") == 0) {
  504. np->speed = 10;
  505. np->full_duplex = 0;
  506. } else {
  507. np->an_enable = 1;
  508. }
  509. }
  510. }
  511. /* Fibre PHY? */
  512. if (readl (ioaddr + ASICCtrl) & 0x80) {
  513. /* Default 100Mbps Full */
  514. if (np->an_enable) {
  515. np->speed = 100;
  516. np->full_duplex = 1;
  517. np->an_enable = 0;
  518. }
  519. }
  520. /* Reset PHY */
  521. mdio_write (dev, np->phys[0], MII_BMCR, BMCR_RESET);
  522. mdelay (300);
  523. mdio_write (dev, np->phys[0], MII_BMCR, BMCR_ANENABLE|BMCR_ANRESTART);
  524. /* Force media type */
  525. if (!np->an_enable) {
  526. mii_ctl = 0;
  527. mii_ctl |= (np->speed == 100) ? BMCR_SPEED100 : 0;
  528. mii_ctl |= (np->full_duplex) ? BMCR_FULLDPLX : 0;
  529. mdio_write (dev, np->phys[0], MII_BMCR, mii_ctl);
  530. printk (KERN_INFO "Override speed=%d, %s duplexn",
  531. np->speed, np->full_duplex ? "Full" : "Half");
  532. }
  533. /* Perhaps move the reset here? */
  534. /* Reset the chip to erase previous misconfiguration. */
  535. if (debug > 1)
  536. printk("ASIC Control is %x.n", readl(ioaddr + ASICCtrl));
  537. writew(0x007f, ioaddr + ASICCtrl + 2);
  538. if (debug > 1)
  539. printk("ASIC Control is now %x.n", readl(ioaddr + ASICCtrl));
  540. card_idx++;
  541. return 0;
  542. err_out_unmap_rx:
  543.         pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, np->rx_ring_dma);
  544. err_out_unmap_tx:
  545.         pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, np->tx_ring_dma);
  546. err_out_cleardev:
  547. pci_set_drvdata(pdev, NULL);
  548. #ifndef USE_IO_OPS
  549. iounmap((void *)ioaddr);
  550. err_out_res:
  551. #endif
  552. pci_release_regions(pdev);
  553. err_out_netdev:
  554. kfree (dev);
  555. return -ENODEV;
  556. }
  557. /* Read the EEPROM and MII Management Data I/O (MDIO) interfaces. */
  558. static int eeprom_read(long ioaddr, int location)
  559. {
  560. int boguscnt = 1000; /* Typical 190 ticks. */
  561. writew(0x0200 | (location & 0xff), ioaddr + EECtrl);
  562. do {
  563. if (! (readw(ioaddr + EECtrl) & 0x8000)) {
  564. return readw(ioaddr + EEData);
  565. }
  566. } while (--boguscnt > 0);
  567. return 0;
  568. }
  569. /*  MII transceiver control section.
  570. Read and write the MII registers using software-generated serial
  571. MDIO protocol.  See the MII specifications or DP83840A data sheet
  572. for details.
  573. The maximum data clock rate is 2.5 Mhz.  The minimum timing is usually
  574. met by back-to-back 33Mhz PCI cycles. */
  575. #define mdio_delay() readb(mdio_addr)
  576. /* Set iff a MII transceiver on any interface requires mdio preamble.
  577.    This only set with older tranceivers, so the extra
  578.    code size of a per-interface flag is not worthwhile. */
  579. static const char mii_preamble_required = 1;
  580. enum mii_reg_bits {
  581. MDIO_ShiftClk=0x0001, MDIO_Data=0x0002, MDIO_EnbOutput=0x0004,
  582. };
  583. #define MDIO_EnbIn  (0)
  584. #define MDIO_WRITE0 (MDIO_EnbOutput)
  585. #define MDIO_WRITE1 (MDIO_Data | MDIO_EnbOutput)
  586. /* Generate the preamble required for initial synchronization and
  587.    a few older transceivers. */
  588. static void mdio_sync(long mdio_addr)
  589. {
  590. int bits = 32;
  591. /* Establish sync by sending at least 32 logic ones. */
  592. while (--bits >= 0) {
  593. writeb(MDIO_WRITE1, mdio_addr);
  594. mdio_delay();
  595. writeb(MDIO_WRITE1 | MDIO_ShiftClk, mdio_addr);
  596. mdio_delay();
  597. }
  598. }
  599. static int mdio_read(struct net_device *dev, int phy_id, int location)
  600. {
  601. long mdio_addr = dev->base_addr + MIICtrl;
  602. int mii_cmd = (0xf6 << 10) | (phy_id << 5) | location;
  603. int i, retval = 0;
  604. if (mii_preamble_required)
  605. mdio_sync(mdio_addr);
  606. /* Shift the read command bits out. */
  607. for (i = 15; i >= 0; i--) {
  608. int dataval = (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0;
  609. writeb(dataval, mdio_addr);
  610. mdio_delay();
  611. writeb(dataval | MDIO_ShiftClk, mdio_addr);
  612. mdio_delay();
  613. }
  614. /* Read the two transition, 16 data, and wire-idle bits. */
  615. for (i = 19; i > 0; i--) {
  616. writeb(MDIO_EnbIn, mdio_addr);
  617. mdio_delay();
  618. retval = (retval << 1) | ((readb(mdio_addr) & MDIO_Data) ? 1 : 0);
  619. writeb(MDIO_EnbIn | MDIO_ShiftClk, mdio_addr);
  620. mdio_delay();
  621. }
  622. return (retval>>1) & 0xffff;
  623. }
  624. static void mdio_write(struct net_device *dev, int phy_id, int location, int value)
  625. {
  626. long mdio_addr = dev->base_addr + MIICtrl;
  627. int mii_cmd = (0x5002 << 16) | (phy_id << 23) | (location<<18) | value;
  628. int i;
  629. if (mii_preamble_required)
  630. mdio_sync(mdio_addr);
  631. /* Shift the command bits out. */
  632. for (i = 31; i >= 0; i--) {
  633. int dataval = (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0;
  634. writeb(dataval, mdio_addr);
  635. mdio_delay();
  636. writeb(dataval | MDIO_ShiftClk, mdio_addr);
  637. mdio_delay();
  638. }
  639. /* Clear out extra bits. */
  640. for (i = 2; i > 0; i--) {
  641. writeb(MDIO_EnbIn, mdio_addr);
  642. mdio_delay();
  643. writeb(MDIO_EnbIn | MDIO_ShiftClk, mdio_addr);
  644. mdio_delay();
  645. }
  646. return;
  647. }
  648. static int netdev_open(struct net_device *dev)
  649. {
  650. struct netdev_private *np = dev->priv;
  651. long ioaddr = dev->base_addr;
  652. int i;
  653. /* Do we need to reset the chip??? */
  654. i = request_irq(dev->irq, &intr_handler, SA_SHIRQ, dev->name, dev);
  655. if (i)
  656. return i;
  657. if (debug > 1)
  658. printk(KERN_DEBUG "%s: netdev_open() irq %d.n",
  659.    dev->name, dev->irq);
  660. init_ring(dev);
  661. writel(np->rx_ring_dma, ioaddr + RxListPtr);
  662. /* The Tx list pointer is written as packets are queued. */
  663. for (i = 0; i < 6; i++)
  664. writeb(dev->dev_addr[i], ioaddr + StationAddr + i);
  665. /* Initialize other registers. */
  666. /* Configure the PCI bus bursts and FIFO thresholds. */
  667. if (dev->if_port == 0)
  668. dev->if_port = np->default_port;
  669. np->mcastlock = (spinlock_t) SPIN_LOCK_UNLOCKED;
  670. set_rx_mode(dev);
  671. writew(0, ioaddr + IntrEnable);
  672. writew(0, ioaddr + DownCounter);
  673. /* Set the chip to poll every N*320nsec. */
  674. writeb(100, ioaddr + RxDescPoll);
  675. writeb(127, ioaddr + TxDescPoll);
  676. netif_start_queue(dev);
  677. /* Enable interrupts by setting the interrupt mask. */
  678. writew(IntrRxDone | IntrRxDMADone | IntrPCIErr | IntrDrvRqst | IntrTxDone
  679.    | StatsMax | LinkChange, ioaddr + IntrEnable);
  680. writew(StatsEnable | RxEnable | TxEnable, ioaddr + MACCtrl1);
  681. if (debug > 2)
  682. printk(KERN_DEBUG "%s: Done netdev_open(), status: Rx %x Tx %x "
  683.    "MAC Control %x, %4.4x %4.4x.n",
  684.    dev->name, readl(ioaddr + RxStatus), readb(ioaddr + TxStatus),
  685.    readl(ioaddr + MACCtrl0),
  686.    readw(ioaddr + MACCtrl1), readw(ioaddr + MACCtrl0));
  687. /* Set the timer to check for link beat. */
  688. init_timer(&np->timer);
  689. np->timer.expires = jiffies + 3*HZ;
  690. np->timer.data = (unsigned long)dev;
  691. np->timer.function = &netdev_timer; /* timer handler */
  692. add_timer(&np->timer);
  693. return 0;
  694. }
  695. static void check_duplex(struct net_device *dev)
  696. {
  697. struct netdev_private *np = dev->priv;
  698. long ioaddr = dev->base_addr;
  699. int mii_lpa = mdio_read(dev, np->phys[0], MII_LPA);
  700. int negotiated = mii_lpa & np->advertising;
  701. int duplex;
  702. /* Force media */
  703. if (!np->an_enable || mii_lpa == 0xffff) {
  704. if (np->full_duplex)
  705. writew (readw (ioaddr + MACCtrl0) | EnbFullDuplex,
  706. ioaddr + MACCtrl0);
  707. return;
  708. }
  709. /* Autonegotiation */
  710. duplex = (negotiated & 0x0100) || (negotiated & 0x01C0) == 0x0040;
  711. if (np->full_duplex != duplex) {
  712. np->full_duplex = duplex;
  713. if (debug)
  714. printk(KERN_INFO "%s: Setting %s-duplex based on MII #%d "
  715.    "negotiated capability %4.4x.n", dev->name,
  716.    duplex ? "full" : "half", np->phys[0], negotiated);
  717. writew(duplex ? 0x20 : 0, ioaddr + MACCtrl0);
  718. }
  719. }
  720. static void netdev_timer(unsigned long data)
  721. {
  722. struct net_device *dev = (struct net_device *)data;
  723. struct netdev_private *np = dev->priv;
  724. long ioaddr = dev->base_addr;
  725. int next_tick = 10*HZ;
  726. if (debug > 3) {
  727. printk(KERN_DEBUG "%s: Media selection timer tick, intr status %4.4x, "
  728.    "Tx %x Rx %x.n",
  729.    dev->name, readw(ioaddr + IntrEnable),
  730.    readb(ioaddr + TxStatus), readl(ioaddr + RxStatus));
  731. }
  732. check_duplex(dev);
  733. np->timer.expires = jiffies + next_tick;
  734. add_timer(&np->timer);
  735. }
  736. static void tx_timeout(struct net_device *dev)
  737. {
  738. struct netdev_private *np = dev->priv;
  739. long ioaddr = dev->base_addr;
  740. printk(KERN_WARNING "%s: Transmit timed out, status %2.2x,"
  741.    " resetting...n", dev->name, readb(ioaddr + TxStatus));
  742. {
  743. int i;
  744. printk(KERN_DEBUG "  Rx ring %p: ", np->rx_ring);
  745. for (i = 0; i < RX_RING_SIZE; i++)
  746. printk(" %8.8x", (unsigned int)np->rx_ring[i].status);
  747. printk("n"KERN_DEBUG"  Tx ring %p: ", np->tx_ring);
  748. for (i = 0; i < TX_RING_SIZE; i++)
  749. printk(" %4.4x", np->tx_ring[i].status);
  750. printk("n");
  751. }
  752. /* Perhaps we should reinitialize the hardware here. */
  753. dev->if_port = 0;
  754. /* Stop and restart the chip's Tx processes . */
  755. /* Trigger an immediate transmit demand. */
  756. writew(IntrRxDone | IntrRxDMADone | IntrPCIErr | IntrDrvRqst | IntrTxDone
  757.    | StatsMax | LinkChange, ioaddr + IntrEnable);
  758. dev->trans_start = jiffies;
  759. np->stats.tx_errors++;
  760. if (!np->tx_full)
  761. netif_wake_queue(dev);
  762. }
  763. /* Initialize the Rx and Tx rings, along with various 'dev' bits. */
  764. static void init_ring(struct net_device *dev)
  765. {
  766. struct netdev_private *np = dev->priv;
  767. int i;
  768. np->tx_full = 0;
  769. np->cur_rx = np->cur_tx = 0;
  770. np->dirty_rx = np->dirty_tx = 0;
  771. np->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32);
  772. /* Initialize all Rx descriptors. */
  773. for (i = 0; i < RX_RING_SIZE; i++) {
  774. np->rx_ring[i].next_desc = cpu_to_le32(np->rx_ring_dma + 
  775. ((i+1)%RX_RING_SIZE)*sizeof(*np->rx_ring));
  776. np->rx_ring[i].status = 0;
  777. np->rx_ring[i].frag[0].length = 0;
  778. np->rx_skbuff[i] = 0;
  779. }
  780. /* Fill in the Rx buffers.  Handle allocation failure gracefully. */
  781. for (i = 0; i < RX_RING_SIZE; i++) {
  782. struct sk_buff *skb = dev_alloc_skb(np->rx_buf_sz);
  783. np->rx_skbuff[i] = skb;
  784. if (skb == NULL)
  785. break;
  786. skb->dev = dev; /* Mark as being used by this device. */
  787. skb_reserve(skb, 2); /* 16 byte align the IP header. */
  788. np->rx_ring[i].frag[0].addr = cpu_to_le32(
  789. pci_map_single(np->pci_dev, skb->tail, np->rx_buf_sz, 
  790. PCI_DMA_FROMDEVICE));
  791. np->rx_ring[i].frag[0].length = cpu_to_le32(np->rx_buf_sz | LastFrag);
  792. }
  793. np->dirty_rx = (unsigned int)(i - RX_RING_SIZE);
  794. for (i = 0; i < TX_RING_SIZE; i++) {
  795. np->tx_skbuff[i] = 0;
  796. np->tx_ring[i].status = 0;
  797. }
  798. return;
  799. }
  800. static int start_tx(struct sk_buff *skb, struct net_device *dev)
  801. {
  802. struct netdev_private *np = dev->priv;
  803. struct netdev_desc *txdesc;
  804. unsigned entry;
  805. /* Note: Ordering is important here, set the field with the
  806.    "ownership" bit last, and only then increment cur_tx. */
  807. /* Calculate the next Tx descriptor entry. */
  808. entry = np->cur_tx % TX_RING_SIZE;
  809. np->tx_skbuff[entry] = skb;
  810. txdesc = &np->tx_ring[entry];
  811. txdesc->next_desc = 0;
  812. /* Note: disable the interrupt generation here before releasing. */
  813. txdesc->status =
  814. cpu_to_le32((entry<<2) | DescIntrOnDMADone | DescIntrOnTx | DisableAlign);
  815. txdesc->frag[0].addr = cpu_to_le32(pci_map_single(np->pci_dev, 
  816. skb->data, skb->len, PCI_DMA_TODEVICE));
  817. txdesc->frag[0].length = cpu_to_le32(skb->len | LastFrag);
  818. if (np->last_tx)
  819. np->last_tx->next_desc = cpu_to_le32(np->tx_ring_dma +
  820. entry*sizeof(struct netdev_desc));
  821. np->last_tx = txdesc;
  822. np->cur_tx++;
  823. /* On some architectures: explicitly flush cache lines here. */
  824. if (np->cur_tx - np->dirty_tx < TX_QUEUE_LEN - 1) {
  825. /* do nothing */
  826. } else {
  827. np->tx_full = 1;
  828. netif_stop_queue(dev);
  829. }
  830. /* Side effect: The read wakes the potentially-idle transmit channel. */
  831. if (readl(dev->base_addr + TxListPtr) == 0)
  832. writel(np->tx_ring_dma + entry*sizeof(*np->tx_ring),
  833. dev->base_addr + TxListPtr);
  834. dev->trans_start = jiffies;
  835. if (debug > 4) {
  836. printk(KERN_DEBUG "%s: Transmit frame #%d queued in slot %d.n",
  837.    dev->name, np->cur_tx, entry);
  838. }
  839. return 0;
  840. }
  841. /* The interrupt handler does all of the Rx thread work and cleans up
  842.    after the Tx thread. */
  843. static void intr_handler(int irq, void *dev_instance, struct pt_regs *rgs)
  844. {
  845. struct net_device *dev = (struct net_device *)dev_instance;
  846. struct netdev_private *np;
  847. long ioaddr;
  848. int boguscnt = max_interrupt_work;
  849. ioaddr = dev->base_addr;
  850. np = dev->priv;
  851. spin_lock(&np->lock);
  852. do {
  853. int intr_status = readw(ioaddr + IntrStatus);
  854. writew(intr_status & (IntrRxDone | IntrRxDMADone | IntrPCIErr |
  855. IntrDrvRqst | IntrTxDone | IntrTxDMADone | StatsMax | 
  856. LinkChange), ioaddr + IntrStatus);
  857. if (debug > 4)
  858. printk(KERN_DEBUG "%s: Interrupt, status %4.4x.n",
  859.    dev->name, intr_status);
  860. if (intr_status == 0)
  861. break;
  862. if (intr_status & (IntrRxDone|IntrRxDMADone))
  863. netdev_rx(dev);
  864. if (intr_status & IntrTxDone) {
  865. int boguscnt = 32;
  866. int tx_status = readw(ioaddr + TxStatus);
  867. while (tx_status & 0x80) {
  868. if (debug > 4)
  869. printk("%s: Transmit status is %2.2x.n",
  870.    dev->name, tx_status);
  871. if (tx_status & 0x1e) {
  872. np->stats.tx_errors++;
  873. if (tx_status & 0x10)  np->stats.tx_fifo_errors++;
  874. #ifdef ETHER_STATS
  875. if (tx_status & 0x08)  np->stats.collisions16++;
  876. #else
  877. if (tx_status & 0x08)  np->stats.collisions++;
  878. #endif
  879. if (tx_status & 0x04)  np->stats.tx_fifo_errors++;
  880. if (tx_status & 0x02)  np->stats.tx_window_errors++;
  881. /* This reset has not been verified!. */
  882. if (tx_status & 0x10) { /* Reset the Tx. */
  883. writew(0x001c, ioaddr + ASICCtrl + 2);
  884. #if 0 /* Do we need to reset the Tx pointer here? */
  885. writel(np->tx_ring_dma
  886. + np->dirty_tx*sizeof(*np->tx_ring),
  887. dev->base_addr + TxListPtr);
  888. #endif
  889. }
  890. if (tx_status & 0x1e)  /* Restart the Tx. */
  891. writew(TxEnable, ioaddr + MACCtrl1);
  892. }
  893. /* Yup, this is a documentation bug.  It cost me *hours*. */
  894. writew(0, ioaddr + TxStatus);
  895. tx_status = readb(ioaddr + TxStatus);
  896. if (--boguscnt < 0)
  897. break;
  898. }
  899. }
  900. for (; np->cur_tx - np->dirty_tx > 0; np->dirty_tx++) {
  901. int entry = np->dirty_tx % TX_RING_SIZE;
  902. struct sk_buff *skb;
  903. if ( ! (np->tx_ring[entry].status & 0x00010000))
  904. break;
  905. skb = np->tx_skbuff[entry];
  906. /* Free the original skb. */
  907. pci_unmap_single(np->pci_dev, 
  908. np->tx_ring[entry].frag[0].addr, 
  909. skb->len, PCI_DMA_TODEVICE);
  910. dev_kfree_skb_irq(skb);
  911. np->tx_skbuff[entry] = 0;
  912. }
  913. if (np->tx_full
  914. && np->cur_tx - np->dirty_tx < TX_QUEUE_LEN - 4) {
  915. /* The ring is no longer full, clear tbusy. */
  916. np->tx_full = 0;
  917. netif_wake_queue(dev);
  918. }
  919. /* Abnormal error summary/uncommon events handlers. */
  920. if (intr_status & (IntrDrvRqst | IntrPCIErr | LinkChange | StatsMax))
  921. netdev_error(dev, intr_status);
  922. if (--boguscnt < 0) {
  923. get_stats(dev);
  924. if (debug > 1) 
  925. printk(KERN_WARNING "%s: Too much work at interrupt, "
  926.    "status=0x%4.4x / 0x%4.4x.n",
  927.    dev->name, intr_status, readw(ioaddr + IntrClear));
  928. /* Re-enable us in 3.2msec. */
  929. writew(0, ioaddr + IntrEnable);
  930. writew(1000, ioaddr + DownCounter);
  931. writew(IntrDrvRqst, ioaddr + IntrEnable);
  932. break;
  933. }
  934. } while (1);
  935. if (debug > 3)
  936. printk(KERN_DEBUG "%s: exiting interrupt, status=%#4.4x.n",
  937.    dev->name, readw(ioaddr + IntrStatus));
  938. spin_unlock(&np->lock);
  939. }
  940. /* This routine is logically part of the interrupt handler, but separated
  941.    for clarity and better register allocation. */
  942. static int netdev_rx(struct net_device *dev)
  943. {
  944. struct netdev_private *np = dev->priv;
  945. int entry = np->cur_rx % RX_RING_SIZE;
  946. int boguscnt = np->dirty_rx + RX_RING_SIZE - np->cur_rx;
  947. if (debug > 4) {
  948. printk(KERN_DEBUG " In netdev_rx(), entry %d status %4.4x.n",
  949.    entry, np->rx_ring[entry].status);
  950. }
  951. /* If EOP is set on the next entry, it's a new packet. Send it up. */
  952. while (1) {
  953. struct netdev_desc *desc = &(np->rx_ring[entry]);
  954. u32 frame_status;
  955. int pkt_len;
  956. if (!(desc->status & DescOwn))
  957. break;
  958. frame_status = le32_to_cpu(desc->status);
  959. pkt_len = frame_status & 0x1fff; /* Chip omits the CRC. */
  960. if (debug > 4)
  961. printk(KERN_DEBUG "  netdev_rx() status was %8.8x.n",
  962.    frame_status);
  963. if (--boguscnt < 0)
  964. break;
  965. pci_dma_sync_single(np->pci_dev, desc->frag[0].addr,
  966. np->rx_buf_sz, PCI_DMA_FROMDEVICE);
  967. if (frame_status & 0x001f4000) {
  968. /* There was a error. */
  969. if (debug > 2)
  970. printk(KERN_DEBUG "  netdev_rx() Rx error was %8.8x.n",
  971.    frame_status);
  972. np->stats.rx_errors++;
  973. if (frame_status & 0x00100000) np->stats.rx_length_errors++;
  974. if (frame_status & 0x00010000) np->stats.rx_fifo_errors++;
  975. if (frame_status & 0x00060000) np->stats.rx_frame_errors++;
  976. if (frame_status & 0x00080000) np->stats.rx_crc_errors++;
  977. if (frame_status & 0x00100000) {
  978. printk(KERN_WARNING "%s: Oversized Ethernet frame,"
  979.    " status %8.8x.n",
  980.    dev->name, frame_status);
  981. }
  982. } else {
  983. struct sk_buff *skb;
  984. #ifndef final_version
  985. if (debug > 4)
  986. printk(KERN_DEBUG "  netdev_rx() normal Rx pkt length %d"
  987.    ", bogus_cnt %d.n",
  988.    pkt_len, boguscnt);
  989. #endif
  990. /* Check if the packet is long enough to accept without copying
  991.    to a minimally-sized skbuff. */
  992. if (pkt_len < rx_copybreak
  993. && (skb = dev_alloc_skb(pkt_len + 2)) != NULL) {
  994. skb->dev = dev;
  995. skb_reserve(skb, 2); /* 16 byte align the IP header */
  996. eth_copy_and_sum(skb, np->rx_skbuff[entry]->tail, pkt_len, 0);
  997. skb_put(skb, pkt_len);
  998. } else {
  999. pci_unmap_single(np->pci_dev, 
  1000. desc->frag[0].addr,
  1001. np->rx_buf_sz, 
  1002. PCI_DMA_FROMDEVICE);
  1003. skb_put(skb = np->rx_skbuff[entry], pkt_len);
  1004. np->rx_skbuff[entry] = NULL;
  1005. }
  1006. skb->protocol = eth_type_trans(skb, dev);
  1007. /* Note: checksum -> skb->ip_summed = CHECKSUM_UNNECESSARY; */
  1008. netif_rx(skb);
  1009. dev->last_rx = jiffies;
  1010. }
  1011. entry = (++np->cur_rx) % RX_RING_SIZE;
  1012. }
  1013. /* Refill the Rx ring buffers. */
  1014. for (; np->cur_rx - np->dirty_rx > 0; np->dirty_rx++) {
  1015. struct sk_buff *skb;
  1016. entry = np->dirty_rx % RX_RING_SIZE;
  1017. if (np->rx_skbuff[entry] == NULL) {
  1018. skb = dev_alloc_skb(np->rx_buf_sz);
  1019. np->rx_skbuff[entry] = skb;
  1020. if (skb == NULL)
  1021. break; /* Better luck next round. */
  1022. skb->dev = dev; /* Mark as being used by this device. */
  1023. skb_reserve(skb, 2); /* Align IP on 16 byte boundaries */
  1024. np->rx_ring[entry].frag[0].addr = cpu_to_le32(
  1025. pci_map_single(np->pci_dev, skb->tail, 
  1026. np->rx_buf_sz, PCI_DMA_FROMDEVICE));
  1027. }
  1028. /* Perhaps we need not reset this field. */
  1029. np->rx_ring[entry].frag[0].length =
  1030. cpu_to_le32(np->rx_buf_sz | LastFrag);
  1031. np->rx_ring[entry].status = 0;
  1032. }
  1033. /* No need to restart Rx engine, it will poll. */
  1034. return 0;
  1035. }
  1036. static void netdev_error(struct net_device *dev, int intr_status)
  1037. {
  1038. long ioaddr = dev->base_addr;
  1039. struct netdev_private *np = dev->priv;
  1040. u16 mii_ctl, mii_advertise, mii_lpa;
  1041. int speed;
  1042. if (intr_status & IntrDrvRqst) {
  1043. /* Stop the down counter and turn interrupts back on. */
  1044. if (debug > 1)
  1045. printk("%s: Turning interrupts back on.n", dev->name);
  1046. writew(0, ioaddr + IntrEnable);
  1047. writew(0, ioaddr + DownCounter);
  1048. writew(IntrRxDone | IntrRxDMADone | IntrPCIErr | IntrDrvRqst |
  1049.    IntrTxDone | StatsMax | LinkChange, ioaddr + IntrEnable);
  1050. /* Ack buggy InRequest */
  1051. writew (IntrDrvRqst, ioaddr + IntrStatus);
  1052. }
  1053. if (intr_status & LinkChange) {
  1054. if (np->an_enable) {
  1055. mii_advertise = mdio_read (dev, np->phys[0], MII_ADVERTISE);
  1056. mii_lpa= mdio_read (dev, np->phys[0], MII_LPA);
  1057. mii_advertise &= mii_lpa;
  1058. printk (KERN_INFO "%s: Link changed: ", dev->name);
  1059. if (mii_advertise & ADVERTISE_100FULL)
  1060. printk ("100Mbps, full duplexn");
  1061. else if (mii_advertise & ADVERTISE_100HALF)
  1062. printk ("100Mbps, half duplexn");
  1063. else if (mii_advertise & ADVERTISE_10FULL)
  1064. printk ("10Mbps, full duplexn");
  1065. else if (mii_advertise & ADVERTISE_10HALF)
  1066. printk ("10Mbps, half duplexn");
  1067. else
  1068. printk ("n");
  1069. } else {
  1070. mii_ctl = mdio_read (dev, np->phys[0], MII_BMCR);
  1071. speed = (mii_ctl & BMCR_SPEED100) ? 100 : 10;
  1072. printk (KERN_INFO "%s: Link changed: %dMbps ,",
  1073. dev->name, speed);
  1074. printk ("%s duplex.n", (mii_ctl & BMCR_FULLDPLX) ?
  1075. "full" : "half");
  1076. }
  1077. check_duplex (dev);
  1078. }
  1079. if (intr_status & StatsMax) {
  1080. get_stats(dev);
  1081. }
  1082. if (intr_status & IntrPCIErr) {
  1083. printk(KERN_ERR "%s: Something Wicked happened! %4.4x.n",
  1084.    dev->name, intr_status);
  1085. /* We must do a global reset of DMA to continue. */
  1086. }
  1087. }
  1088. static struct net_device_stats *get_stats(struct net_device *dev)
  1089. {
  1090. long ioaddr = dev->base_addr;
  1091. struct netdev_private *np = dev->priv;
  1092. int i;
  1093. /* We should lock this segment of code for SMP eventually, although
  1094.    the vulnerability window is very small and statistics are
  1095.    non-critical. */
  1096. /* The chip only need report frame silently dropped. */
  1097. np->stats.rx_missed_errors += readb(ioaddr + RxMissed);
  1098. np->stats.tx_packets += readw(ioaddr + TxFramesOK);
  1099. np->stats.rx_packets += readw(ioaddr + RxFramesOK);
  1100. np->stats.collisions += readb(ioaddr + StatsLateColl);
  1101. np->stats.collisions += readb(ioaddr + StatsMultiColl);
  1102. np->stats.collisions += readb(ioaddr + StatsOneColl);
  1103. readb(ioaddr + StatsCarrierError);
  1104. readb(ioaddr + StatsTxDefer);
  1105. for (i = StatsTxDefer; i <= StatsMcastRx; i++)
  1106. readb(ioaddr + i);
  1107. np->stats.tx_bytes += readw(ioaddr + TxOctetsLow);
  1108. np->stats.tx_bytes += readw(ioaddr + TxOctetsHigh) << 16;
  1109. np->stats.rx_bytes += readw(ioaddr + RxOctetsLow);
  1110. np->stats.rx_bytes += readw(ioaddr + RxOctetsHigh) << 16;
  1111. return &np->stats;
  1112. }
  1113. /* The little-endian AUTODIN II ethernet CRC calculations.
  1114.    A big-endian version is also available.
  1115.    This is slow but compact code.  Do not use this routine for bulk data,
  1116.    use a table-based routine instead.
  1117.    This is common code and should be moved to net/core/crc.c.
  1118.    Chips may use the upper or lower CRC bits, and may reverse and/or invert
  1119.    them.  Select the endian-ness that results in minimal calculations.
  1120. */
  1121. static unsigned const ethernet_polynomial_le = 0xedb88320U;
  1122. static inline unsigned ether_crc_le(int length, unsigned char *data)
  1123. {
  1124. unsigned int crc = 0xffffffff; /* Initial value. */
  1125. while(--length >= 0) {
  1126. unsigned char current_octet = *data++;
  1127. int bit;
  1128. for (bit = 8; --bit >= 0; current_octet >>= 1) {
  1129. if ((crc ^ current_octet) & 1) {
  1130. crc >>= 1;
  1131. crc ^= ethernet_polynomial_le;
  1132. } else
  1133. crc >>= 1;
  1134. }
  1135. }
  1136. return crc;
  1137. }
  1138. static void set_rx_mode(struct net_device *dev)
  1139. {
  1140. long ioaddr = dev->base_addr;
  1141. u16 mc_filter[4]; /* Multicast hash filter */
  1142. u32 rx_mode;
  1143. int i;
  1144. if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */
  1145. /* Unconditionally log net taps. */
  1146. printk(KERN_NOTICE "%s: Promiscuous mode enabled.n", dev->name);
  1147. memset(mc_filter, 0xff, sizeof(mc_filter));
  1148. rx_mode = AcceptBroadcast | AcceptMulticast | AcceptAll | AcceptMyPhys;
  1149. } else if ((dev->mc_count > multicast_filter_limit)
  1150.    ||  (dev->flags & IFF_ALLMULTI)) {
  1151. /* Too many to match, or accept all multicasts. */
  1152. memset(mc_filter, 0xff, sizeof(mc_filter));
  1153. rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys;
  1154. } else if (dev->mc_count) {
  1155. struct dev_mc_list *mclist;
  1156. memset(mc_filter, 0, sizeof(mc_filter));
  1157. for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
  1158.  i++, mclist = mclist->next) {
  1159. set_bit(ether_crc_le(ETH_ALEN, mclist->dmi_addr) & 0x3f,
  1160. mc_filter);
  1161. }
  1162. rx_mode = AcceptBroadcast | AcceptMultiHash | AcceptMyPhys;
  1163. } else {
  1164. writeb(AcceptBroadcast | AcceptMyPhys, ioaddr + RxMode);
  1165. return;
  1166. }
  1167. for (i = 0; i < 4; i++)
  1168. writew(mc_filter[i], ioaddr + MulticastFilter0 + i*2);
  1169. writeb(rx_mode, ioaddr + RxMode);
  1170. }
  1171. static int netdev_ethtool_ioctl(struct net_device *dev, void *useraddr)
  1172. {
  1173. struct netdev_private *np = dev->priv;
  1174. u32 ethcmd;
  1175. if (copy_from_user(&ethcmd, useraddr, sizeof(ethcmd)))
  1176. return -EFAULT;
  1177.         switch (ethcmd) {
  1178.         case ETHTOOL_GDRVINFO: {
  1179. struct ethtool_drvinfo info = {ETHTOOL_GDRVINFO};
  1180. strcpy(info.driver, DRV_NAME);
  1181. strcpy(info.version, DRV_VERSION);
  1182. strcpy(info.bus_info, np->pci_dev->slot_name);
  1183. if (copy_to_user(useraddr, &info, sizeof(info)))
  1184. return -EFAULT;
  1185. return 0;
  1186. }
  1187.         }
  1188. return -EOPNOTSUPP;
  1189. }
  1190. static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
  1191. {
  1192. struct mii_ioctl_data *data = (struct mii_ioctl_data *)&rq->ifr_data;
  1193. switch(cmd) {
  1194. case SIOCETHTOOL:
  1195. return netdev_ethtool_ioctl(dev, (void *) rq->ifr_data);
  1196. case SIOCGMIIPHY: /* Get address of MII PHY in use. */
  1197. case SIOCDEVPRIVATE: /* for binary compat, remove in 2.5 */
  1198. data->phy_id = ((struct netdev_private *)dev->priv)->phys[0] & 0x1f;
  1199. /* Fall Through */
  1200. case SIOCGMIIREG: /* Read MII PHY register. */
  1201. case SIOCDEVPRIVATE+1: /* for binary compat, remove in 2.5 */
  1202. data->val_out = mdio_read(dev, data->phy_id & 0x1f, data->reg_num & 0x1f);
  1203. return 0;
  1204. case SIOCSMIIREG: /* Write MII PHY register. */
  1205. case SIOCDEVPRIVATE+2: /* for binary compat, remove in 2.5 */
  1206. if (!capable(CAP_NET_ADMIN))
  1207. return -EPERM;
  1208. mdio_write(dev, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in);
  1209. return 0;
  1210. default:
  1211. return -EOPNOTSUPP;
  1212. }
  1213. }
  1214. static int netdev_close(struct net_device *dev)
  1215. {
  1216. long ioaddr = dev->base_addr;
  1217. struct netdev_private *np = dev->priv;
  1218. struct sk_buff *skb;
  1219. int i;
  1220. netif_stop_queue(dev);
  1221. if (debug > 1) {
  1222. printk(KERN_DEBUG "%s: Shutting down ethercard, status was Tx %2.2x "
  1223.    "Rx %4.4x Int %2.2x.n",
  1224.    dev->name, readb(ioaddr + TxStatus),
  1225.    readl(ioaddr + RxStatus), readw(ioaddr + IntrStatus));
  1226. printk(KERN_DEBUG "%s: Queue pointers were Tx %d / %d,  Rx %d / %d.n",
  1227.    dev->name, np->cur_tx, np->dirty_tx, np->cur_rx, np->dirty_rx);
  1228. }
  1229. /* Disable interrupts by clearing the interrupt mask. */
  1230. writew(0x0000, ioaddr + IntrEnable);
  1231. /* Stop the chip's Tx and Rx processes. */
  1232. writew(TxDisable | RxDisable | StatsDisable, ioaddr + MACCtrl1);
  1233. #ifdef __i386__
  1234. if (debug > 2) {
  1235. printk("n"KERN_DEBUG"  Tx ring at %8.8x:n",
  1236.    (int)(np->tx_ring_dma));
  1237. for (i = 0; i < TX_RING_SIZE; i++)
  1238. printk(" #%d desc. %4.4x %8.8x %8.8x.n",
  1239.    i, np->tx_ring[i].status, np->tx_ring[i].frag[0].addr,
  1240.    np->tx_ring[i].frag[0].length);
  1241. printk("n"KERN_DEBUG "  Rx ring %8.8x:n",
  1242.    (int)(np->rx_ring_dma));
  1243. for (i = 0; i < /*RX_RING_SIZE*/4 ; i++) {
  1244. printk(KERN_DEBUG " #%d desc. %4.4x %4.4x %8.8xn",
  1245.    i, np->rx_ring[i].status, np->rx_ring[i].frag[0].addr,
  1246.    np->rx_ring[i].frag[0].length);
  1247. }
  1248. }
  1249. #endif /* __i386__ debugging only */
  1250. free_irq(dev->irq, dev);
  1251. del_timer_sync(&np->timer);
  1252. /* Free all the skbuffs in the Rx queue. */
  1253. for (i = 0; i < RX_RING_SIZE; i++) {
  1254. np->rx_ring[i].status = 0;
  1255. np->rx_ring[i].frag[0].addr = 0xBADF00D0; /* An invalid address. */
  1256. skb = np->rx_skbuff[i];
  1257. if (skb) {
  1258. pci_unmap_single(np->pci_dev, 
  1259. np->rx_ring[i].frag[0].addr, np->rx_buf_sz, 
  1260. PCI_DMA_FROMDEVICE);
  1261. dev_kfree_skb(skb);
  1262. np->rx_skbuff[i] = 0;
  1263. }
  1264. }
  1265. for (i = 0; i < TX_RING_SIZE; i++) {
  1266. skb = np->tx_skbuff[i];
  1267. if (skb) {
  1268. pci_unmap_single(np->pci_dev, 
  1269. np->tx_ring[i].frag[0].addr, skb->len,
  1270. PCI_DMA_TODEVICE);
  1271. dev_kfree_skb(skb);
  1272. np->tx_skbuff[i] = 0;
  1273. }
  1274. }
  1275. return 0;
  1276. }
  1277. static void __devexit sundance_remove1 (struct pci_dev *pdev)
  1278. {
  1279. struct net_device *dev = pci_get_drvdata(pdev);
  1280. /* No need to check MOD_IN_USE, as sys_delete_module() checks. */
  1281. if (dev) {
  1282. struct netdev_private *np = dev->priv;
  1283. unregister_netdev(dev);
  1284.          pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, 
  1285. np->rx_ring_dma);
  1286.         pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, 
  1287. np->tx_ring_dma);
  1288. pci_release_regions(pdev);
  1289. #ifndef USE_IO_OPS
  1290. iounmap((char *)(dev->base_addr));
  1291. #endif
  1292. kfree(dev);
  1293. pci_set_drvdata(pdev, NULL);
  1294. }
  1295. }
  1296. static struct pci_driver sundance_driver = {
  1297. name: DRV_NAME,
  1298. id_table: sundance_pci_tbl,
  1299. probe: sundance_probe1,
  1300. remove: __devexit_p(sundance_remove1),
  1301. };
  1302. static int __init sundance_init(void)
  1303. {
  1304. /* when a module, this is printed whether or not devices are found in probe */
  1305. #ifdef MODULE
  1306. printk(version);
  1307. #endif
  1308. return pci_module_init(&sundance_driver);
  1309. }
  1310. static void __exit sundance_exit(void)
  1311. {
  1312. pci_unregister_driver(&sundance_driver);
  1313. }
  1314. module_init(sundance_init);
  1315. module_exit(sundance_exit);