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

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

嵌入式Linux

开发平台：

Unix_Linux

pci-skeleton.c：源码内容
  1. /*
  3. drivers/net/pci-skeleton.c
  5. Maintained by Jeff Garzik <jgarzik@mandrakesoft.com>
  7. Original code came from 8139too.c, which in turns was based
  8. originally on Donald Becker's rtl8139.c driver, versions 1.11
  9. and older.  This driver was originally based on rtl8139.c
  10. version 1.07.  Header of rtl8139.c version 1.11:
  12. -----<snip>-----
  14.          Written 1997-2000 by Donald Becker.
  15. This software may be used and distributed according to the
  16. terms of the GNU General Public License (GPL), incorporated
  17. herein by reference.  Drivers based on or derived from this
  18. code fall under the GPL and must retain the authorship,
  19. copyright and license notice.  This file is not a complete
  20. program and may only be used when the entire operating
  21. system is licensed under the GPL.
  23. This driver is for boards based on the RTL8129 and RTL8139
  24. PCI ethernet chips.
  26. The author may be reached as becker@scyld.com, or C/O Scyld
  27. Computing Corporation 410 Severn Ave., Suite 210 Annapolis
  28. MD 21403
  30. Support and updates available at
  31. http://www.scyld.com/network/rtl8139.html
  33. Twister-tuning table provided by Kinston
  34. <shangh@realtek.com.tw>.
  36. -----<snip>-----
  38. This software may be used and distributed according to the terms
  39. of the GNU General Public License, incorporated herein by reference.
  42. -----------------------------------------------------------------------------
  44. Theory of Operation
  46. I. Board Compatibility
  48. This device driver is designed for the RealTek RTL8139 series, the RealTek
  49. Fast Ethernet controllers for PCI and CardBus.  This chip is used on many
  50. low-end boards, sometimes with its markings changed.
  53. II. Board-specific settings
  55. PCI bus devices are configured by the system at boot time, so no jumpers
  56. need to be set on the board.  The system BIOS will assign the
  57. PCI INTA signal to a (preferably otherwise unused) system IRQ line.
  59. III. Driver operation
  61. IIIa. Rx Ring buffers
  63. The receive unit uses a single linear ring buffer rather than the more
  64. common (and more efficient) descriptor-based architecture.  Incoming frames
  65. are sequentially stored into the Rx region, and the host copies them into
  66. skbuffs.
  68. Comment: While it is theoretically possible to process many frames in place,
  69. any delay in Rx processing would cause us to drop frames.  More importantly,
  70. the Linux protocol stack is not designed to operate in this manner.
  72. IIIb. Tx operation
  74. The RTL8139 uses a fixed set of four Tx descriptors in register space.
  75. In a stunningly bad design choice, Tx frames must be 32 bit aligned.  Linux
  76. aligns the IP header on word boundaries, and 14 byte ethernet header means
  77. that almost all frames will need to be copied to an alignment buffer.
  79. IVb. References
  81. http://www.realtek.com.tw/cn/cn.html
  82. http://www.scyld.com/expert/NWay.html
  84. IVc. Errata
  86. */
  88. #include <linux/config.h>
  89. #include <linux/module.h>
  90. #include <linux/kernel.h>
  91. #include <linux/pci.h>
  92. #include <linux/init.h>
  93. #include <linux/ioport.h>
  94. #include <linux/netdevice.h>
  95. #include <linux/etherdevice.h>
  96. #include <linux/delay.h>
  97. #include <linux/ethtool.h>
  98. #include <linux/mii.h>
  99. #include <asm/io.h>
  101. #define NETDRV_VERSION "1.0.0"
  102. #define MODNAME "netdrv"
  103. #define NETDRV_DRIVER_LOAD_MSG "MyVendor Fast Ethernet driver " NETDRV_VERSION " loaded"
  104. #define PFX MODNAME ": "
  106. static char version[] __devinitdata =
  107. KERN_INFO NETDRV_DRIVER_LOAD_MSG "n"
  108. KERN_INFO "  Support available from http://foo.com/bar/baz.htmln";
  110. /* define to 1 to enable PIO instead of MMIO */
  111. #undef USE_IO_OPS
  113. /* define to 1 to enable copious debugging info */
  114. #undef NETDRV_DEBUG
  116. /* define to 1 to disable lightweight runtime debugging checks */
  117. #undef NETDRV_NDEBUG
  120. #ifdef NETDRV_DEBUG
  121. /* note: prints function name for you */
  122. #  define DPRINTK(fmt, args...) printk(KERN_DEBUG "%s: " fmt, __FUNCTION__ , ## args)
  123. #else
  124. #  define DPRINTK(fmt, args...)
  125. #endif
  127. #ifdef NETDRV_NDEBUG
  128. #  define assert(expr) do {} while (0)
  129. #else
  130. #  define assert(expr) 
  131.         if(!(expr)) {
  132.         printk( "Assertion failed! %s,%s,%s,line=%dn",
  133.         #expr,__FILE__,__FUNCTION__,__LINE__);
  134.         }
  135. #endif
  138. /* A few user-configurable values. */
  139. /* media options */
  140. static int media[] = {-1, -1, -1, -1, -1, -1, -1, -1};
  142. /* Maximum events (Rx packets, etc.) to handle at each interrupt. */
  143. static int max_interrupt_work = 20;
  145. /* Maximum number of multicast addresses to filter (vs. Rx-all-multicast).
  146.    The RTL chips use a 64 element hash table based on the Ethernet CRC.  */
  147. static int multicast_filter_limit = 32;
  149. /* Size of the in-memory receive ring. */
  150. #define RX_BUF_LEN_IDX 2 /* 0==8K, 1==16K, 2==32K, 3==64K */
  151. #define RX_BUF_LEN (8192 << RX_BUF_LEN_IDX)
  152. #define RX_BUF_PAD 16
  153. #define RX_BUF_WRAP_PAD 2048 /* spare padding to handle lack of packet wrap */
  154. #define RX_BUF_TOT_LEN (RX_BUF_LEN + RX_BUF_PAD + RX_BUF_WRAP_PAD)
  156. /* Number of Tx descriptor registers. */
  157. #define NUM_TX_DESC 4
  159. /* max supported ethernet frame size -- must be at least (dev->mtu+14+4).*/
  160. #define MAX_ETH_FRAME_SIZE 1536
  162. /* Size of the Tx bounce buffers -- must be at least (dev->mtu+14+4). */
  163. #define TX_BUF_SIZE MAX_ETH_FRAME_SIZE
  164. #define TX_BUF_TOT_LEN (TX_BUF_SIZE * NUM_TX_DESC)
  166. /* PCI Tuning Parameters
  167.    Threshold is bytes transferred to chip before transmission starts. */
  168. #define TX_FIFO_THRESH 256 /* In bytes, rounded down to 32 byte units. */
  170. /* The following settings are log_2(bytes)-4:  0 == 16 bytes .. 6==1024, 7==end of packet. */
  171. #define RX_FIFO_THRESH 6 /* Rx buffer level before first PCI xfer.  */
  172. #define RX_DMA_BURST 6 /* Maximum PCI burst, '6' is 1024 */
  173. #define TX_DMA_BURST 6 /* Maximum PCI burst, '6' is 1024 */
  176. /* Operational parameters that usually are not changed. */
  177. /* Time in jiffies before concluding the transmitter is hung. */
  178. #define TX_TIMEOUT  (6*HZ)
  181. enum {
  182. HAS_CHIP_XCVR = 0x020000,
  183. HAS_LNK_CHNG = 0x040000,
  184. };
  186. #define NETDRV_MIN_IO_SIZE 0x80
  187. #define RTL8139B_IO_SIZE 256
  189. #define NETDRV_CAPS HAS_CHIP_XCVR|HAS_LNK_CHNG
  191. typedef enum {
  192. RTL8139 = 0,
  193. NETDRV_CB,
  194. SMC1211TX,
  195. /*MPX5030,*/
  196. DELTA8139,
  197. ADDTRON8139,
  198. } board_t;
  201. /* indexed by board_t, above */
  202. static struct {
  203. const char *name;
  204. } board_info[] __devinitdata = {
  205. { "RealTek RTL8139 Fast Ethernet" },
  206. { "RealTek RTL8139B PCI/CardBus" },
  207. { "SMC1211TX EZCard 10/100 (RealTek RTL8139)" },
  208. /* { MPX5030, "Accton MPX5030 (RealTek RTL8139)" },*/
  209. { "Delta Electronics 8139 10/100BaseTX" },
  210. { "Addtron Technolgy 8139 10/100BaseTX" },
  211. };
  214. static struct pci_device_id netdrv_pci_tbl[] __devinitdata = {
  215. {0x10ec, 0x8139, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
  216. {0x10ec, 0x8138, PCI_ANY_ID, PCI_ANY_ID, 0, 0, NETDRV_CB },
  217. {0x1113, 0x1211, PCI_ANY_ID, PCI_ANY_ID, 0, 0, SMC1211TX },
  218. /* {0x1113, 0x1211, PCI_ANY_ID, PCI_ANY_ID, 0, 0, MPX5030 },*/
  219. {0x1500, 0x1360, PCI_ANY_ID, PCI_ANY_ID, 0, 0, DELTA8139 },
  220. {0x4033, 0x1360, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ADDTRON8139 },
  221. {0,}
  222. };
  223. MODULE_DEVICE_TABLE (pci, netdrv_pci_tbl);
  226. /* The rest of these values should never change. */
  228. /* Symbolic offsets to registers. */
  229. enum NETDRV_registers {
  230. MAC0 = 0, /* Ethernet hardware address. */
  231. MAR0 = 8, /* Multicast filter. */
  232. TxStatus0 = 0x10, /* Transmit status (Four 32bit registers). */
  233. TxAddr0 = 0x20, /* Tx descriptors (also four 32bit). */
  234. RxBuf = 0x30,
  235. RxEarlyCnt = 0x34,
  236. RxEarlyStatus = 0x36,
  237. ChipCmd = 0x37,
  238. RxBufPtr = 0x38,
  239. RxBufAddr = 0x3A,
  240. IntrMask = 0x3C,
  241. IntrStatus = 0x3E,
  242. TxConfig = 0x40,
  243. ChipVersion = 0x43,
  244. RxConfig = 0x44,
  245. Timer = 0x48, /* A general-purpose counter. */
  246. RxMissed = 0x4C, /* 24 bits valid, write clears. */
  247. Cfg9346 = 0x50,
  248. Config0 = 0x51,
  249. Config1 = 0x52,
  250. FlashReg = 0x54,
  251. MediaStatus = 0x58,
  252. Config3 = 0x59,
  253. Config4 = 0x5A, /* absent on RTL-8139A */
  254. HltClk = 0x5B,
  255. MultiIntr = 0x5C,
  256. TxSummary = 0x60,
  257. BasicModeCtrl = 0x62,
  258. BasicModeStatus = 0x64,
  259. NWayAdvert = 0x66,
  260. NWayLPAR = 0x68,
  261. NWayExpansion = 0x6A,
  262. /* Undocumented registers, but required for proper operation. */
  263. FIFOTMS = 0x70, /* FIFO Control and test. */
  264. CSCR = 0x74, /* Chip Status and Configuration Register. */
  265. PARA78 = 0x78,
  266. PARA7c = 0x7c, /* Magic transceiver parameter register. */
  267. Config5 = 0xD8, /* absent on RTL-8139A */
  268. };
  270. enum ClearBitMasks {
  271. MultiIntrClear = 0xF000,
  272. ChipCmdClear = 0xE2,
  273. Config1Clear = (1<<7)|(1<<6)|(1<<3)|(1<<2)|(1<<1),
  274. };
  276. enum ChipCmdBits {
  277. CmdReset = 0x10,
  278. CmdRxEnb = 0x08,
  279. CmdTxEnb = 0x04,
  280. RxBufEmpty = 0x01,
  281. };
  283. /* Interrupt register bits, using my own meaningful names. */
  284. enum IntrStatusBits {
  285. PCIErr = 0x8000,
  286. PCSTimeout = 0x4000,
  287. RxFIFOOver = 0x40,
  288. RxUnderrun = 0x20,
  289. RxOverflow = 0x10,
  290. TxErr = 0x08,
  291. TxOK = 0x04,
  292. RxErr = 0x02,
  293. RxOK = 0x01,
  294. };
  295. enum TxStatusBits {
  296. TxHostOwns = 0x2000,
  297. TxUnderrun = 0x4000,
  298. TxStatOK = 0x8000,
  299. TxOutOfWindow = 0x20000000,
  300. TxAborted = 0x40000000,
  301. TxCarrierLost = 0x80000000,
  302. };
  303. enum RxStatusBits {
  304. RxMulticast = 0x8000,
  305. RxPhysical = 0x4000,
  306. RxBroadcast = 0x2000,
  307. RxBadSymbol = 0x0020,
  308. RxRunt = 0x0010,
  309. RxTooLong = 0x0008,
  310. RxCRCErr = 0x0004,
  311. RxBadAlign = 0x0002,
  312. RxStatusOK = 0x0001,
  313. };
  315. /* Bits in RxConfig. */
  316. enum rx_mode_bits {
  317. AcceptErr = 0x20,
  318. AcceptRunt = 0x10,
  319. AcceptBroadcast = 0x08,
  320. AcceptMulticast = 0x04,
  321. AcceptMyPhys = 0x02,
  322. AcceptAllPhys = 0x01,
  323. };
  325. /* Bits in TxConfig. */
  326. enum tx_config_bits {
  327. TxIFG1 = (1 << 25), /* Interframe Gap Time */
  328. TxIFG0 = (1 << 24), /* Enabling these bits violates IEEE 802.3 */
  329. TxLoopBack = (1 << 18) | (1 << 17), /* enable loopback test mode */
  330. TxCRC = (1 << 16), /* DISABLE appending CRC to end of Tx packets */
  331. TxClearAbt = (1 << 0), /* Clear abort (WO) */
  332. TxDMAShift = 8, /* DMA burst value (0-7) is shift this many bits */
  334. TxVersionMask = 0x7C800000, /* mask out version bits 30-26, 23 */
  335. };
  337. /* Bits in Config1 */
  338. enum Config1Bits {
  339. Cfg1_PM_Enable = 0x01,
  340. Cfg1_VPD_Enable = 0x02,
  341. Cfg1_PIO = 0x04,
  342. Cfg1_MMIO = 0x08,
  343. Cfg1_LWAKE = 0x10,
  344. Cfg1_Driver_Load = 0x20,
  345. Cfg1_LED0 = 0x40,
  346. Cfg1_LED1 = 0x80,
  347. };
  349. enum RxConfigBits {
  350. /* Early Rx threshold, none or X/16 */
  351. RxCfgEarlyRxNone = 0,
  352. RxCfgEarlyRxShift = 24,
  354. /* rx fifo threshold */
  355. RxCfgFIFOShift = 13,
  356. RxCfgFIFONone = (7 << RxCfgFIFOShift),
  358. /* Max DMA burst */
  359. RxCfgDMAShift = 8,
  360. RxCfgDMAUnlimited = (7 << RxCfgDMAShift),
  362. /* rx ring buffer length */
  363. RxCfgRcv8K = 0,
  364. RxCfgRcv16K = (1 << 11),
  365. RxCfgRcv32K = (1 << 12),
  366. RxCfgRcv64K = (1 << 11) | (1 << 12),
  368. /* Disable packet wrap at end of Rx buffer */
  369. RxNoWrap = (1 << 7),
  370. };
  373. /* Twister tuning parameters from RealTek.
  374.    Completely undocumented, but required to tune bad links. */
  375. enum CSCRBits {
  376. CSCR_LinkOKBit = 0x0400,
  377. CSCR_LinkChangeBit = 0x0800,
  378. CSCR_LinkStatusBits = 0x0f000,
  379. CSCR_LinkDownOffCmd = 0x003c0,
  380. CSCR_LinkDownCmd = 0x0f3c0,
  381. };
  384. enum Cfg9346Bits {
  385. Cfg9346_Lock = 0x00,
  386. Cfg9346_Unlock = 0xC0,
  387. };
  390. #define PARA78_default 0x78fa8388
  391. #define PARA7c_default 0xcb38de43 /* param[0][3] */
  392. #define PARA7c_xxx 0xcb38de43
  393. static const unsigned long param[4][4] = {
  394. {0xcb39de43, 0xcb39ce43, 0xfb38de03, 0xcb38de43},
  395. {0xcb39de43, 0xcb39ce43, 0xcb39ce83, 0xcb39ce83},
  396. {0xcb39de43, 0xcb39ce43, 0xcb39ce83, 0xcb39ce83},
  397. {0xbb39de43, 0xbb39ce43, 0xbb39ce83, 0xbb39ce83}
  398. };
  400. struct ring_info {
  401. struct sk_buff *skb;
  402. dma_addr_t mapping;
  403. };
  406. typedef enum {
  407. CH_8139 = 0,
  408. CH_8139_K,
  409. CH_8139A,
  410. CH_8139B,
  411. CH_8130,
  412. CH_8139C,
  413. } chip_t;
  416. /* directly indexed by chip_t, above */
  417. const static struct {
  418. const char *name;
  419. u8 version; /* from RTL8139C docs */
  420. u32 RxConfigMask; /* should clear the bits supported by this chip */
  421. } rtl_chip_info[] = {
  422. { "RTL-8139",
  423.   0x40,
  424.   0xf0fe0040, /* XXX copied from RTL8139A, verify */
  425. },
  427. { "RTL-8139 rev K",
  428.   0x60,
  429.   0xf0fe0040,
  430. },
  432. { "RTL-8139A",
  433.   0x70,
  434.   0xf0fe0040,
  435. },
  437. { "RTL-8139B",
  438.   0x78,
  439.   0xf0fc0040
  440. },
  442. { "RTL-8130",
  443.   0x7C,
  444.   0xf0fe0040, /* XXX copied from RTL8139A, verify */
  445. },
  447. { "RTL-8139C",
  448.   0x74,
  449.   0xf0fc0040, /* XXX copied from RTL8139B, verify */
  450. },
  452. };
  455. struct netdrv_private {
  456. board_t board;
  457. void *mmio_addr;
  458. int drv_flags;
  459. struct pci_dev *pci_dev;
  460. struct net_device_stats stats;
  461. struct timer_list timer; /* Media selection timer. */
  462. unsigned char *rx_ring;
  463. unsigned int cur_rx; /* Index into the Rx buffer of next Rx pkt. */
  464. unsigned int tx_flag;
  465. atomic_t cur_tx;
  466. atomic_t dirty_tx;
  467. /* The saved address of a sent-in-place packet/buffer, for skfree(). */
  468. struct ring_info tx_info[NUM_TX_DESC];
  469. unsigned char *tx_buf[NUM_TX_DESC]; /* Tx bounce buffers */
  470. unsigned char *tx_bufs; /* Tx bounce buffer region. */
  471. dma_addr_t rx_ring_dma;
  472. dma_addr_t tx_bufs_dma;
  473. char phys[4]; /* MII device addresses. */
  474. char twistie, twist_row, twist_col; /* Twister tune state. */
  475. unsigned int full_duplex:1; /* Full-duplex operation requested. */
  476. unsigned int duplex_lock:1;
  477. unsigned int default_port:4; /* Last dev->if_port value. */
  478. unsigned int media2:4; /* Secondary monitored media port. */
  479. unsigned int medialock:1; /* Don't sense media type. */
  480. unsigned int mediasense:1; /* Media sensing in progress. */
  481. spinlock_t lock;
  482. chip_t chipset;
  483. };
  485. MODULE_AUTHOR ("Jeff Garzik <jgarzik@mandrakesoft.com>");
  486. MODULE_DESCRIPTION ("Skeleton for a PCI Fast Ethernet driver");
  487. MODULE_LICENSE("GPL");
  488. MODULE_PARM (multicast_filter_limit, "i");
  489. MODULE_PARM (max_interrupt_work, "i");
  490. MODULE_PARM (debug, "i");
  491. MODULE_PARM (media, "1-" __MODULE_STRING(8) "i");
  492. MODULE_PARM_DESC (multicast_filter_limit, "pci-skeleton maximum number of filtered multicast addresses");
  493. MODULE_PARM_DESC (max_interrupt_work, "pci-skeleton maximum events handled per interrupt");
  494. MODULE_PARM_DESC (media, "pci-skeleton: Bits 0-3: media type, bit 17: full duplex");
  495. MODULE_PARM_DESC (debug, "(unused)");
  497. static int read_eeprom (void *ioaddr, int location, int addr_len);
  498. static int netdrv_open (struct net_device *dev);
  499. static int mdio_read (struct net_device *dev, int phy_id, int location);
  500. static void mdio_write (struct net_device *dev, int phy_id, int location,
  501. int val);
  502. static void netdrv_timer (unsigned long data);
  503. static void netdrv_tx_timeout (struct net_device *dev);
  504. static void netdrv_init_ring (struct net_device *dev);
  505. static int netdrv_start_xmit (struct sk_buff *skb,
  506.        struct net_device *dev);
  507. static void netdrv_interrupt (int irq, void *dev_instance,
  508.        struct pt_regs *regs);
  509. static int netdrv_close (struct net_device *dev);
  510. static int netdrv_ioctl (struct net_device *dev, struct ifreq *rq, int cmd);
  511. static struct net_device_stats *netdrv_get_stats (struct net_device *dev);
  512. static inline u32 ether_crc (int length, unsigned char *data);
  513. static void netdrv_set_rx_mode (struct net_device *dev);
  514. static void netdrv_hw_start (struct net_device *dev);
  517. #ifdef USE_IO_OPS
  519. #define NETDRV_R8(reg) inb (((unsigned long)ioaddr) + (reg))
  520. #define NETDRV_R16(reg) inw (((unsigned long)ioaddr) + (reg))
  521. #define NETDRV_R32(reg) ((unsigned long) inl (((unsigned long)ioaddr) + (reg)))
  522. #define NETDRV_W8(reg, val8) outb ((val8), ((unsigned long)ioaddr) + (reg))
  523. #define NETDRV_W16(reg, val16) outw ((val16), ((unsigned long)ioaddr) + (reg))
  524. #define NETDRV_W32(reg, val32) outl ((val32), ((unsigned long)ioaddr) + (reg))
  525. #define NETDRV_W8_F NETDRV_W8
  526. #define NETDRV_W16_F NETDRV_W16
  527. #define NETDRV_W32_F NETDRV_W32
  528. #undef readb
  529. #undef readw
  530. #undef readl
  531. #undef writeb
  532. #undef writew
  533. #undef writel
  534. #define readb(addr) inb((unsigned long)(addr))
  535. #define readw(addr) inw((unsigned long)(addr))
  536. #define readl(addr) inl((unsigned long)(addr))
  537. #define writeb(val,addr) outb((val),(unsigned long)(addr))
  538. #define writew(val,addr) outw((val),(unsigned long)(addr))
  539. #define writel(val,addr) outl((val),(unsigned long)(addr))
  541. #else
  543. /* write MMIO register, with flush */
  544. /* Flush avoids rtl8139 bug w/ posted MMIO writes */
  545. #define NETDRV_W8_F(reg, val8) do { writeb ((val8), ioaddr + (reg)); readb (ioaddr + (reg)); } while (0)
  546. #define NETDRV_W16_F(reg, val16) do { writew ((val16), ioaddr + (reg)); readw (ioaddr + (reg)); } while (0)
  547. #define NETDRV_W32_F(reg, val32) do { writel ((val32), ioaddr + (reg)); readl (ioaddr + (reg)); } while (0)
  550. #if MMIO_FLUSH_AUDIT_COMPLETE
  552. /* write MMIO register */
  553. #define NETDRV_W8(reg, val8) writeb ((val8), ioaddr + (reg))
  554. #define NETDRV_W16(reg, val16) writew ((val16), ioaddr + (reg))
  555. #define NETDRV_W32(reg, val32) writel ((val32), ioaddr + (reg))
  557. #else
  559. /* write MMIO register, then flush */
  560. #define NETDRV_W8 NETDRV_W8_F
  561. #define NETDRV_W16 NETDRV_W16_F
  562. #define NETDRV_W32 NETDRV_W32_F
  564. #endif /* MMIO_FLUSH_AUDIT_COMPLETE */
  566. /* read MMIO register */
  567. #define NETDRV_R8(reg) readb (ioaddr + (reg))
  568. #define NETDRV_R16(reg) readw (ioaddr + (reg))
  569. #define NETDRV_R32(reg) ((unsigned long) readl (ioaddr + (reg)))
  571. #endif /* USE_IO_OPS */
  574. static const u16 netdrv_intr_mask =
  575. PCIErr | PCSTimeout | RxUnderrun | RxOverflow | RxFIFOOver |
  576. TxErr | TxOK | RxErr | RxOK;
  578. static const unsigned int netdrv_rx_config =
  579.   RxCfgEarlyRxNone | RxCfgRcv32K | RxNoWrap |
  580.   (RX_FIFO_THRESH << RxCfgFIFOShift) |
  581.   (RX_DMA_BURST << RxCfgDMAShift);
  584. static int __devinit netdrv_init_board (struct pci_dev *pdev,
  585.  struct net_device **dev_out,
  586.  void **ioaddr_out)
  587. {
  588. void *ioaddr = NULL;
  589. struct net_device *dev;
  590. struct netdrv_private *tp;
  591. u8 tmp8;
  592. int rc, i;
  593. u32 pio_start, pio_end, pio_flags, pio_len;
  594. unsigned long mmio_start, mmio_end, mmio_flags, mmio_len;
  595. u32 tmp;
  597. DPRINTK ("ENTERn");
  599. assert (pdev != NULL);
  600. assert (ioaddr_out != NULL);
  602. *ioaddr_out = NULL;
  603. *dev_out = NULL;
  605. /* dev zeroed in init_etherdev */
  606. dev = alloc_etherdev (sizeof (*tp));
  607. if (dev == NULL) {
  608. printk (KERN_ERR PFX "unable to alloc new ethernetn");
  609. DPRINTK ("EXIT, returning -ENOMEMn");
  610. return -ENOMEM;
  611. }
  612. SET_MODULE_OWNER(dev);
  613. tp = dev->priv;
  615. /* enable device (incl. PCI PM wakeup), and bus-mastering */
  616. rc = pci_enable_device (pdev);
  617. if (rc)
  618. goto err_out;
  620. pio_start = pci_resource_start (pdev, 0);
  621. pio_end = pci_resource_end (pdev, 0);
  622. pio_flags = pci_resource_flags (pdev, 0);
  623. pio_len = pci_resource_len (pdev, 0);
  625. mmio_start = pci_resource_start (pdev, 1);
  626. mmio_end = pci_resource_end (pdev, 1);
  627. mmio_flags = pci_resource_flags (pdev, 1);
  628. mmio_len = pci_resource_len (pdev, 1);
  630. /* set this immediately, we need to know before
  631.  * we talk to the chip directly */
  632. DPRINTK("PIO region size == 0x%02Xn", pio_len);
  633. DPRINTK("MMIO region size == 0x%02lXn", mmio_len);
  635. /* make sure PCI base addr 0 is PIO */
  636. if (!(pio_flags & IORESOURCE_IO)) {
  637. printk (KERN_ERR PFX "region #0 not a PIO resource, abortingn");
  638. rc = -ENODEV;
  639. goto err_out;
  640. }
  642. /* make sure PCI base addr 1 is MMIO */
  643. if (!(mmio_flags & IORESOURCE_MEM)) {
  644. printk (KERN_ERR PFX "region #1 not an MMIO resource, abortingn");
  645. rc = -ENODEV;
  646. goto err_out;
  647. }
  649. /* check for weird/broken PCI region reporting */
  650. if ((pio_len < NETDRV_MIN_IO_SIZE) ||
  651.     (mmio_len < NETDRV_MIN_IO_SIZE)) {
  652. printk (KERN_ERR PFX "Invalid PCI region size(s), abortingn");
  653. rc = -ENODEV;
  654. goto err_out;
  655. }
  657. rc = pci_request_regions (pdev, "pci-skeleton");
  658. if (rc)
  659. goto err_out;
  661. pci_set_master (pdev);
  663. #ifdef USE_IO_OPS
  664. ioaddr = (void *) pio_start;
  665. #else
  666. /* ioremap MMIO region */
  667. ioaddr = ioremap (mmio_start, mmio_len);
  668. if (ioaddr == NULL) {
  669. printk (KERN_ERR PFX "cannot remap MMIO, abortingn");
  670. rc = -EIO;
  671. goto err_out_free_res;
  672. }
  673. #endif /* USE_IO_OPS */
  675. /* Soft reset the chip. */
  676. NETDRV_W8 (ChipCmd, (NETDRV_R8 (ChipCmd) & ChipCmdClear) | CmdReset);
  678. /* Check that the chip has finished the reset. */
  679. for (i = 1000; i > 0; i--)
  680. if ((NETDRV_R8 (ChipCmd) & CmdReset) == 0)
  681. break;
  682. else
  683. udelay (10);
  685. /* Bring the chip out of low-power mode. */
  686. /* <insert device-specific code here> */
  688. #ifndef USE_IO_OPS
  689. /* sanity checks -- ensure PIO and MMIO registers agree */
  690. assert (inb (pio_start+Config0) == readb (ioaddr+Config0));
  691. assert (inb (pio_start+Config1) == readb (ioaddr+Config1));
  692. assert (inb (pio_start+TxConfig) == readb (ioaddr+TxConfig));
  693. assert (inb (pio_start+RxConfig) == readb (ioaddr+RxConfig));
  694. #endif /* !USE_IO_OPS */
  696. /* identify chip attached to board */
  697. tmp = NETDRV_R8 (ChipVersion);
  698. for (i = ARRAY_SIZE (rtl_chip_info) - 1; i >= 0; i--)
  699. if (tmp == rtl_chip_info[i].version) {
  700. tp->chipset = i;
  701. goto match;
  702. }
  704. /* if unknown chip, assume array element #0, original RTL-8139 in this case */
  705. printk (KERN_DEBUG PFX "PCI device %s: unknown chip version, assuming RTL-8139n",
  706. pdev->slot_name);
  707. printk (KERN_DEBUG PFX "PCI device %s: TxConfig = 0x%lxn", pdev->slot_name, NETDRV_R32 (TxConfig));
  708. tp->chipset = 0;
  710. match:
  711. DPRINTK ("chipset id (%d) == index %d, '%s'n",
  712. tmp,
  713. tp->chipset,
  714. rtl_chip_info[tp->chipset].name);
  716. i = register_netdev (dev);
  717. if (i)
  718. goto err_out_unmap;
  720. DPRINTK ("EXIT, returning 0n");
  721. *ioaddr_out = ioaddr;
  722. *dev_out = dev;
  723. return 0;
  725. err_out_unmap:
  726. #ifndef USE_IO_OPS
  727. iounmap(ioaddr);
  728. err_out_free_res:
  729. #endif
  730. pci_release_regions (pdev);
  731. err_out:
  732. kfree (dev);
  733. DPRINTK ("EXIT, returning %dn", rc);
  734. return rc;
  735. }
  738. static int __devinit netdrv_init_one (struct pci_dev *pdev,
  739.        const struct pci_device_id *ent)
  740. {
  741. struct net_device *dev = NULL;
  742. struct netdrv_private *tp;
  743. int i, addr_len, option;
  744. void *ioaddr = NULL;
  745. static int board_idx = -1;
  746. u8 tmp;
  748. /* when built into the kernel, we only print version if device is found */
  749. #ifndef MODULE
  750. static int printed_version;
  751. if (!printed_version++)
  752. printk(version);
  753. #endif
  755. DPRINTK ("ENTERn");
  757. assert (pdev != NULL);
  758. assert (ent != NULL);
  760. board_idx++;
  762. i = netdrv_init_board (pdev, &dev, &ioaddr);
  763. if (i < 0) {
  764. DPRINTK ("EXIT, returning %dn", i);
  765. return i;
  766. }
  768. tp = dev->priv;
  770. assert (ioaddr != NULL);
  771. assert (dev != NULL);
  772. assert (tp != NULL);
  774. addr_len = read_eeprom (ioaddr, 0, 8) == 0x8129 ? 8 : 6;
  775. for (i = 0; i < 3; i++)
  776. ((u16 *) (dev->dev_addr))[i] =
  777.     le16_to_cpu (read_eeprom (ioaddr, i + 7, addr_len));
  779. /* The Rtl8139-specific entries in the device structure. */
  780. dev->open = netdrv_open;
  781. dev->hard_start_xmit = netdrv_start_xmit;
  782. dev->stop = netdrv_close;
  783. dev->get_stats = netdrv_get_stats;
  784. dev->set_multicast_list = netdrv_set_rx_mode;
  785. dev->do_ioctl = netdrv_ioctl;
  786. dev->tx_timeout = netdrv_tx_timeout;
  787. dev->watchdog_timeo = TX_TIMEOUT;
  789. dev->irq = pdev->irq;
  790. dev->base_addr = (unsigned long) ioaddr;
  792. /* dev->priv/tp zeroed and aligned in init_etherdev */
  793. tp = dev->priv;
  795. /* note: tp->chipset set in netdrv_init_board */
  796. tp->drv_flags = PCI_COMMAND_IO | PCI_COMMAND_MEMORY |
  797. PCI_COMMAND_MASTER | NETDRV_CAPS;
  798. tp->pci_dev = pdev;
  799. tp->board = ent->driver_data;
  800. tp->mmio_addr = ioaddr;
  801. tp->lock = SPIN_LOCK_UNLOCKED;
  803. pci_set_drvdata(pdev, dev);
  805. tp->phys[0] = 32;
  807. printk (KERN_INFO "%s: %s at 0x%lx, "
  808. "%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x, "
  809. "IRQ %dn",
  810. dev->name,
  811. board_info[ent->driver_data].name,
  812. dev->base_addr,
  813. dev->dev_addr[0], dev->dev_addr[1],
  814. dev->dev_addr[2], dev->dev_addr[3],
  815. dev->dev_addr[4], dev->dev_addr[5],
  816. dev->irq);
  818. printk (KERN_DEBUG "%s:  Identified 8139 chip type '%s'n",
  819. dev->name, rtl_chip_info[tp->chipset].name);
  821. /* Put the chip into low-power mode. */
  822. NETDRV_W8_F (Cfg9346, Cfg9346_Unlock);
  824. /* The lower four bits are the media type. */
  825. option = (board_idx > 7) ? 0 : media[board_idx];
  826. if (option > 0) {
  827. tp->full_duplex = (option & 0x200) ? 1 : 0;
  828. tp->default_port = option & 15;
  829. if (tp->default_port)
  830. tp->medialock = 1;
  831. }
  833. if (tp->full_duplex) {
  834. printk (KERN_INFO
  835. "%s: Media type forced to Full Duplex.n",
  836. dev->name);
  837. mdio_write (dev, tp->phys[0], MII_ADVERTISE, ADVERTISE_FULL);
  838. tp->duplex_lock = 1;
  839. }
  841. DPRINTK ("EXIT - returning 0n");
  842. return 0;
  843. }
  846. static void __devexit netdrv_remove_one (struct pci_dev *pdev)
  847. {
  848. struct net_device *dev = pci_get_drvdata (pdev);
  849. struct netdrv_private *np;
  851. DPRINTK ("ENTERn");
  853. assert (dev != NULL);
  855. np = dev->priv;
  856. assert (np != NULL);
  858. unregister_netdev (dev);
  860. #ifndef USE_IO_OPS
  861. iounmap (np->mmio_addr);
  862. #endif /* !USE_IO_OPS */
  864. pci_release_regions (pdev);
  866. #ifndef NETDRV_NDEBUG
  867. /* poison memory before freeing */
  868. memset (dev, 0xBC,
  869. sizeof (struct net_device) +
  870. sizeof (struct netdrv_private));
  871. #endif /* NETDRV_NDEBUG */
  873. kfree (dev);
  875. pci_set_drvdata (pdev, NULL);
  877. pci_power_off (pdev, -1);
  879. DPRINTK ("EXITn");
  880. }
  883. /* Serial EEPROM section. */
  885. /*  EEPROM_Ctrl bits. */
  886. #define EE_SHIFT_CLK 0x04 /* EEPROM shift clock. */
  887. #define EE_CS 0x08 /* EEPROM chip select. */
  888. #define EE_DATA_WRITE 0x02 /* EEPROM chip data in. */
  889. #define EE_WRITE_0 0x00
  890. #define EE_WRITE_1 0x02
  891. #define EE_DATA_READ 0x01 /* EEPROM chip data out. */
  892. #define EE_ENB (0x80 | EE_CS)
  894. /* Delay between EEPROM clock transitions.
  895.    No extra delay is needed with 33Mhz PCI, but 66Mhz may change this.
  896.  */
  898. #define eeprom_delay() readl(ee_addr)
  900. /* The EEPROM commands include the alway-set leading bit. */
  901. #define EE_WRITE_CMD (5)
  902. #define EE_READ_CMD (6)
  903. #define EE_ERASE_CMD (7)
  905. static int __devinit read_eeprom (void *ioaddr, int location, int addr_len)
  906. {
  907. int i;
  908. unsigned retval = 0;
  909. void *ee_addr = ioaddr + Cfg9346;
  910. int read_cmd = location | (EE_READ_CMD << addr_len);
  912. DPRINTK ("ENTERn");
  914. writeb (EE_ENB & ~EE_CS, ee_addr);
  915. writeb (EE_ENB, ee_addr);
  916. eeprom_delay ();
  918. /* Shift the read command bits out. */
  919. for (i = 4 + addr_len; i >= 0; i--) {
  920. int dataval = (read_cmd & (1 << i)) ? EE_DATA_WRITE : 0;
  921. writeb (EE_ENB | dataval, ee_addr);
  922. eeprom_delay ();
  923. writeb (EE_ENB | dataval | EE_SHIFT_CLK, ee_addr);
  924. eeprom_delay ();
  925. }
  926. writeb (EE_ENB, ee_addr);
  927. eeprom_delay ();
  929. for (i = 16; i > 0; i--) {
  930. writeb (EE_ENB | EE_SHIFT_CLK, ee_addr);
  931. eeprom_delay ();
  932. retval =
  933.     (retval << 1) | ((readb (ee_addr) & EE_DATA_READ) ? 1 :
  934.      0);
  935. writeb (EE_ENB, ee_addr);
  936. eeprom_delay ();
  937. }
  939. /* Terminate the EEPROM access. */
  940. writeb (~EE_CS, ee_addr);
  941. eeprom_delay ();
  943. DPRINTK ("EXIT - returning %dn", retval);
  944. return retval;
  945. }
  947. /* MII serial management: mostly bogus for now. */
  948. /* Read and write the MII management registers using software-generated
  949.    serial MDIO protocol.
  950.    The maximum data clock rate is 2.5 Mhz.  The minimum timing is usually
  951.    met by back-to-back PCI I/O cycles, but we insert a delay to avoid
  952.    "overclocking" issues. */
  953. #define MDIO_DIR 0x80
  954. #define MDIO_DATA_OUT 0x04
  955. #define MDIO_DATA_IN 0x02
  956. #define MDIO_CLK 0x01
  957. #define MDIO_WRITE0 (MDIO_DIR)
  958. #define MDIO_WRITE1 (MDIO_DIR | MDIO_DATA_OUT)
  960. #define mdio_delay() readb(mdio_addr)
  963. static char mii_2_8139_map[8] = {
  964. BasicModeCtrl,
  965. BasicModeStatus,
  966. 0,
  967. 0,
  968. NWayAdvert,
  969. NWayLPAR,
  970. NWayExpansion,
  971. 0
  972. };
  975. /* Syncronize the MII management interface by shifting 32 one bits out. */
  976. static void mdio_sync (void *mdio_addr)
  977. {
  978. int i;
  980. DPRINTK ("ENTERn");
  982. for (i = 32; i >= 0; i--) {
  983. writeb (MDIO_WRITE1, mdio_addr);
  984. mdio_delay ();
  985. writeb (MDIO_WRITE1 | MDIO_CLK, mdio_addr);
  986. mdio_delay ();
  987. }
  989. DPRINTK ("EXITn");
  990. }
  993. static int mdio_read (struct net_device *dev, int phy_id, int location)
  994. {
  995. struct netdrv_private *tp = dev->priv;
  996. void *mdio_addr = tp->mmio_addr + Config4;
  997. int mii_cmd = (0xf6 << 10) | (phy_id << 5) | location;
  998. int retval = 0;
  999. int i;
  1001. DPRINTK ("ENTERn");
  1003. if (phy_id > 31) { /* Really a 8139.  Use internal registers. */
  1004. DPRINTK ("EXIT after directly using 8139 internal regsn");
  1005. return location < 8 && mii_2_8139_map[location] ?
  1006.     readw (tp->mmio_addr + mii_2_8139_map[location]) : 0;
  1007. }
  1008. mdio_sync (mdio_addr);
  1009. /* Shift the read command bits out. */
  1010. for (i = 15; i >= 0; i--) {
  1011. int dataval = (mii_cmd & (1 << i)) ? MDIO_DATA_OUT : 0;
  1013. writeb (MDIO_DIR | dataval, mdio_addr);
  1014. mdio_delay ();
  1015. writeb (MDIO_DIR | dataval | MDIO_CLK, mdio_addr);
  1016. mdio_delay ();
  1017. }
  1019. /* Read the two transition, 16 data, and wire-idle bits. */
  1020. for (i = 19; i > 0; i--) {
  1021. writeb (0, mdio_addr);
  1022. mdio_delay ();
  1023. retval =
  1024.     (retval << 1) | ((readb (mdio_addr) & MDIO_DATA_IN) ? 1
  1025.      : 0);
  1026. writeb (MDIO_CLK, mdio_addr);
  1027. mdio_delay ();
  1028. }
  1030. DPRINTK ("EXIT, returning %dn", (retval >> 1) & 0xffff);
  1031. return (retval >> 1) & 0xffff;
  1032. }
  1035. static void mdio_write (struct net_device *dev, int phy_id, int location,
  1036. int value)
  1037. {
  1038. struct netdrv_private *tp = dev->priv;
  1039. void *mdio_addr = tp->mmio_addr + Config4;
  1040. int mii_cmd =
  1041.     (0x5002 << 16) | (phy_id << 23) | (location << 18) | value;
  1042. int i;
  1044. DPRINTK ("ENTERn");
  1046. if (phy_id > 31) { /* Really a 8139.  Use internal registers. */
  1047. if (location < 8 && mii_2_8139_map[location]) {
  1048. writew (value,
  1049. tp->mmio_addr + mii_2_8139_map[location]);
  1050. readw (tp->mmio_addr + mii_2_8139_map[location]);
  1051. }
  1052. DPRINTK ("EXIT after directly using 8139 internal regsn");
  1053. return;
  1054. }
  1055. mdio_sync (mdio_addr);
  1057. /* Shift the command bits out. */
  1058. for (i = 31; i >= 0; i--) {
  1059. int dataval =
  1060.     (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0;
  1061. writeb (dataval, mdio_addr);
  1062. mdio_delay ();
  1063. writeb (dataval | MDIO_CLK, mdio_addr);
  1064. mdio_delay ();
  1065. }
  1067. /* Clear out extra bits. */
  1068. for (i = 2; i > 0; i--) {
  1069. writeb (0, mdio_addr);
  1070. mdio_delay ();
  1071. writeb (MDIO_CLK, mdio_addr);
  1072. mdio_delay ();
  1073. }
  1075. DPRINTK ("EXITn");
  1076. }
  1079. static int netdrv_open (struct net_device *dev)
  1080. {
  1081. struct netdrv_private *tp = dev->priv;
  1082. int retval;
  1083. #ifdef NETDRV_DEBUG
  1084. void *ioaddr = tp->mmio_addr;
  1085. #endif
  1087. DPRINTK ("ENTERn");
  1089. retval = request_irq (dev->irq, netdrv_interrupt, SA_SHIRQ, dev->name, dev);
  1090. if (retval) {
  1091. DPRINTK ("EXIT, returning %dn", retval);
  1092. return retval;
  1093. }
  1095. tp->tx_bufs = pci_alloc_consistent(tp->pci_dev, TX_BUF_TOT_LEN,
  1096.    &tp->tx_bufs_dma);
  1097. tp->rx_ring = pci_alloc_consistent(tp->pci_dev, RX_BUF_TOT_LEN,
  1098.    &tp->rx_ring_dma);
  1099. if (tp->tx_bufs == NULL || tp->rx_ring == NULL) {
  1100. free_irq(dev->irq, dev);
  1102. if (tp->tx_bufs)
  1103. pci_free_consistent(tp->pci_dev, TX_BUF_TOT_LEN,
  1104.     tp->tx_bufs, tp->tx_bufs_dma);
  1105. if (tp->rx_ring)
  1106. pci_free_consistent(tp->pci_dev, RX_BUF_TOT_LEN,
  1107.     tp->rx_ring, tp->rx_ring_dma);
  1109. DPRINTK ("EXIT, returning -ENOMEMn");
  1110. return -ENOMEM;
  1112. }
  1114. tp->full_duplex = tp->duplex_lock;
  1115. tp->tx_flag = (TX_FIFO_THRESH << 11) & 0x003f0000;
  1117. netdrv_init_ring (dev);
  1118. netdrv_hw_start (dev);
  1120. DPRINTK ("%s: netdrv_open() ioaddr %#lx IRQ %d"
  1121. " GP Pins %2.2x %s-duplex.n",
  1122. dev->name, pci_resource_start (tp->pci_dev, 1),
  1123. dev->irq, NETDRV_R8 (MediaStatus),
  1124. tp->full_duplex ? "full" : "half");
  1126. /* Set the timer to switch to check for link beat and perhaps switch
  1127.    to an alternate media type. */
  1128. init_timer (&tp->timer);
  1129. tp->timer.expires = jiffies + 3 * HZ;
  1130. tp->timer.data = (unsigned long) dev;
  1131. tp->timer.function = &netdrv_timer;
  1132. add_timer (&tp->timer);
  1134. DPRINTK ("EXIT, returning 0n");
  1135. return 0;
  1136. }
  1139. /* Start the hardware at open or resume. */
  1140. static void netdrv_hw_start (struct net_device *dev)
  1141. {
  1142. struct netdrv_private *tp = dev->priv;
  1143. void *ioaddr = tp->mmio_addr;
  1144. u32 i;
  1145. u8 tmp;
  1147. DPRINTK ("ENTERn");
  1149. /* Soft reset the chip. */
  1150. NETDRV_W8 (ChipCmd, (NETDRV_R8 (ChipCmd) & ChipCmdClear) | CmdReset);
  1151. udelay (100);
  1153. /* Check that the chip has finished the reset. */
  1154. for (i = 1000; i > 0; i--)
  1155. if ((NETDRV_R8 (ChipCmd) & CmdReset) == 0)
  1156. break;
  1158. /* Restore our idea of the MAC address. */
  1159. NETDRV_W32_F (MAC0 + 0, cpu_to_le32 (*(u32 *) (dev->dev_addr + 0)));
  1160. NETDRV_W32_F (MAC0 + 4, cpu_to_le32 (*(u32 *) (dev->dev_addr + 4)));
  1162. /* Must enable Tx/Rx before setting transfer thresholds! */
  1163. NETDRV_W8_F (ChipCmd, (NETDRV_R8 (ChipCmd) & ChipCmdClear) |
  1164.    CmdRxEnb | CmdTxEnb);
  1166. i = netdrv_rx_config |
  1167.     (NETDRV_R32 (RxConfig) & rtl_chip_info[tp->chipset].RxConfigMask);
  1168. NETDRV_W32_F (RxConfig, i);
  1170. /* Check this value: the documentation for IFG contradicts ifself. */
  1171. NETDRV_W32 (TxConfig, (TX_DMA_BURST << TxDMAShift));
  1173. /* unlock Config[01234] and BMCR register writes */
  1174. NETDRV_W8_F (Cfg9346, Cfg9346_Unlock);
  1175. udelay (10);
  1177. tp->cur_rx = 0;
  1179. /* Lock Config[01234] and BMCR register writes */
  1180. NETDRV_W8_F (Cfg9346, Cfg9346_Lock);
  1181. udelay (10);
  1183. /* init Rx ring buffer DMA address */
  1184. NETDRV_W32_F (RxBuf, tp->rx_ring_dma);
  1186. /* init Tx buffer DMA addresses */
  1187. for (i = 0; i < NUM_TX_DESC; i++)
  1188. NETDRV_W32_F (TxAddr0 + (i * 4), tp->tx_bufs_dma + (tp->tx_buf[i] - tp->tx_bufs));
  1190. NETDRV_W32_F (RxMissed, 0);
  1192. netdrv_set_rx_mode (dev);
  1194. /* no early-rx interrupts */
  1195. NETDRV_W16 (MultiIntr, NETDRV_R16 (MultiIntr) & MultiIntrClear);
  1197. /* make sure RxTx has started */
  1198. NETDRV_W8_F (ChipCmd, (NETDRV_R8 (ChipCmd) & ChipCmdClear) |
  1199.    CmdRxEnb | CmdTxEnb);
  1201. /* Enable all known interrupts by setting the interrupt mask. */
  1202. NETDRV_W16_F (IntrMask, netdrv_intr_mask);
  1204. netif_start_queue (dev);
  1206. DPRINTK ("EXITn");
  1207. }
  1210. /* Initialize the Rx and Tx rings, along with various 'dev' bits. */
  1211. static void netdrv_init_ring (struct net_device *dev)
  1212. {
  1213. struct netdrv_private *tp = dev->priv;
  1214. int i;
  1216. DPRINTK ("ENTERn");
  1218. tp->cur_rx = 0;
  1219. atomic_set (&tp->cur_tx, 0);
  1220. atomic_set (&tp->dirty_tx, 0);
  1222. for (i = 0; i < NUM_TX_DESC; i++) {
  1223. tp->tx_info[i].skb = NULL;
  1224. tp->tx_info[i].mapping = 0;
  1225. tp->tx_buf[i] = &tp->tx_bufs[i * TX_BUF_SIZE];
  1226. }
  1228. DPRINTK ("EXITn");
  1229. }
  1232. static void netdrv_timer (unsigned long data)
  1233. {
  1234. struct net_device *dev = (struct net_device *) data;
  1235. struct netdrv_private *tp = dev->priv;
  1236. void *ioaddr = tp->mmio_addr;
  1237. int next_tick = 60 * HZ;
  1238. int mii_lpa;
  1240. mii_lpa = mdio_read (dev, tp->phys[0], MII_LPA);
  1242. if (!tp->duplex_lock && mii_lpa != 0xffff) {
  1243. int duplex = (mii_lpa & LPA_100FULL)
  1244.     || (mii_lpa & 0x01C0) == 0x0040;
  1245. if (tp->full_duplex != duplex) {
  1246. tp->full_duplex = duplex;
  1247. printk (KERN_INFO
  1248. "%s: Setting %s-duplex based on MII #%d link"
  1249. " partner ability of %4.4x.n", dev->name,
  1250. tp->full_duplex ? "full" : "half",
  1251. tp->phys[0], mii_lpa);
  1252. NETDRV_W8 (Cfg9346, Cfg9346_Unlock);
  1253. NETDRV_W8 (Config1, tp->full_duplex ? 0x60 : 0x20);
  1254. NETDRV_W8 (Cfg9346, Cfg9346_Lock);
  1255. }
  1256. }
  1258. DPRINTK ("%s: Media selection tick, Link partner %4.4x.n",
  1259.  dev->name, NETDRV_R16 (NWayLPAR));
  1260. DPRINTK ("%s:  Other registers are IntMask %4.4x IntStatus %4.4x"
  1261.  " RxStatus %4.4x.n", dev->name,
  1262.  NETDRV_R16 (IntrMask),
  1263.  NETDRV_R16 (IntrStatus),
  1264.  NETDRV_R32 (RxEarlyStatus));
  1265. DPRINTK ("%s:  Chip config %2.2x %2.2x.n",
  1266.  dev->name, NETDRV_R8 (Config0),
  1267.  NETDRV_R8 (Config1));
  1269. tp->timer.expires = jiffies + next_tick;
  1270. add_timer (&tp->timer);
  1271. }
  1274. static void netdrv_tx_clear (struct netdrv_private *tp)
  1275. {
  1276. int i;
  1278. atomic_set (&tp->cur_tx, 0);
  1279. atomic_set (&tp->dirty_tx, 0);
  1281. /* Dump the unsent Tx packets. */
  1282. for (i = 0; i < NUM_TX_DESC; i++) {
  1283. struct ring_info *rp = &tp->tx_info[i];
  1284. if (rp->mapping != 0) {
  1285. pci_unmap_single (tp->pci_dev, rp->mapping,
  1286.   rp->skb->len, PCI_DMA_TODEVICE);
  1287. rp->mapping = 0;
  1288. }
  1289. if (rp->skb) {
  1290. dev_kfree_skb (rp->skb);
  1291. rp->skb = NULL;
  1292. tp->stats.tx_dropped++;
  1293. }
  1294. }
  1295. }
  1298. static void netdrv_tx_timeout (struct net_device *dev)
  1299. {
  1300. struct netdrv_private *tp = dev->priv;
  1301. void *ioaddr = tp->mmio_addr;
  1302. int i;
  1303. u8 tmp8;
  1304. unsigned long flags;
  1306. DPRINTK ("%s: Transmit timeout, status %2.2x %4.4x "
  1307.  "media %2.2x.n", dev->name,
  1308.  NETDRV_R8 (ChipCmd),
  1309.  NETDRV_R16 (IntrStatus),
  1310.  NETDRV_R8 (MediaStatus));
  1312. /* disable Tx ASAP, if not already */
  1313. tmp8 = NETDRV_R8 (ChipCmd);
  1314. if (tmp8 & CmdTxEnb)
  1315. NETDRV_W8 (ChipCmd, tmp8 & ~CmdTxEnb);
  1317. /* Disable interrupts by clearing the interrupt mask. */
  1318. NETDRV_W16 (IntrMask, 0x0000);
  1320. /* Emit info to figure out what went wrong. */
  1321. printk (KERN_DEBUG "%s: Tx queue start entry %d  dirty entry %d.n",
  1322. dev->name, atomic_read (&tp->cur_tx),
  1323. atomic_read (&tp->dirty_tx));
  1324. for (i = 0; i < NUM_TX_DESC; i++)
  1325. printk (KERN_DEBUG "%s:  Tx descriptor %d is %8.8lx.%sn",
  1326. dev->name, i, NETDRV_R32 (TxStatus0 + (i * 4)),
  1327. i == atomic_read (&tp->dirty_tx) % NUM_TX_DESC ?
  1328. " (queue head)" : "");
  1330. /* Stop a shared interrupt from scavenging while we are. */
  1331. spin_lock_irqsave (&tp->lock, flags);
  1333. netdrv_tx_clear (tp);
  1335. spin_unlock_irqrestore (&tp->lock, flags);
  1337. /* ...and finally, reset everything */
  1338. netdrv_hw_start (dev);
  1340. netif_wake_queue (dev);
  1341. }
  1345. static int netdrv_start_xmit (struct sk_buff *skb, struct net_device *dev)
  1346. {
  1347. struct netdrv_private *tp = dev->priv;
  1348. void *ioaddr = tp->mmio_addr;
  1349. int entry;
  1351. /* Calculate the next Tx descriptor entry. */
  1352. entry = atomic_read (&tp->cur_tx) % NUM_TX_DESC;
  1354. assert (tp->tx_info[entry].skb == NULL);
  1355. assert (tp->tx_info[entry].mapping == 0);
  1357. tp->tx_info[entry].skb = skb;
  1358. /* tp->tx_info[entry].mapping = 0; */
  1359. memcpy (tp->tx_buf[entry], skb->data, skb->len);
  1361. /* Note: the chip doesn't have auto-pad! */
  1362. NETDRV_W32 (TxStatus0 + (entry * sizeof(u32)),
  1363.  tp->tx_flag | (skb->len >= ETH_ZLEN ? skb->len : ETH_ZLEN));
  1365. dev->trans_start = jiffies;
  1366. atomic_inc (&tp->cur_tx);
  1367. if ((atomic_read (&tp->cur_tx) - atomic_read (&tp->dirty_tx)) >= NUM_TX_DESC)
  1368. netif_stop_queue (dev);
  1370. DPRINTK ("%s: Queued Tx packet at %p size %u to slot %d.n",
  1371.  dev->name, skb->data, skb->len, entry);
  1373. return 0;
  1374. }
  1377. static void netdrv_tx_interrupt (struct net_device *dev,
  1378.   struct netdrv_private *tp,
  1379.   void *ioaddr)
  1380. {
  1381. int cur_tx, dirty_tx, tx_left;
  1383. assert (dev != NULL);
  1384. assert (tp != NULL);
  1385. assert (ioaddr != NULL);
  1387. dirty_tx = atomic_read (&tp->dirty_tx);
  1389. cur_tx = atomic_read (&tp->cur_tx);
  1390. tx_left = cur_tx - dirty_tx;
  1391. while (tx_left > 0) {
  1392. int entry = dirty_tx % NUM_TX_DESC;
  1393. int txstatus;
  1395. txstatus = NETDRV_R32 (TxStatus0 + (entry * sizeof (u32)));
  1397. if (!(txstatus & (TxStatOK | TxUnderrun | TxAborted)))
  1398. break; /* It still hasn't been Txed */
  1400. /* Note: TxCarrierLost is always asserted at 100mbps. */
  1401. if (txstatus & (TxOutOfWindow | TxAborted)) {
  1402. /* There was an major error, log it. */
  1403. DPRINTK ("%s: Transmit error, Tx status %8.8x.n",
  1404.  dev->name, txstatus);
  1405. tp->stats.tx_errors++;
  1406. if (txstatus & TxAborted) {
  1407. tp->stats.tx_aborted_errors++;
  1408. NETDRV_W32 (TxConfig, TxClearAbt | (TX_DMA_BURST << TxDMAShift));
  1409. }
  1410. if (txstatus & TxCarrierLost)
  1411. tp->stats.tx_carrier_errors++;
  1412. if (txstatus & TxOutOfWindow)
  1413. tp->stats.tx_window_errors++;
  1414. #ifdef ETHER_STATS
  1415. if ((txstatus & 0x0f000000) == 0x0f000000)
  1416. tp->stats.collisions16++;
  1417. #endif
  1418. } else {
  1419. if (txstatus & TxUnderrun) {
  1420. /* Add 64 to the Tx FIFO threshold. */
  1421. if (tp->tx_flag < 0x00300000)
  1422. tp->tx_flag += 0x00020000;
  1423. tp->stats.tx_fifo_errors++;
  1424. }
  1425. tp->stats.collisions += (txstatus >> 24) & 15;
  1426. tp->stats.tx_bytes += txstatus & 0x7ff;
  1427. tp->stats.tx_packets++;
  1428. }
  1430. /* Free the original skb. */
  1431. if (tp->tx_info[entry].mapping != 0) {
  1432. pci_unmap_single(tp->pci_dev,
  1433.  tp->tx_info[entry].mapping,
  1434.  tp->tx_info[entry].skb->len,
  1435.  PCI_DMA_TODEVICE);
  1436. tp->tx_info[entry].mapping = 0;
  1437. }
  1438. dev_kfree_skb_irq (tp->tx_info[entry].skb);
  1439. tp->tx_info[entry].skb = NULL;
  1440. dirty_tx++;
  1441. if (dirty_tx < 0) { /* handle signed int overflow */
  1442. atomic_sub (cur_tx, &tp->cur_tx); /* XXX racy? */
  1443. dirty_tx = cur_tx - tx_left + 1;
  1444. }
  1445. if (netif_queue_stopped (dev))
  1446. netif_wake_queue (dev);
  1448. cur_tx = atomic_read (&tp->cur_tx);
  1449. tx_left = cur_tx - dirty_tx;
  1451. }
  1453. #ifndef NETDRV_NDEBUG
  1454. if (atomic_read (&tp->cur_tx) - dirty_tx > NUM_TX_DESC) {
  1455. printk (KERN_ERR
  1456.   "%s: Out-of-sync dirty pointer, %d vs. %d.n",
  1457.      dev->name, dirty_tx, atomic_read (&tp->cur_tx));
  1458. dirty_tx += NUM_TX_DESC;
  1459. }
  1460. #endif /* NETDRV_NDEBUG */
  1462. atomic_set (&tp->dirty_tx, dirty_tx);
  1463. }
  1466. /* TODO: clean this up!  Rx reset need not be this intensive */
  1467. static void netdrv_rx_err (u32 rx_status, struct net_device *dev,
  1468.     struct netdrv_private *tp, void *ioaddr)
  1469. {
  1470. u8 tmp8;
  1471. int tmp_work = 1000;
  1473. DPRINTK ("%s: Ethernet frame had errors, status %8.8x.n",
  1474.          dev->name, rx_status);
  1475. if (rx_status & RxTooLong) {
  1476. DPRINTK ("%s: Oversized Ethernet frame, status %4.4x!n",
  1477.  dev->name, rx_status);
  1478. /* A.C.: The chip hangs here. */
  1479. }
  1480. tp->stats.rx_errors++;
  1481. if (rx_status & (RxBadSymbol | RxBadAlign))
  1482. tp->stats.rx_frame_errors++;
  1483. if (rx_status & (RxRunt | RxTooLong))
  1484. tp->stats.rx_length_errors++;
  1485. if (rx_status & RxCRCErr)
  1486. tp->stats.rx_crc_errors++;
  1487. /* Reset the receiver, based on RealTek recommendation. (Bug?) */
  1488. tp->cur_rx = 0;
  1490. /* disable receive */
  1491. tmp8 = NETDRV_R8 (ChipCmd) & ChipCmdClear;
  1492. NETDRV_W8_F (ChipCmd, tmp8 | CmdTxEnb);
  1494. /* A.C.: Reset the multicast list. */
  1495. netdrv_set_rx_mode (dev);
  1497. /* XXX potentially temporary hack to
  1498.  * restart hung receiver */
  1499. while (--tmp_work > 0) {
  1500. tmp8 = NETDRV_R8 (ChipCmd);
  1501. if ((tmp8 & CmdRxEnb) && (tmp8 & CmdTxEnb))
  1502. break;
  1503. NETDRV_W8_F (ChipCmd,
  1504.   (tmp8 & ChipCmdClear) | CmdRxEnb | CmdTxEnb);
  1505. }
  1507. /* G.S.: Re-enable receiver */
  1508. /* XXX temporary hack to work around receiver hang */
  1509. netdrv_set_rx_mode (dev);
  1511. if (tmp_work <= 0)
  1512. printk (KERN_WARNING PFX "tx/rx enable wait too longn");
  1513. }
  1516. /* The data sheet doesn't describe the Rx ring at all, so I'm guessing at the
  1517.    field alignments and semantics. */
  1518. static void netdrv_rx_interrupt (struct net_device *dev,
  1519.   struct netdrv_private *tp, void *ioaddr)
  1520. {
  1521. unsigned char *rx_ring;
  1522. u16 cur_rx;
  1524. assert (dev != NULL);
  1525. assert (tp != NULL);
  1526. assert (ioaddr != NULL);
  1528. rx_ring = tp->rx_ring;
  1529. cur_rx = tp->cur_rx;
  1531. DPRINTK ("%s: In netdrv_rx(), current %4.4x BufAddr %4.4x,"
  1532.  " free to %4.4x, Cmd %2.2x.n", dev->name, cur_rx,
  1533.  NETDRV_R16 (RxBufAddr),
  1534.  NETDRV_R16 (RxBufPtr), NETDRV_R8 (ChipCmd));
  1536. while ((NETDRV_R8 (ChipCmd) & RxBufEmpty) == 0) {
  1537. int ring_offset = cur_rx % RX_BUF_LEN;
  1538. u32 rx_status;
  1539. unsigned int rx_size;
  1540. unsigned int pkt_size;
  1541. struct sk_buff *skb;
  1543. /* read size+status of next frame from DMA ring buffer */
  1544. rx_status = le32_to_cpu (*(u32 *) (rx_ring + ring_offset));
  1545. rx_size = rx_status >> 16;
  1546. pkt_size = rx_size - 4;
  1548. DPRINTK ("%s:  netdrv_rx() status %4.4x, size %4.4x,"
  1549.  " cur %4.4x.n", dev->name, rx_status,
  1550.  rx_size, cur_rx);
  1551. #if NETDRV_DEBUG > 2
  1552. {
  1553. int i;
  1554. DPRINTK ("%s: Frame contents ", dev->name);
  1555. for (i = 0; i < 70; i++)
  1556. printk (" %2.2x",
  1557. rx_ring[ring_offset + i]);
  1558. printk (".n");
  1559. }
  1560. #endif
  1562. /* If Rx err or invalid rx_size/rx_status received
  1563.  * (which happens if we get lost in the ring),
  1564.  * Rx process gets reset, so we abort any further
  1565.  * Rx processing.
  1566.  */
  1567. if ((rx_size > (MAX_ETH_FRAME_SIZE+4)) ||
  1568.     (!(rx_status & RxStatusOK))) {
  1569. netdrv_rx_err (rx_status, dev, tp, ioaddr);
  1570. return;
  1571. }
  1573. /* Malloc up new buffer, compatible with net-2e. */
  1574. /* Omit the four octet CRC from the length. */
  1576. /* TODO: consider allocating skb's outside of
  1577.  * interrupt context, both to speed interrupt processing,
  1578.  * and also to reduce the chances of having to
  1579.  * drop packets here under memory pressure.
  1580.  */
  1582. skb = dev_alloc_skb (pkt_size + 2);
  1583. if (skb) {
  1584. skb->dev = dev;
  1585. skb_reserve (skb, 2); /* 16 byte align the IP fields. */
  1587. eth_copy_and_sum (skb, &rx_ring[ring_offset + 4], pkt_size, 0);
  1588. skb_put (skb, pkt_size);
  1590. skb->protocol = eth_type_trans (skb, dev);
  1591. netif_rx (skb);
  1592. dev->last_rx = jiffies;
  1593. tp->stats.rx_bytes += pkt_size;
  1594. tp->stats.rx_packets++;
  1595. } else {
  1596. printk (KERN_WARNING
  1597. "%s: Memory squeeze, dropping packet.n",
  1598. dev->name);
  1599. tp->stats.rx_dropped++;
  1600. }
  1602. cur_rx = (cur_rx + rx_size + 4 + 3) & ~3;
  1603. NETDRV_W16_F (RxBufPtr, cur_rx - 16);
  1604. }
  1606. DPRINTK ("%s: Done netdrv_rx(), current %4.4x BufAddr %4.4x,"
  1607.  " free to %4.4x, Cmd %2.2x.n", dev->name, cur_rx,
  1608.  NETDRV_R16 (RxBufAddr),
  1609.  NETDRV_R16 (RxBufPtr), NETDRV_R8 (ChipCmd));
  1611. tp->cur_rx = cur_rx;
  1612. }
  1615. static void netdrv_weird_interrupt (struct net_device *dev,
  1616.      struct netdrv_private *tp,
  1617.      void *ioaddr,
  1618.      int status, int link_changed)
  1619. {
  1620. printk (KERN_DEBUG "%s: Abnormal interrupt, status %8.8x.n",
  1621. dev->name, status);
  1623. assert (dev != NULL);
  1624. assert (tp != NULL);
  1625. assert (ioaddr != NULL);
  1627. /* Update the error count. */
  1628. tp->stats.rx_missed_errors += NETDRV_R32 (RxMissed);
  1629. NETDRV_W32 (RxMissed, 0);
  1631. if ((status & RxUnderrun) && link_changed &&
  1632.     (tp->drv_flags & HAS_LNK_CHNG)) {
  1633. /* Really link-change on new chips. */
  1634. int lpar = NETDRV_R16 (NWayLPAR);
  1635. int duplex = (lpar & 0x0100) || (lpar & 0x01C0) == 0x0040
  1636. || tp->duplex_lock;
  1637. if (tp->full_duplex != duplex) {
  1638. tp->full_duplex = duplex;
  1639. NETDRV_W8 (Cfg9346, Cfg9346_Unlock);
  1640. NETDRV_W8 (Config1, tp->full_duplex ? 0x60 : 0x20);
  1641. NETDRV_W8 (Cfg9346, Cfg9346_Lock);
  1642. }
  1643. status &= ~RxUnderrun;
  1644. }
  1646. /* XXX along with netdrv_rx_err, are we double-counting errors? */
  1647. if (status &
  1648.     (RxUnderrun | RxOverflow | RxErr | RxFIFOOver))
  1649. tp->stats.rx_errors++;
  1651. if (status & (PCSTimeout))
  1652. tp->stats.rx_length_errors++;
  1653. if (status & (RxUnderrun | RxFIFOOver))
  1654. tp->stats.rx_fifo_errors++;
  1655. if (status & RxOverflow) {
  1656. tp->stats.rx_over_errors++;
  1657. tp->cur_rx = NETDRV_R16 (RxBufAddr) % RX_BUF_LEN;
  1658. NETDRV_W16_F (RxBufPtr, tp->cur_rx - 16);
  1659. }
  1660. if (status & PCIErr) {
  1661. u16 pci_cmd_status;
  1662. pci_read_config_word (tp->pci_dev, PCI_STATUS, &pci_cmd_status);
  1664. printk (KERN_ERR "%s: PCI Bus error %4.4x.n",
  1665. dev->name, pci_cmd_status);
  1666. }
  1667. }
  1670. /* The interrupt handler does all of the Rx thread work and cleans up
  1671.    after the Tx thread. */
  1672. static void netdrv_interrupt (int irq, void *dev_instance,
  1673.        struct pt_regs *regs)
  1674. {
  1675. struct net_device *dev = (struct net_device *) dev_instance;
  1676. struct netdrv_private *tp = dev->priv;
  1677. int boguscnt = max_interrupt_work;
  1678. void *ioaddr = tp->mmio_addr;
  1679. int status = 0, link_changed = 0; /* avoid bogus "uninit" warning */
  1681. spin_lock (&tp->lock);
  1683. do {
  1684. status = NETDRV_R16 (IntrStatus);
  1686. /* h/w no longer present (hotplug?) or major error, bail */
  1687. if (status == 0xFFFF)
  1688. break;
  1690. /* Acknowledge all of the current interrupt sources ASAP */
  1691. NETDRV_W16_F (IntrStatus, status);
  1693. DPRINTK ("%s: interrupt  status=%#4.4x new intstat=%#4.4x.n",
  1694. dev->name, status,
  1695. NETDRV_R16 (IntrStatus));
  1697. if ((status &
  1698.      (PCIErr | PCSTimeout | RxUnderrun | RxOverflow |
  1699.       RxFIFOOver | TxErr | TxOK | RxErr | RxOK)) == 0)
  1700. break;
  1702. /* Check uncommon events with one test. */
  1703. if (status & (PCIErr | PCSTimeout | RxUnderrun | RxOverflow |
  1704.          RxFIFOOver | TxErr | RxErr))
  1705. netdrv_weird_interrupt (dev, tp, ioaddr,
  1706.  status, link_changed);
  1708. if (status & (RxOK | RxUnderrun | RxOverflow | RxFIFOOver)) /* Rx interrupt */
  1709. netdrv_rx_interrupt (dev, tp, ioaddr);
  1711. if (status & (TxOK | TxErr))
  1712. netdrv_tx_interrupt (dev, tp, ioaddr);
  1714. boguscnt--;
  1715. } while (boguscnt > 0);
  1717. if (boguscnt <= 0) {
  1718. printk (KERN_WARNING
  1719. "%s: Too much work at interrupt, "
  1720. "IntrStatus=0x%4.4x.n", dev->name,
  1721. status);
  1723. /* Clear all interrupt sources. */
  1724. NETDRV_W16 (IntrStatus, 0xffff);
  1725. }
  1727. spin_unlock (&tp->lock);
  1729. DPRINTK ("%s: exiting interrupt, intr_status=%#4.4x.n",
  1730.  dev->name, NETDRV_R16 (IntrStatus));
  1731. }
  1734. static int netdrv_close (struct net_device *dev)
  1735. {
  1736. struct netdrv_private *tp = dev->priv;
  1737. void *ioaddr = tp->mmio_addr;
  1738. unsigned long flags;
  1740. DPRINTK ("ENTERn");
  1742. netif_stop_queue (dev);
  1744. DPRINTK ("%s: Shutting down ethercard, status was 0x%4.4x.n",
  1745. dev->name, NETDRV_R16 (IntrStatus));
  1747. del_timer_sync (&tp->timer);
  1749. spin_lock_irqsave (&tp->lock, flags);
  1751. /* Stop the chip's Tx and Rx DMA processes. */
  1752. NETDRV_W8 (ChipCmd, (NETDRV_R8 (ChipCmd) & ChipCmdClear));
  1754. /* Disable interrupts by clearing the interrupt mask. */
  1755. NETDRV_W16 (IntrMask, 0x0000);
  1757. /* Update the error counts. */
  1758. tp->stats.rx_missed_errors += NETDRV_R32 (RxMissed);
  1759. NETDRV_W32 (RxMissed, 0);
  1761. spin_unlock_irqrestore (&tp->lock, flags);
  1763. synchronize_irq ();
  1764. free_irq (dev->irq, dev);
  1766. netdrv_tx_clear (tp);
  1768. pci_free_consistent(tp->pci_dev, RX_BUF_TOT_LEN,
  1769.     tp->rx_ring, tp->rx_ring_dma);
  1770. pci_free_consistent(tp->pci_dev, TX_BUF_TOT_LEN,
  1771.     tp->tx_bufs, tp->tx_bufs_dma);
  1772. tp->rx_ring = NULL;
  1773. tp->tx_bufs = NULL;
  1775. /* Green! Put the chip in low-power mode. */
  1776. NETDRV_W8 (Cfg9346, Cfg9346_Unlock);
  1777. NETDRV_W8 (Config1, 0x03);
  1778. NETDRV_W8 (Cfg9346, Cfg9346_Lock);
  1780. DPRINTK ("EXITn");
  1781. return 0;
  1782. }
  1785. static int netdrv_ioctl (struct net_device *dev, struct ifreq *rq, int cmd)
  1786. {
  1787. struct netdrv_private *tp = dev->priv;
  1788. struct mii_ioctl_data *data = (struct mii_ioctl_data *) & rq->ifr_data;
  1789. unsigned long flags;
  1790. int rc = 0;
  1792. DPRINTK ("ENTERn");
  1794. switch (cmd) {
  1795. case SIOCGMIIPHY: /* Get address of MII PHY in use. */
  1796. case SIOCDEVPRIVATE: /* for binary compat, remove in 2.5 */
  1797. data->phy_id = tp->phys[0] & 0x3f;
  1798. /* Fall Through */
  1800. case SIOCGMIIREG: /* Read MII PHY register. */
  1801. case SIOCDEVPRIVATE+1: /* for binary compat, remove in 2.5 */
  1802. spin_lock_irqsave (&tp->lock, flags);
  1803. data->val_out = mdio_read (dev, data->phy_id & 0x1f, data->reg_num & 0x1f);
  1804. spin_unlock_irqrestore (&tp->lock, flags);
  1805. break;
  1807. case SIOCSMIIREG: /* Write MII PHY register. */
  1808. case SIOCDEVPRIVATE+2: /* for binary compat, remove in 2.5 */
  1809. if (!capable (CAP_NET_ADMIN)) {
  1810. rc = -EPERM;
  1811. break;
  1812. }
  1814. spin_lock_irqsave (&tp->lock, flags);
  1815. mdio_write (dev, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in);
  1816. spin_unlock_irqrestore (&tp->lock, flags);
  1817. break;
  1819. default:
  1820. rc = -EOPNOTSUPP;
  1821. break;
  1822. }
  1824. DPRINTK ("EXIT, returning %dn", rc);
  1825. return rc;
  1826. }
  1829. static struct net_device_stats *netdrv_get_stats (struct net_device *dev)
  1830. {
  1831. struct netdrv_private *tp = dev->priv;
  1832. void *ioaddr = tp->mmio_addr;
  1834. DPRINTK ("ENTERn");
  1836. assert (tp != NULL);
  1838. if (netif_running(dev)) {
  1839. unsigned long flags;
  1841. spin_lock_irqsave (&tp->lock, flags);
  1843. tp->stats.rx_missed_errors += NETDRV_R32 (RxMissed);
  1844. NETDRV_W32 (RxMissed, 0);
  1846. spin_unlock_irqrestore (&tp->lock, flags);
  1847. }
  1849. DPRINTK ("EXITn");
  1850. return &tp->stats;
  1851. }
  1853. /* Set or clear the multicast filter for this adaptor.
  1854.    This routine is not state sensitive and need not be SMP locked. */
  1856. static unsigned const ethernet_polynomial = 0x04c11db7U;
  1857. static inline u32 ether_crc (int length, unsigned char *data)
  1858. {
  1859. int crc = -1;
  1861. DPRINTK ("ENTERn");
  1863. while (--length >= 0) {
  1864. unsigned char current_octet = *data++;
  1865. int bit;
  1866. for (bit = 0; bit < 8; bit++, current_octet >>= 1)
  1867. crc = (crc << 1) ^
  1868.     ((crc < 0) ^ (current_octet & 1) ?
  1869.      ethernet_polynomial : 0);
  1870. }
  1872. DPRINTK ("EXITn");
  1873. return crc;
  1874. }
  1877. static void netdrv_set_rx_mode (struct net_device *dev)
  1878. {
  1879. struct netdrv_private *tp = dev->priv;
  1880. void *ioaddr = tp->mmio_addr;
  1881. u32 mc_filter[2]; /* Multicast hash filter */
  1882. int i, rx_mode;
  1883. u32 tmp;
  1885. DPRINTK ("ENTERn");
  1887. DPRINTK ("%s:   netdrv_set_rx_mode(%4.4x) done -- Rx config %8.8x.n",
  1888. dev->name, dev->flags, NETDRV_R32 (RxConfig));
  1890. /* Note: do not reorder, GCC is clever about common statements. */
  1891. if (dev->flags & IFF_PROMISC) {
  1892. /* Unconditionally log net taps. */
  1893. printk (KERN_NOTICE "%s: Promiscuous mode enabled.n",
  1894. dev->name);
  1895. rx_mode =
  1896.     AcceptBroadcast | AcceptMulticast | AcceptMyPhys |
  1897.     AcceptAllPhys;
  1898. mc_filter[1] = mc_filter[0] = 0xffffffff;
  1899. } else if ((dev->mc_count > multicast_filter_limit)
  1900.    || (dev->flags & IFF_ALLMULTI)) {
  1901. /* Too many to filter perfectly -- accept all multicasts. */
  1902. rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys;
  1903. mc_filter[1] = mc_filter[0] = 0xffffffff;
  1904. } else {
  1905. struct dev_mc_list *mclist;
  1906. rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys;
  1907. mc_filter[1] = mc_filter[0] = 0;
  1908. for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
  1909.      i++, mclist = mclist->next)
  1910. set_bit (ether_crc (ETH_ALEN, mclist->dmi_addr) >> 26,
  1911.  mc_filter);
  1912. }
  1914. /* if called from irq handler, lock already acquired */
  1915. if (!in_irq ())
  1916. spin_lock_irq (&tp->lock);
  1918. /* We can safely update without stopping the chip. */
  1919. tmp = netdrv_rx_config | rx_mode |
  1920. (NETDRV_R32 (RxConfig) & rtl_chip_info[tp->chipset].RxConfigMask);
  1921. NETDRV_W32_F (RxConfig, tmp);
  1922. NETDRV_W32_F (MAR0 + 0, mc_filter[0]);
  1923. NETDRV_W32_F (MAR0 + 4, mc_filter[1]);
  1925. if (!in_irq ())
  1926. spin_unlock_irq (&tp->lock);
  1928. DPRINTK ("EXITn");
  1929. }
  1932. #ifdef CONFIG_PM
  1934. static int netdrv_suspend (struct pci_dev *pdev, u32 state)
  1935. {
  1936. struct net_device *dev = pci_get_drvdata (pdev);
  1937. struct netdrv_private *tp = dev->priv;
  1938. void *ioaddr = tp->mmio_addr;
  1939. unsigned long flags;
  1941. if (!netif_running(dev))
  1942. return;
  1943. netif_device_detach (dev);
  1945. spin_lock_irqsave (&tp->lock, flags);
  1947. /* Disable interrupts, stop Tx and Rx. */
  1948. NETDRV_W16 (IntrMask, 0x0000);
  1949. NETDRV_W8 (ChipCmd, (NETDRV_R8 (ChipCmd) & ChipCmdClear));
  1951. /* Update the error counts. */
  1952. tp->stats.rx_missed_errors += NETDRV_R32 (RxMissed);
  1953. NETDRV_W32 (RxMissed, 0);
  1955. spin_unlock_irqrestore (&tp->lock, flags);
  1957. pci_power_off (pdev, -1);
  1959. return 0;
  1960. }
  1963. static int netdrv_resume (struct pci_dev *pdev)
  1964. {
  1965. struct net_device *dev = pci_get_drvdata (pdev);
  1967. if (!netif_running(dev))
  1968. return;
  1969. pci_power_on (pdev);
  1970. netif_device_attach (dev);
  1971. netdrv_hw_start (dev);
  1973. return 0;
  1974. }
  1976. #endif /* CONFIG_PM */
  1979. static struct pci_driver netdrv_pci_driver = {
  1980. name: MODNAME,
  1981. id_table: netdrv_pci_tbl,
  1982. probe: netdrv_init_one,
  1983. remove: __devexit_p(netdrv_remove_one),
  1984. #ifdef CONFIG_PM
  1985. suspend: netdrv_suspend,
  1986. resume: netdrv_resume,
  1987. #endif /* CONFIG_PM */
  1988. };
  1991. static int __init netdrv_init_module (void)
  1992. {
  1993. /* when a module, this is printed whether or not devices are found in probe */
  1994. #ifdef MODULE
  1995. printk(version);
  1996. #endif
  1997. return pci_module_init (&netdrv_pci_driver);
  1998. }
  2001. static void __exit netdrv_cleanup_module (void)
  2002. {
  2003. pci_unregister_driver (&netdrv_pci_driver);
  2004. }
  2007. module_init(netdrv_init_module);
  2008. module_exit(netdrv_cleanup_module);