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

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.     A Davicom DM9102/DM9102A/DM9102A+DM9801/DM9102A+DM9802 NIC fast
  3.     ethernet driver for Linux.
  4.     Copyright (C) 1997  Sten Wang
  5.     This program is free software; you can redistribute it and/or
  6.     modify it under the terms of the GNU General Public License
  7.     as published by the Free Software Foundation; either version 2
  8.     of the License, or (at your option) any later version.
  9.     This program is distributed in the hope that it will be useful,
  10.     but WITHOUT ANY WARRANTY; without even the implied warranty of
  11.     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12.     GNU General Public License for more details.
  13.     DAVICOM Web-Site: www.davicom.com.tw
  14.     Author: Sten Wang, 886-3-5798797-8517, E-mail: sten_wang@davicom.com.tw
  15.     Maintainer: Tobias Ringstrom <tori@unhappy.mine.nu>
  16.     (C)Copyright 1997-1998 DAVICOM Semiconductor,Inc. All Rights Reserved.
  17.     Marcelo Tosatti <marcelo@conectiva.com.br> :
  18.     Made it compile in 2.3 (device to net_device)
  19.     Alan Cox <alan@redhat.com> :
  20.     Cleaned up for kernel merge.
  21.     Removed the back compatibility support
  22.     Reformatted, fixing spelling etc as I went
  23.     Removed IRQ 0-15 assumption
  24.     Jeff Garzik <jgarzik@mandrakesoft.com> :
  25.     Updated to use new PCI driver API.
  26.     Resource usage cleanups.
  27.     Report driver version to user.
  28.     Tobias Ringstrom <tori@unhappy.mine.nu> :
  29.     Cleaned up and added SMP safety.  Thanks go to Jeff Garzik,
  30.     Andrew Morton and Frank Davis for the SMP safety fixes.
  31.     Vojtech Pavlik <vojtech@suse.cz> :
  32.     Cleaned up pointer arithmetics.
  33.     Fixed a lot of 64bit issues.
  34.     Cleaned up printk()s a bit.
  35.     Fixed some obvious big endian problems.
  36.     Tobias Ringstrom <tori@unhappy.mine.nu> :
  37.     Use time_after for jiffies calculation.  Added ethtool
  38.     support.  Updated PCI resource allocation.  Do not
  39.     forget to unmap PCI mapped skbs.
  40.     TODO
  41.     Implement pci_driver::suspend() and pci_driver::resume()
  42.     power management methods.
  43.     Check on 64 bit boxes.
  44.     Check and fix on big endian boxes.
  45.     Test and make sure PCI latency is now correct for all cases.
  46. */
  47. #define DRV_NAME "dmfe"
  48. #define DRV_VERSION "1.36.4"
  49. #define DRV_RELDATE "2002-01-17"
  50. #include <linux/module.h>
  51. #include <linux/kernel.h>
  52. #include <linux/sched.h>
  53. #include <linux/string.h>
  54. #include <linux/timer.h>
  55. #include <linux/ptrace.h>
  56. #include <linux/errno.h>
  57. #include <linux/ioport.h>
  58. #include <linux/slab.h>
  59. #include <linux/interrupt.h>
  60. #include <linux/pci.h>
  61. #include <linux/init.h>
  62. #include <linux/version.h>
  63. #include <linux/netdevice.h>
  64. #include <linux/etherdevice.h>
  65. #include <linux/ethtool.h>
  66. #include <linux/skbuff.h>
  67. #include <linux/delay.h>
  68. #include <linux/spinlock.h>
  69. #include <linux/crc32.h>
  70. #include <asm/processor.h>
  71. #include <asm/bitops.h>
  72. #include <asm/io.h>
  73. #include <asm/dma.h>
  74. #include <asm/uaccess.h>
  75. /* Board/System/Debug information/definition ---------------- */
  76. #define PCI_DM9132_ID   0x91321282      /* Davicom DM9132 ID */
  77. #define PCI_DM9102_ID   0x91021282      /* Davicom DM9102 ID */
  78. #define PCI_DM9100_ID   0x91001282      /* Davicom DM9100 ID */
  79. #define PCI_DM9009_ID   0x90091282      /* Davicom DM9009 ID */
  80. #define DM9102_IO_SIZE  0x80
  81. #define DM9102A_IO_SIZE 0x100
  82. #define TX_MAX_SEND_CNT 0x1             /* Maximum tx packet per time */
  83. #define TX_DESC_CNT     0x10            /* Allocated Tx descriptors */
  84. #define RX_DESC_CNT     0x20            /* Allocated Rx descriptors */
  85. #define TX_FREE_DESC_CNT (TX_DESC_CNT - 2) /* Max TX packet count */
  86. #define TX_WAKE_DESC_CNT (TX_DESC_CNT - 3) /* TX wakeup count */
  87. #define DESC_ALL_CNT    (TX_DESC_CNT + RX_DESC_CNT)
  88. #define TX_BUF_ALLOC    0x600
  89. #define RX_ALLOC_SIZE   0x620
  90. #define DM910X_RESET    1
  91. #define CR0_DEFAULT     0x00E00000      /* TX & RX burst mode */
  92. #define CR6_DEFAULT     0x00080000      /* HD */
  93. #define CR7_DEFAULT     0x180c1
  94. #define CR15_DEFAULT    0x06            /* TxJabber RxWatchdog */
  95. #define TDES0_ERR_MASK  0x4302          /* TXJT, LC, EC, FUE */
  96. #define MAX_PACKET_SIZE 1514
  97. #define DMFE_MAX_MULTICAST 14
  98. #define RX_COPY_SIZE 100
  99. #define MAX_CHECK_PACKET 0x8000
  100. #define DM9801_NOISE_FLOOR 8
  101. #define DM9802_NOISE_FLOOR 5
  102. #define DMFE_10MHF      0
  103. #define DMFE_100MHF     1
  104. #define DMFE_10MFD      4
  105. #define DMFE_100MFD     5
  106. #define DMFE_AUTO       8
  107. #define DMFE_1M_HPNA    0x10
  108. #define DMFE_TXTH_72 0x400000 /* TX TH 72 byte */
  109. #define DMFE_TXTH_96 0x404000 /* TX TH 96 byte */
  110. #define DMFE_TXTH_128 0x0000 /* TX TH 128 byte */
  111. #define DMFE_TXTH_256 0x4000 /* TX TH 256 byte */
  112. #define DMFE_TXTH_512 0x8000 /* TX TH 512 byte */
  113. #define DMFE_TXTH_1K 0xC000 /* TX TH 1K  byte */
  114. #define DMFE_TIMER_WUT  (jiffies + HZ * 1)/* timer wakeup time : 1 second */
  115. #define DMFE_TX_TIMEOUT ((3*HZ)/2) /* tx packet time-out time 1.5 s" */
  116. #define DMFE_TX_KICK  (HZ/2) /* tx packet Kick-out time 0.5 s" */
  117. #define DMFE_DBUG(dbug_now, msg, value) if (dmfe_debug || (dbug_now)) printk(KERN_ERR DRV_NAME ": %s %lxn", (msg), (long) (value))
  118. #define SHOW_MEDIA_TYPE(mode) printk(KERN_ERR DRV_NAME ": Change Speed to %sMhz %s duplexn",mode & 1 ?"100":"10", mode & 4 ? "full":"half");
  119. /* CR9 definition: SROM/MII */
  120. #define CR9_SROM_READ   0x4800
  121. #define CR9_SRCS        0x1
  122. #define CR9_SRCLK       0x2
  123. #define CR9_CRDOUT      0x8
  124. #define SROM_DATA_0     0x0
  125. #define SROM_DATA_1     0x4
  126. #define PHY_DATA_1      0x20000
  127. #define PHY_DATA_0      0x00000
  128. #define MDCLKH          0x10000
  129. #define PHY_POWER_DOWN 0x800
  130. #define SROM_V41_CODE   0x14
  131. #define SROM_CLK_WRITE(data, ioaddr) outl(data|CR9_SROM_READ|CR9_SRCS,ioaddr);udelay(5);outl(data|CR9_SROM_READ|CR9_SRCS|CR9_SRCLK,ioaddr);udelay(5);outl(data|CR9_SROM_READ|CR9_SRCS,ioaddr);udelay(5);
  132. #define __CHK_IO_SIZE(pci_id, dev_rev) ( ((pci_id)==PCI_DM9132_ID) || ((dev_rev) >= 0x02000030) ) ? DM9102A_IO_SIZE: DM9102_IO_SIZE
  133. #define CHK_IO_SIZE(pci_dev, dev_rev) __CHK_IO_SIZE(((pci_dev)->device << 16) | (pci_dev)->vendor, dev_rev)
  134. /* Sten Check */
  135. #define DEVICE net_device
  136. /* Structure/enum declaration ------------------------------- */
  137. struct tx_desc {
  138.         u32 tdes0, tdes1, tdes2, tdes3; /* Data for the card */
  139.         char *tx_buf_ptr;               /* Data for us */
  140.         struct tx_desc *next_tx_desc;
  141. } __attribute__(( aligned(32) ));
  142. struct rx_desc {
  143. u32 rdes0, rdes1, rdes2, rdes3; /* Data for the card */
  144. struct sk_buff *rx_skb_ptr; /* Data for us */
  145. struct rx_desc *next_rx_desc;
  146. } __attribute__(( aligned(32) ));
  147. struct dmfe_board_info {
  148. u32 chip_id; /* Chip vendor/Device ID */
  149. u32 chip_revision; /* Chip revision */
  150. struct DEVICE *next_dev; /* next device */
  151. struct pci_dev *pdev; /* PCI device */
  152. spinlock_t lock;
  153. long ioaddr; /* I/O base address */
  154. u32 cr0_data;
  155. u32 cr5_data;
  156. u32 cr6_data;
  157. u32 cr7_data;
  158. u32 cr15_data;
  159. /* pointer for memory physical address */
  160. dma_addr_t buf_pool_dma_ptr; /* Tx buffer pool memory */
  161. dma_addr_t buf_pool_dma_start; /* Tx buffer pool align dword */
  162. dma_addr_t desc_pool_dma_ptr; /* descriptor pool memory */
  163. dma_addr_t first_tx_desc_dma;
  164. dma_addr_t first_rx_desc_dma;
  165. /* descriptor pointer */
  166. unsigned char *buf_pool_ptr; /* Tx buffer pool memory */
  167. unsigned char *buf_pool_start; /* Tx buffer pool align dword */
  168. unsigned char *desc_pool_ptr; /* descriptor pool memory */
  169. struct tx_desc *first_tx_desc;
  170. struct tx_desc *tx_insert_ptr;
  171. struct tx_desc *tx_remove_ptr;
  172. struct rx_desc *first_rx_desc;
  173. struct rx_desc *rx_insert_ptr;
  174. struct rx_desc *rx_ready_ptr; /* packet come pointer */
  175. unsigned long tx_packet_cnt; /* transmitted packet count */
  176. unsigned long tx_queue_cnt; /* wait to send packet count */
  177. unsigned long rx_avail_cnt; /* available rx descriptor count */
  178. unsigned long interval_rx_cnt; /* rx packet count a callback time */
  179. u16 HPNA_command; /* For HPNA register 16 */
  180. u16 HPNA_timer; /* For HPNA remote device check */
  181. u16 dbug_cnt;
  182. u16 NIC_capability; /* NIC media capability */
  183. u16 PHY_reg4; /* Saved Phyxcer register 4 value */
  184. u8 HPNA_present; /* 0:none, 1:DM9801, 2:DM9802 */
  185. u8 chip_type; /* Keep DM9102A chip type */
  186. u8 media_mode; /* user specify media mode */
  187. u8 op_mode; /* real work media mode */
  188. u8 phy_addr;
  189. u8 link_failed; /* Ever link failed */
  190. u8 wait_reset; /* Hardware failed, need to reset */
  191. u8 dm910x_chk_mode; /* Operating mode check */
  192. u8 first_in_callback; /* Flag to record state */
  193. struct timer_list timer;
  194. /* System defined statistic counter */
  195. struct net_device_stats stats;
  196. /* Driver defined statistic counter */
  197. unsigned long tx_fifo_underrun;
  198. unsigned long tx_loss_carrier;
  199. unsigned long tx_no_carrier;
  200. unsigned long tx_late_collision;
  201. unsigned long tx_excessive_collision;
  202. unsigned long tx_jabber_timeout;
  203. unsigned long reset_count;
  204. unsigned long reset_cr8;
  205. unsigned long reset_fatal;
  206. unsigned long reset_TXtimeout;
  207. /* NIC SROM data */
  208. unsigned char srom[128];
  209. };
  210. enum dmfe_offsets {
  211. DCR0 = 0x00, DCR1 = 0x08, DCR2 = 0x10, DCR3 = 0x18, DCR4 = 0x20,
  212. DCR5 = 0x28, DCR6 = 0x30, DCR7 = 0x38, DCR8 = 0x40, DCR9 = 0x48,
  213. DCR10 = 0x50, DCR11 = 0x58, DCR12 = 0x60, DCR13 = 0x68, DCR14 = 0x70,
  214. DCR15 = 0x78
  215. };
  216. enum dmfe_CR6_bits {
  217. CR6_RXSC = 0x2, CR6_PBF = 0x8, CR6_PM = 0x40, CR6_PAM = 0x80,
  218. CR6_FDM = 0x200, CR6_TXSC = 0x2000, CR6_STI = 0x100000,
  219. CR6_SFT = 0x200000, CR6_RXA = 0x40000000, CR6_NO_PURGE = 0x20000000
  220. };
  221. /* Global variable declaration ----------------------------- */
  222. static int __devinitdata printed_version;
  223. static char version[] __devinitdata =
  224. KERN_INFO DRV_NAME ": Davicom DM9xxx net driver, version "
  225. DRV_VERSION " (" DRV_RELDATE ")n";
  226. static int dmfe_debug;
  227. static unsigned char dmfe_media_mode = DMFE_AUTO;
  228. static u32 dmfe_cr6_user_set;
  229. /* For module input parameter */
  230. static int debug;
  231. static u32 cr6set;
  232. static unsigned char mode = 8;
  233. static u8 chkmode = 1;
  234. static u8 HPNA_mode; /* Default: Low Power/High Speed */
  235. static u8 HPNA_rx_cmd; /* Default: Disable Rx remote command */
  236. static u8 HPNA_tx_cmd; /* Default: Don't issue remote command */
  237. static u8 HPNA_NoiseFloor; /* Default: HPNA NoiseFloor */
  238. static u8 SF_mode; /* Special Function: 1:VLAN, 2:RX Flow Control
  239.    4: TX pause packet */
  240. /* function declaration ------------------------------------- */
  241. static int dmfe_open(struct DEVICE *);
  242. static int dmfe_start_xmit(struct sk_buff *, struct DEVICE *);
  243. static int dmfe_stop(struct DEVICE *);
  244. static struct net_device_stats * dmfe_get_stats(struct DEVICE *);
  245. static void dmfe_set_filter_mode(struct DEVICE *);
  246. static int dmfe_do_ioctl(struct DEVICE *, struct ifreq *, int);
  247. static u16 read_srom_word(long ,int);
  248. static void dmfe_interrupt(int , void *, struct pt_regs *);
  249. static void dmfe_descriptor_init(struct dmfe_board_info *, unsigned long);
  250. static void allocate_rx_buffer(struct dmfe_board_info *);
  251. static void update_cr6(u32, unsigned long);
  252. static void send_filter_frame(struct DEVICE * ,int);
  253. static void dm9132_id_table(struct DEVICE * ,int);
  254. static u16 phy_read(unsigned long, u8, u8, u32);
  255. static void phy_write(unsigned long, u8, u8, u16, u32);
  256. static void phy_write_1bit(unsigned long, u32);
  257. static u16 phy_read_1bit(unsigned long);
  258. static u8 dmfe_sense_speed(struct dmfe_board_info *);
  259. static void dmfe_process_mode(struct dmfe_board_info *);
  260. static void dmfe_timer(unsigned long);
  261. static void dmfe_rx_packet(struct DEVICE *, struct dmfe_board_info *);
  262. static void dmfe_free_tx_pkt(struct DEVICE *, struct dmfe_board_info *);
  263. static void dmfe_reuse_skb(struct dmfe_board_info *, struct sk_buff *);
  264. static void dmfe_dynamic_reset(struct DEVICE *);
  265. static void dmfe_free_rxbuffer(struct dmfe_board_info *);
  266. static void dmfe_init_dm910x(struct DEVICE *);
  267. static inline u32 cal_CRC(unsigned char *, unsigned int, u8);
  268. static void dmfe_parse_srom(struct dmfe_board_info *);
  269. static void dmfe_program_DM9801(struct dmfe_board_info *, int);
  270. static void dmfe_program_DM9802(struct dmfe_board_info *);
  271. static void dmfe_HPNA_remote_cmd_chk(struct dmfe_board_info * );
  272. static void dmfe_set_phyxcer(struct dmfe_board_info *);
  273. /* DM910X network baord routine ---------------------------- */
  274. /*
  275.  * Search DM910X board ,allocate space and register it
  276.  */
  277. static int __devinit dmfe_init_one (struct pci_dev *pdev,
  278.     const struct pci_device_id *ent)
  279. {
  280. struct dmfe_board_info *db; /* board information structure */
  281. struct net_device *dev;
  282. u32 dev_rev, pci_pmr;
  283. int i, err;
  284. DMFE_DBUG(0, "dmfe_init_one()", 0);
  285. if (!printed_version++)
  286. printk(version);
  287. /* Init network device */
  288. dev = alloc_etherdev(sizeof(*db));
  289. if (dev == NULL)
  290. return -ENOMEM;
  291. SET_MODULE_OWNER(dev);
  292. if (pci_set_dma_mask(pdev, 0xffffffff)) {
  293. printk(KERN_WARNING DRV_NAME ": 32-bit PCI DMA not available.n");
  294. err = -ENODEV;
  295. goto err_out_free;
  296. }
  297. /* Enable Master/IO access, Disable memory access */
  298. err = pci_enable_device(pdev);
  299. if (err)
  300. goto err_out_free;
  301. if (!pci_resource_start(pdev, 0)) {
  302. printk(KERN_ERR DRV_NAME ": I/O base is zeron");
  303. err = -ENODEV;
  304. goto err_out_disable;
  305. }
  306. /* Read Chip revision */
  307. pci_read_config_dword(pdev, PCI_REVISION_ID, &dev_rev);
  308. if (pci_resource_len(pdev, 0) < (CHK_IO_SIZE(pdev, dev_rev)) ) {
  309. printk(KERN_ERR DRV_NAME ": Allocated I/O size too smalln");
  310. err = -ENODEV;
  311. goto err_out_disable;
  312. }
  313. #if 0 /* pci_{enable_device,set_master} sets minimum latency for us now */
  314. /* Set Latency Timer 80h */
  315. /* FIXME: setting values > 32 breaks some SiS 559x stuff.
  316.    Need a PCI quirk.. */
  317. pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0x80);
  318. #endif
  319. if (pci_request_regions(pdev, DRV_NAME)) {
  320. printk(KERN_ERR DRV_NAME ": Failed to request PCI regionsn");
  321. err = -ENODEV;
  322. goto err_out_disable;
  323. }
  324. /* Init system & device */
  325. db = dev->priv;
  326. /* Allocate Tx/Rx descriptor memory */
  327. db->desc_pool_ptr = pci_alloc_consistent(pdev, sizeof(struct tx_desc) * DESC_ALL_CNT + 0x20, &db->desc_pool_dma_ptr);
  328. db->buf_pool_ptr = pci_alloc_consistent(pdev, TX_BUF_ALLOC * TX_DESC_CNT + 4, &db->buf_pool_dma_ptr);
  329. db->first_tx_desc = (struct tx_desc *) db->desc_pool_ptr;
  330. db->first_tx_desc_dma = db->desc_pool_dma_ptr;
  331. db->buf_pool_start = db->buf_pool_ptr;
  332. db->buf_pool_dma_start = db->buf_pool_dma_ptr;
  333. db->chip_id = ent->driver_data;
  334. db->ioaddr = pci_resource_start(pdev, 0);
  335. db->chip_revision = dev_rev;
  336. db->pdev = pdev;
  337. dev->base_addr = db->ioaddr;
  338. dev->irq = pdev->irq;
  339. pci_set_drvdata(pdev, dev);
  340. dev->open = &dmfe_open;
  341. dev->hard_start_xmit = &dmfe_start_xmit;
  342. dev->stop = &dmfe_stop;
  343. dev->get_stats = &dmfe_get_stats;
  344. dev->set_multicast_list = &dmfe_set_filter_mode;
  345. dev->do_ioctl = &dmfe_do_ioctl;
  346. spin_lock_init(&db->lock);
  347. pci_read_config_dword(pdev, 0x50, &pci_pmr);
  348. pci_pmr &= 0x70000;
  349. if ( (pci_pmr == 0x10000) && (dev_rev == 0x02000031) )
  350. db->chip_type = 1; /* DM9102A E3 */
  351. else
  352. db->chip_type = 0;
  353. /* read 64 word srom data */
  354. for (i = 0; i < 64; i++)
  355. ((u16 *) db->srom)[i] = cpu_to_le16(read_srom_word(db->ioaddr, i));
  356. /* Set Node address */
  357. for (i = 0; i < 6; i++)
  358. dev->dev_addr[i] = db->srom[20 + i];
  359. err = register_netdev (dev);
  360. if (err)
  361. goto err_out_res;
  362. printk(KERN_INFO "%s: Davicom DM%04lx at pci%s,",
  363. dev->name,
  364. ent->driver_data >> 16,
  365. pdev->slot_name);
  366. for (i = 0; i < 6; i++)
  367. printk("%c%02x", i ? ':' : ' ', dev->dev_addr[i]);
  368. printk(", irq %d.n", dev->irq);
  369. pci_set_master(pdev);
  370. return 0;
  371. err_out_res:
  372. pci_release_regions(pdev);
  373. err_out_disable:
  374. pci_disable_device(pdev);
  375. err_out_free:
  376. pci_set_drvdata(pdev, NULL);
  377. kfree(dev);
  378. return err;
  379. }
  380. static void __devexit dmfe_remove_one (struct pci_dev *pdev)
  381. {
  382. struct net_device *dev = pci_get_drvdata(pdev);
  383. struct dmfe_board_info *db = dev->priv;
  384. DMFE_DBUG(0, "dmfe_remove_one()", 0);
  385.   if (dev) {
  386. pci_free_consistent(db->pdev, sizeof(struct tx_desc) *
  387. DESC_ALL_CNT + 0x20, db->desc_pool_ptr,
  388.   db->desc_pool_dma_ptr);
  389. pci_free_consistent(db->pdev, TX_BUF_ALLOC * TX_DESC_CNT + 4,
  390. db->buf_pool_ptr, db->buf_pool_dma_ptr);
  391. unregister_netdev(dev);
  392. pci_release_regions(pdev);
  393. kfree(dev); /* free board information */
  394. pci_set_drvdata(pdev, NULL);
  395. }
  396. DMFE_DBUG(0, "dmfe_remove_one() exit", 0);
  397. }
  398. /*
  399.  * Open the interface.
  400.  * The interface is opened whenever "ifconfig" actives it.
  401.  */
  402. static int dmfe_open(struct DEVICE *dev)
  403. {
  404. int ret;
  405. struct dmfe_board_info *db = dev->priv;
  406. DMFE_DBUG(0, "dmfe_open", 0);
  407. ret = request_irq(dev->irq, &dmfe_interrupt, SA_SHIRQ, dev->name, dev);
  408. if (ret)
  409. return ret;
  410. /* system variable init */
  411. db->cr6_data = CR6_DEFAULT | dmfe_cr6_user_set;
  412. db->tx_packet_cnt = 0;
  413. db->tx_queue_cnt = 0;
  414. db->rx_avail_cnt = 0;
  415. db->link_failed = 1;
  416. db->wait_reset = 0;
  417. db->first_in_callback = 0;
  418. db->NIC_capability = 0xf; /* All capability*/
  419. db->PHY_reg4 = 0x1e0;
  420. /* CR6 operation mode decision */
  421. if ( !chkmode || (db->chip_id == PCI_DM9132_ID) ||
  422. (db->chip_revision >= 0x02000030) ) {
  423.      db->cr6_data |= DMFE_TXTH_256;
  424. db->cr0_data = CR0_DEFAULT;
  425. db->dm910x_chk_mode=4; /* Enter the normal mode */
  426.   } else {
  427. db->cr6_data |= CR6_SFT; /* Store & Forward mode */
  428. db->cr0_data = 0;
  429. db->dm910x_chk_mode = 1; /* Enter the check mode */
  430. }
  431. /* Initilize DM910X board */
  432. dmfe_init_dm910x(dev);
  433. /* Active System Interface */
  434. netif_wake_queue(dev);
  435. /* set and active a timer process */
  436. init_timer(&db->timer);
  437. db->timer.expires = DMFE_TIMER_WUT + HZ * 2;
  438. db->timer.data = (unsigned long)dev;
  439. db->timer.function = &dmfe_timer;
  440. add_timer(&db->timer);
  441. return 0;
  442. }
  443. /* Initilize DM910X board
  444.  * Reset DM910X board
  445.  * Initilize TX/Rx descriptor chain structure
  446.  * Send the set-up frame
  447.  * Enable Tx/Rx machine
  448.  */
  449. static void dmfe_init_dm910x(struct DEVICE *dev)
  450. {
  451. struct dmfe_board_info *db = dev->priv;
  452. unsigned long ioaddr = db->ioaddr;
  453. DMFE_DBUG(0, "dmfe_init_dm910x()", 0);
  454. /* Reset DM910x MAC controller */
  455. outl(DM910X_RESET, ioaddr + DCR0); /* RESET MAC */
  456. udelay(100);
  457. outl(db->cr0_data, ioaddr + DCR0);
  458. udelay(5);
  459. /* Phy addr : DM910(A)2/DM9132/9801, phy address = 1 */
  460. db->phy_addr = 1;
  461. /* Parser SROM and media mode */
  462. dmfe_parse_srom(db);
  463. db->media_mode = dmfe_media_mode;
  464. /* RESET Phyxcer Chip by GPR port bit 7 */
  465. outl(0x180, ioaddr + DCR12); /* Let bit 7 output port */
  466. if (db->chip_id == PCI_DM9009_ID) {
  467. outl(0x80, ioaddr + DCR12); /* Issue RESET signal */
  468. mdelay(300); /* Delay 300 ms */
  469. }
  470. outl(0x0, ioaddr + DCR12); /* Clear RESET signal */
  471. /* Process Phyxcer Media Mode */
  472. if ( !(db->media_mode & 0x10) ) /* Force 1M mode */
  473. dmfe_set_phyxcer(db);
  474. /* Media Mode Process */
  475. if ( !(db->media_mode & DMFE_AUTO) )
  476. db->op_mode = db->media_mode;  /* Force Mode */
  477. /* Initiliaze Transmit/Receive decriptor and CR3/4 */
  478. dmfe_descriptor_init(db, ioaddr);
  479. /* Init CR6 to program DM910x operation */
  480. update_cr6(db->cr6_data, ioaddr);
  481. /* Send setup frame */
  482. if (db->chip_id == PCI_DM9132_ID)
  483. dm9132_id_table(dev, dev->mc_count); /* DM9132 */
  484. else
  485. send_filter_frame(dev, dev->mc_count); /* DM9102/DM9102A */
  486. /* Init CR7, interrupt active bit */
  487. db->cr7_data = CR7_DEFAULT;
  488. outl(db->cr7_data, ioaddr + DCR7);
  489. /* Init CR15, Tx jabber and Rx watchdog timer */
  490. outl(db->cr15_data, ioaddr + DCR15);
  491. /* Enable DM910X Tx/Rx function */
  492. db->cr6_data |= CR6_RXSC | CR6_TXSC | 0x40000;
  493. update_cr6(db->cr6_data, ioaddr);
  494. }
  495. /*
  496.  * Hardware start transmission.
  497.  * Send a packet to media from the upper layer.
  498.  */
  499. static int dmfe_start_xmit(struct sk_buff *skb, struct DEVICE *dev)
  500. {
  501. struct dmfe_board_info *db = dev->priv;
  502. struct tx_desc *txptr;
  503. unsigned long flags;
  504. DMFE_DBUG(0, "dmfe_start_xmit", 0);
  505. /* Resource flag check */
  506. netif_stop_queue(dev);
  507. /* Too large packet check */
  508. if (skb->len > MAX_PACKET_SIZE) {
  509. printk(KERN_ERR DRV_NAME ": big packet = %dn", (u16)skb->len);
  510. dev_kfree_skb(skb);
  511. return 0;
  512. }
  513. spin_lock_irqsave(&db->lock, flags);
  514. /* No Tx resource check, it never happen nromally */
  515. if (db->tx_queue_cnt >= TX_FREE_DESC_CNT) {
  516. spin_unlock_irqrestore(&db->lock, flags);
  517. printk(KERN_ERR DRV_NAME ": No Tx resource %ldn", db->tx_queue_cnt);
  518. return 1;
  519. }
  520. /* Disable NIC interrupt */
  521. outl(0, dev->base_addr + DCR7);
  522. /* transmit this packet */
  523. txptr = db->tx_insert_ptr;
  524. memcpy(txptr->tx_buf_ptr, skb->data, skb->len);
  525. txptr->tdes1 = cpu_to_le32(0xe1000000 | skb->len);
  526. /* Point to next transmit free descriptor */
  527. db->tx_insert_ptr = txptr->next_tx_desc;
  528. /* Transmit Packet Process */
  529. if ( (!db->tx_queue_cnt) && (db->tx_packet_cnt < TX_MAX_SEND_CNT) ) {
  530. txptr->tdes0 = cpu_to_le32(0x80000000); /* Set owner bit */
  531. db->tx_packet_cnt++; /* Ready to send */
  532. outl(0x1, dev->base_addr + DCR1); /* Issue Tx polling */
  533. dev->trans_start = jiffies; /* saved time stamp */
  534. } else {
  535. db->tx_queue_cnt++; /* queue TX packet */
  536. outl(0x1, dev->base_addr + DCR1); /* Issue Tx polling */
  537. }
  538. /* Tx resource check */
  539. if ( db->tx_queue_cnt < TX_FREE_DESC_CNT )
  540. netif_wake_queue(dev);
  541. /* free this SKB */
  542. dev_kfree_skb(skb);
  543. /* Restore CR7 to enable interrupt */
  544. spin_unlock_irqrestore(&db->lock, flags);
  545. outl(db->cr7_data, dev->base_addr + DCR7);
  546. return 0;
  547. }
  548. /*
  549.  * Stop the interface.
  550.  * The interface is stopped when it is brought.
  551.  */
  552. static int dmfe_stop(struct DEVICE *dev)
  553. {
  554. struct dmfe_board_info *db = dev->priv;
  555. unsigned long ioaddr = dev->base_addr;
  556. DMFE_DBUG(0, "dmfe_stop", 0);
  557. /* disable system */
  558. netif_stop_queue(dev);
  559. /* deleted timer */
  560. del_timer_sync(&db->timer);
  561. /* Reset & stop DM910X board */
  562. outl(DM910X_RESET, ioaddr + DCR0);
  563. udelay(5);
  564. phy_write(db->ioaddr, db->phy_addr, 0, 0x8000, db->chip_id);
  565. /* free interrupt */
  566. free_irq(dev->irq, dev);
  567. /* free allocated rx buffer */
  568. dmfe_free_rxbuffer(db);
  569. #if 0
  570. /* show statistic counter */
  571. printk(DRV_NAME ": FU:%lx EC:%lx LC:%lx NC:%lx LOC:%lx TXJT:%lx RESET:%lx RCR8:%lx FAL:%lx TT:%lxn",
  572. db->tx_fifo_underrun, db->tx_excessive_collision,
  573. db->tx_late_collision, db->tx_no_carrier, db->tx_loss_carrier,
  574. db->tx_jabber_timeout, db->reset_count, db->reset_cr8,
  575. db->reset_fatal, db->reset_TXtimeout);
  576. #endif
  577. return 0;
  578. }
  579. /*
  580.  * DM9102 insterrupt handler
  581.  * receive the packet to upper layer, free the transmitted packet
  582.  */
  583. static void dmfe_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  584. {
  585. struct DEVICE *dev = dev_id;
  586. struct dmfe_board_info *db = (struct dmfe_board_info *) dev->priv;
  587. unsigned long ioaddr = dev->base_addr;
  588. unsigned long flags;
  589. DMFE_DBUG(0, "dmfe_interrupt()", 0);
  590. if (!dev) {
  591. DMFE_DBUG(1, "dmfe_interrupt() without DEVICE arg", 0);
  592. return;
  593. }
  594. spin_lock_irqsave(&db->lock, flags);
  595. /* Got DM910X status */
  596. db->cr5_data = inl(ioaddr + DCR5);
  597. outl(db->cr5_data, ioaddr + DCR5);
  598. if ( !(db->cr5_data & 0xc1) ) {
  599. spin_unlock_irqrestore(&db->lock, flags);
  600. return;
  601. }
  602. /* Disable all interrupt in CR7 to solve the interrupt edge problem */
  603. outl(0, ioaddr + DCR7);
  604. /* Check system status */
  605. if (db->cr5_data & 0x2000) {
  606. /* system bus error happen */
  607. DMFE_DBUG(1, "System bus error happen. CR5=", db->cr5_data);
  608. db->reset_fatal++;
  609. db->wait_reset = 1; /* Need to RESET */
  610. spin_unlock_irqrestore(&db->lock, flags);
  611. return;
  612. }
  613.  /* Received the coming packet */
  614. if ( (db->cr5_data & 0x40) && db->rx_avail_cnt )
  615. dmfe_rx_packet(dev, db);
  616. /* reallocate rx descriptor buffer */
  617. if (db->rx_avail_cnt<RX_DESC_CNT)
  618. allocate_rx_buffer(db);
  619. /* Free the transmitted descriptor */
  620. if ( db->cr5_data & 0x01)
  621. dmfe_free_tx_pkt(dev, db);
  622. /* Mode Check */
  623. if (db->dm910x_chk_mode & 0x2) {
  624. db->dm910x_chk_mode = 0x4;
  625. db->cr6_data |= 0x100;
  626. update_cr6(db->cr6_data, db->ioaddr);
  627. }
  628. /* Restore CR7 to enable interrupt mask */
  629. outl(db->cr7_data, ioaddr + DCR7);
  630. spin_unlock_irqrestore(&db->lock, flags);
  631. }
  632. /*
  633.  * Free TX resource after TX complete
  634.  */
  635. static void dmfe_free_tx_pkt(struct DEVICE *dev, struct dmfe_board_info * db)
  636. {
  637. struct tx_desc *txptr;
  638. unsigned long ioaddr = dev->base_addr;
  639. u32 tdes0;
  640. txptr = db->tx_remove_ptr;
  641. while(db->tx_packet_cnt) {
  642. tdes0 = le32_to_cpu(txptr->tdes0);
  643. /* printk(DRV_NAME ": tdes0=%xn", tdes0); */
  644. if (tdes0 & 0x80000000)
  645. break;
  646. /* A packet sent completed */
  647. db->tx_packet_cnt--;
  648. db->stats.tx_packets++;
  649. /* Transmit statistic counter */
  650. if ( tdes0 != 0x7fffffff ) {
  651. /* printk(DRV_NAME ": tdes0=%xn", tdes0); */
  652. db->stats.collisions += (tdes0 >> 3) & 0xf;
  653. db->stats.tx_bytes += le32_to_cpu(txptr->tdes1) & 0x7ff;
  654. if (tdes0 & TDES0_ERR_MASK) {
  655. db->stats.tx_errors++;
  656. if (tdes0 & 0x0002) { /* UnderRun */
  657. db->tx_fifo_underrun++;
  658. if ( !(db->cr6_data & CR6_SFT) ) {
  659. db->cr6_data = db->cr6_data | CR6_SFT;
  660. update_cr6(db->cr6_data, db->ioaddr);
  661. }
  662. }
  663. if (tdes0 & 0x0100)
  664. db->tx_excessive_collision++;
  665. if (tdes0 & 0x0200)
  666. db->tx_late_collision++;
  667. if (tdes0 & 0x0400)
  668. db->tx_no_carrier++;
  669. if (tdes0 & 0x0800)
  670. db->tx_loss_carrier++;
  671. if (tdes0 & 0x4000)
  672. db->tx_jabber_timeout++;
  673. }
  674. }
  675.      txptr = txptr->next_tx_desc;
  676. }/* End of while */
  677. /* Update TX remove pointer to next */
  678. db->tx_remove_ptr = txptr;
  679. /* Send the Tx packet in queue */
  680. if ( (db->tx_packet_cnt < TX_MAX_SEND_CNT) && db->tx_queue_cnt ) {
  681. txptr->tdes0 = cpu_to_le32(0x80000000); /* Set owner bit */
  682. db->tx_packet_cnt++; /* Ready to send */
  683. db->tx_queue_cnt--;
  684. outl(0x1, ioaddr + DCR1); /* Issue Tx polling */
  685. dev->trans_start = jiffies; /* saved time stamp */
  686. }
  687. /* Resource available check */
  688. if ( db->tx_queue_cnt < TX_WAKE_DESC_CNT )
  689. netif_wake_queue(dev); /* Active upper layer, send again */
  690. }
  691. /*
  692.  * Receive the come packet and pass to upper layer
  693.  */
  694. static void dmfe_rx_packet(struct DEVICE *dev, struct dmfe_board_info * db)
  695. {
  696. struct rx_desc *rxptr;
  697. struct sk_buff *skb;
  698. int rxlen;
  699. u32 rdes0;
  700. rxptr = db->rx_ready_ptr;
  701. while(db->rx_avail_cnt) {
  702. rdes0 = le32_to_cpu(rxptr->rdes0);
  703. if (rdes0 & 0x80000000) /* packet owner check */
  704. break;
  705. db->rx_avail_cnt--;
  706. db->interval_rx_cnt++;
  707. pci_unmap_single(db->pdev, le32_to_cpu(rxptr->rdes2), RX_ALLOC_SIZE, PCI_DMA_FROMDEVICE);
  708. if ( (rdes0 & 0x300) != 0x300) {
  709. /* A packet without First/Last flag */
  710. /* reuse this SKB */
  711. DMFE_DBUG(0, "Reuse SK buffer, rdes0", rdes0);
  712. dmfe_reuse_skb(db, rxptr->rx_skb_ptr);
  713. } else {
  714. /* A packet with First/Last flag */
  715. rxlen = ( (rdes0 >> 16) & 0x3fff) - 4;
  716. /* error summary bit check */
  717. if (rdes0 & 0x8000) {
  718. /* This is a error packet */
  719. //printk(DRV_NAME ": rdes0: %lxn", rdes0);
  720. db->stats.rx_errors++;
  721. if (rdes0 & 1)
  722. db->stats.rx_fifo_errors++;
  723. if (rdes0 & 2)
  724. db->stats.rx_crc_errors++;
  725. if (rdes0 & 0x80)
  726. db->stats.rx_length_errors++;
  727. }
  728. if ( !(rdes0 & 0x8000) ||
  729. ((db->cr6_data & CR6_PM) && (rxlen>6)) ) {
  730. skb = rxptr->rx_skb_ptr;
  731. /* Received Packet CRC check need or not */
  732. if ( (db->dm910x_chk_mode & 1) &&
  733. (cal_CRC(skb->tail, rxlen, 1) !=
  734. (*(u32 *) (skb->tail+rxlen) ))) { /* FIXME (?) */
  735. /* Found a error received packet */
  736. dmfe_reuse_skb(db, rxptr->rx_skb_ptr);
  737. db->dm910x_chk_mode = 3;
  738. } else {
  739. /* Good packet, send to upper layer */
  740. /* Shorst packet used new SKB */
  741. if ( (rxlen < RX_COPY_SIZE) &&
  742. ( (skb = dev_alloc_skb(rxlen + 2) )
  743. != NULL) ) {
  744. /* size less than COPY_SIZE, allocate a rxlen SKB */
  745. skb->dev = dev;
  746. skb_reserve(skb, 2); /* 16byte align */
  747. memcpy(skb_put(skb, rxlen), rxptr->rx_skb_ptr->tail, rxlen);
  748. dmfe_reuse_skb(db, rxptr->rx_skb_ptr);
  749. } else {
  750. skb->dev = dev;
  751. skb_put(skb, rxlen);
  752. }
  753. skb->protocol = eth_type_trans(skb, dev);
  754. netif_rx(skb);
  755. dev->last_rx = jiffies;
  756. db->stats.rx_packets++;
  757. db->stats.rx_bytes += rxlen;
  758. }
  759. } else {
  760. /* Reuse SKB buffer when the packet is error */
  761. DMFE_DBUG(0, "Reuse SK buffer, rdes0", rdes0);
  762. dmfe_reuse_skb(db, rxptr->rx_skb_ptr);
  763. }
  764. }
  765. rxptr = rxptr->next_rx_desc;
  766. }
  767. db->rx_ready_ptr = rxptr;
  768. }
  769. /*
  770.  * Get statistics from driver.
  771.  */
  772. static struct net_device_stats * dmfe_get_stats(struct DEVICE *dev)
  773. {
  774. struct dmfe_board_info *db = (struct dmfe_board_info *)dev->priv;
  775. DMFE_DBUG(0, "dmfe_get_stats", 0);
  776. return &db->stats;
  777. }
  778. /*
  779.  * Set DM910X multicast address
  780.  */
  781. static void dmfe_set_filter_mode(struct DEVICE * dev)
  782. {
  783. struct dmfe_board_info *db = dev->priv;
  784. unsigned long flags;
  785. DMFE_DBUG(0, "dmfe_set_filter_mode()", 0);
  786. spin_lock_irqsave(&db->lock, flags);
  787. if (dev->flags & IFF_PROMISC) {
  788. DMFE_DBUG(0, "Enable PROM Mode", 0);
  789. db->cr6_data |= CR6_PM | CR6_PBF;
  790. update_cr6(db->cr6_data, db->ioaddr);
  791. spin_unlock_irqrestore(&db->lock, flags);
  792. return;
  793. }
  794. if (dev->flags & IFF_ALLMULTI || dev->mc_count > DMFE_MAX_MULTICAST) {
  795. DMFE_DBUG(0, "Pass all multicast address", dev->mc_count);
  796. db->cr6_data &= ~(CR6_PM | CR6_PBF);
  797. db->cr6_data |= CR6_PAM;
  798. spin_unlock_irqrestore(&db->lock, flags);
  799. return;
  800. }
  801. DMFE_DBUG(0, "Set multicast address", dev->mc_count);
  802. if (db->chip_id == PCI_DM9132_ID)
  803. dm9132_id_table(dev, dev->mc_count); /* DM9132 */
  804. else
  805. send_filter_frame(dev, dev->mc_count);  /* DM9102/DM9102A */
  806. spin_unlock_irqrestore(&db->lock, flags);
  807. }
  808. /*
  809.  * Process the ethtool ioctl command
  810.  */
  811. static int dmfe_ethtool_ioctl(struct net_device *dev, void *useraddr)
  812. {
  813. struct dmfe_board_info *db = dev->priv;
  814. struct ethtool_drvinfo info = { ETHTOOL_GDRVINFO };
  815. u32 ethcmd;
  816. if (copy_from_user(&ethcmd, useraddr, sizeof(ethcmd)))
  817. return -EFAULT;
  818.         switch (ethcmd) {
  819.         case ETHTOOL_GDRVINFO:
  820. strcpy(info.driver, DRV_NAME);
  821. strcpy(info.version, DRV_VERSION);
  822. if (db->pdev)
  823. strcpy(info.bus_info, db->pdev->slot_name);
  824. else
  825. sprintf(info.bus_info, "EISA 0x%lx %d",
  826. dev->base_addr, dev->irq);
  827. if (copy_to_user(useraddr, &info, sizeof(info)))
  828. return -EFAULT;
  829. return 0;
  830.         }
  831. return -EOPNOTSUPP;
  832. }
  833. /*
  834.  * Process the upper socket ioctl command
  835.  */
  836. static int dmfe_do_ioctl(struct DEVICE *dev, struct ifreq *ifr, int cmd)
  837. {
  838. int retval = -EOPNOTSUPP;
  839. DMFE_DBUG(0, "dmfe_do_ioctl()", 0);
  840. switch(cmd) {
  841. case SIOCETHTOOL:
  842. return dmfe_ethtool_ioctl(dev, (void*)ifr->ifr_data);
  843. }
  844. return retval;
  845. }
  846. /*
  847.  * A periodic timer routine
  848.  * Dynamic media sense, allocate Rx buffer...
  849.  */
  850. static void dmfe_timer(unsigned long data)
  851. {
  852. u32 tmp_cr8;
  853. unsigned char tmp_cr12;
  854. struct DEVICE *dev = (struct DEVICE *) data;
  855. struct dmfe_board_info *db = (struct dmfe_board_info *) dev->priv;
  856.   unsigned long flags;
  857. DMFE_DBUG(0, "dmfe_timer()", 0);
  858. spin_lock_irqsave(&db->lock, flags);
  859. /* Media mode process when Link OK before enter this route */
  860. if (db->first_in_callback == 0) {
  861. db->first_in_callback = 1;
  862. if (db->chip_type && (db->chip_id==PCI_DM9102_ID)) {
  863. db->cr6_data &= ~0x40000;
  864. update_cr6(db->cr6_data, db->ioaddr);
  865. phy_write(db->ioaddr, db->phy_addr, 0, 0x1000, db->chip_id);
  866. db->cr6_data |= 0x40000;
  867. update_cr6(db->cr6_data, db->ioaddr);
  868. db->timer.expires = DMFE_TIMER_WUT + HZ * 2;
  869. add_timer(&db->timer);
  870. spin_unlock_irqrestore(&db->lock, flags);
  871. return;
  872. }
  873. }
  874. /* Operating Mode Check */
  875. if ( (db->dm910x_chk_mode & 0x1) &&
  876. (db->stats.rx_packets > MAX_CHECK_PACKET) )
  877. db->dm910x_chk_mode = 0x4;
  878. /* Dynamic reset DM910X : system error or transmit time-out */
  879. tmp_cr8 = inl(db->ioaddr + DCR8);
  880. if ( (db->interval_rx_cnt==0) && (tmp_cr8) ) {
  881. db->reset_cr8++;
  882. db->wait_reset = 1;
  883. }
  884. db->interval_rx_cnt = 0;
  885. /* TX polling kick monitor */
  886. if ( db->tx_packet_cnt &&
  887.      time_after(jiffies, dev->trans_start + DMFE_TX_KICK) ) {
  888. outl(0x1, dev->base_addr + DCR1);   /* Tx polling again */
  889. /* TX Timeout */
  890. if ( time_after(jiffies, dev->trans_start + DMFE_TX_TIMEOUT) ) {
  891. db->reset_TXtimeout++;
  892. db->wait_reset = 1;
  893. printk(KERN_WARNING "%s: Tx timeout - resettingn",
  894.        dev->name);
  895. }
  896. }
  897. if (db->wait_reset) {
  898. DMFE_DBUG(0, "Dynamic Reset device", db->tx_packet_cnt);
  899. db->reset_count++;
  900. dmfe_dynamic_reset(dev);
  901. db->first_in_callback = 0;
  902. db->timer.expires = DMFE_TIMER_WUT;
  903. add_timer(&db->timer);
  904. spin_unlock_irqrestore(&db->lock, flags);
  905. return;
  906. }
  907. /* Link status check, Dynamic media type change */
  908. if (db->chip_id == PCI_DM9132_ID)
  909. tmp_cr12 = inb(db->ioaddr + DCR9 + 3); /* DM9132 */
  910. else
  911. tmp_cr12 = inb(db->ioaddr + DCR12); /* DM9102/DM9102A */
  912. if ( ((db->chip_id == PCI_DM9102_ID) &&
  913. (db->chip_revision == 0x02000030)) ||
  914. ((db->chip_id == PCI_DM9132_ID) &&
  915. (db->chip_revision == 0x02000010)) ) {
  916. /* DM9102A Chip */
  917. if (tmp_cr12 & 2)
  918. tmp_cr12 = 0x0; /* Link failed */
  919. else
  920. tmp_cr12 = 0x3; /* Link OK */
  921. }
  922. if ( !(tmp_cr12 & 0x3) && !db->link_failed ) {
  923. /* Link Failed */
  924. DMFE_DBUG(0, "Link Failed", tmp_cr12);
  925. db->link_failed = 1;
  926. /* For Force 10/100M Half/Full mode: Enable Auto-Nego mode */
  927. /* AUTO or force 1M Homerun/Longrun don't need */
  928. if ( !(db->media_mode & 0x38) )
  929. phy_write(db->ioaddr, db->phy_addr, 0, 0x1000, db->chip_id);
  930. /* AUTO mode, if INT phyxcer link failed, select EXT device */
  931. if (db->media_mode & DMFE_AUTO) {
  932. /* 10/100M link failed, used 1M Home-Net */
  933. db->cr6_data|=0x00040000; /* bit18=1, MII */
  934. db->cr6_data&=~0x00000200; /* bit9=0, HD mode */
  935. update_cr6(db->cr6_data, db->ioaddr);
  936. }
  937. } else
  938. if ((tmp_cr12 & 0x3) && db->link_failed) {
  939. DMFE_DBUG(0, "Link link OK", tmp_cr12);
  940. db->link_failed = 0;
  941. /* Auto Sense Speed */
  942. if ( (db->media_mode & DMFE_AUTO) &&
  943. dmfe_sense_speed(db) )
  944. db->link_failed = 1;
  945. dmfe_process_mode(db);
  946. /* SHOW_MEDIA_TYPE(db->op_mode); */
  947. }
  948. /* HPNA remote command check */
  949. if (db->HPNA_command & 0xf00) {
  950. db->HPNA_timer--;
  951. if (!db->HPNA_timer)
  952. dmfe_HPNA_remote_cmd_chk(db);
  953. }
  954. /* Timer active again */
  955. db->timer.expires = DMFE_TIMER_WUT;
  956. add_timer(&db->timer);
  957. spin_unlock_irqrestore(&db->lock, flags);
  958. }
  959. /*
  960.  * Dynamic reset the DM910X board
  961.  * Stop DM910X board
  962.  * Free Tx/Rx allocated memory
  963.  * Reset DM910X board
  964.  * Re-initilize DM910X board
  965.  */
  966. static void dmfe_dynamic_reset(struct DEVICE *dev)
  967. {
  968. struct dmfe_board_info *db = dev->priv;
  969. DMFE_DBUG(0, "dmfe_dynamic_reset()", 0);
  970. /* Sopt MAC controller */
  971. db->cr6_data &= ~(CR6_RXSC | CR6_TXSC); /* Disable Tx/Rx */
  972. update_cr6(db->cr6_data, dev->base_addr);
  973. outl(0, dev->base_addr + DCR7); /* Disable Interrupt */
  974. outl(inl(dev->base_addr + DCR5), dev->base_addr + DCR5);
  975. /* Disable upper layer interface */
  976. netif_stop_queue(dev);
  977. /* Free Rx Allocate buffer */
  978. dmfe_free_rxbuffer(db);
  979. /* system variable init */
  980. db->tx_packet_cnt = 0;
  981. db->tx_queue_cnt = 0;
  982. db->rx_avail_cnt = 0;
  983. db->link_failed = 1;
  984. db->wait_reset = 0;
  985. /* Re-initilize DM910X board */
  986. dmfe_init_dm910x(dev);
  987. /* Restart upper layer interface */
  988. netif_wake_queue(dev);
  989. }
  990. /*
  991.  * free all allocated rx buffer
  992.  */
  993. static void dmfe_free_rxbuffer(struct dmfe_board_info * db)
  994. {
  995. DMFE_DBUG(0, "dmfe_free_rxbuffer()", 0);
  996. /* free allocated rx buffer */
  997. while (db->rx_avail_cnt) {
  998. dev_kfree_skb(db->rx_ready_ptr->rx_skb_ptr);
  999. db->rx_ready_ptr = db->rx_ready_ptr->next_rx_desc;
  1000. db->rx_avail_cnt--;
  1001. }
  1002. }
  1003. /*
  1004.  * Reuse the SK buffer
  1005.  */
  1006. static void dmfe_reuse_skb(struct dmfe_board_info *db, struct sk_buff * skb)
  1007. {
  1008. struct rx_desc *rxptr = db->rx_insert_ptr;
  1009. if (!(rxptr->rdes0 & cpu_to_le32(0x80000000))) {
  1010. rxptr->rx_skb_ptr = skb;
  1011. rxptr->rdes2 = cpu_to_le32( pci_map_single(db->pdev, skb->tail, RX_ALLOC_SIZE, PCI_DMA_FROMDEVICE) );
  1012. wmb();
  1013. rxptr->rdes0 = cpu_to_le32(0x80000000);
  1014. db->rx_avail_cnt++;
  1015. db->rx_insert_ptr = rxptr->next_rx_desc;
  1016. } else
  1017. DMFE_DBUG(0, "SK Buffer reuse method error", db->rx_avail_cnt);
  1018. }
  1019. /*
  1020.  * Initialize transmit/Receive descriptor
  1021.  * Using Chain structure, and allocate Tx/Rx buffer
  1022.  */
  1023. static void dmfe_descriptor_init(struct dmfe_board_info *db, unsigned long ioaddr)
  1024. {
  1025. struct tx_desc *tmp_tx;
  1026. struct rx_desc *tmp_rx;
  1027. unsigned char *tmp_buf;
  1028. dma_addr_t tmp_tx_dma, tmp_rx_dma;
  1029. dma_addr_t tmp_buf_dma;
  1030. int i;
  1031. DMFE_DBUG(0, "dmfe_descriptor_init()", 0);
  1032. /* tx descriptor start pointer */
  1033. db->tx_insert_ptr = db->first_tx_desc;
  1034. db->tx_remove_ptr = db->first_tx_desc;
  1035. outl(db->first_tx_desc_dma, ioaddr + DCR4);     /* TX DESC address */
  1036. /* rx descriptor start pointer */
  1037. db->first_rx_desc = (void *)db->first_tx_desc + sizeof(struct tx_desc) * TX_DESC_CNT;
  1038. db->first_rx_desc_dma =  db->first_tx_desc_dma + sizeof(struct tx_desc) * TX_DESC_CNT;
  1039. db->rx_insert_ptr = db->first_rx_desc;
  1040. db->rx_ready_ptr = db->first_rx_desc;
  1041. outl(db->first_rx_desc_dma, ioaddr + DCR3); /* RX DESC address */
  1042. /* Init Transmit chain */
  1043. tmp_buf = db->buf_pool_start;
  1044. tmp_buf_dma = db->buf_pool_dma_start;
  1045. tmp_tx_dma = db->first_tx_desc_dma;
  1046. for (tmp_tx = db->first_tx_desc, i = 0; i < TX_DESC_CNT; i++, tmp_tx++) {
  1047. tmp_tx->tx_buf_ptr = tmp_buf;
  1048. tmp_tx->tdes0 = cpu_to_le32(0);
  1049. tmp_tx->tdes1 = cpu_to_le32(0x81000000); /* IC, chain */
  1050. tmp_tx->tdes2 = cpu_to_le32(tmp_buf_dma);
  1051. tmp_tx_dma += sizeof(struct tx_desc);
  1052. tmp_tx->tdes3 = cpu_to_le32(tmp_tx_dma);
  1053. tmp_tx->next_tx_desc = tmp_tx + 1;
  1054. tmp_buf = tmp_buf + TX_BUF_ALLOC;
  1055. tmp_buf_dma = tmp_buf_dma + TX_BUF_ALLOC;
  1056. }
  1057. (--tmp_tx)->tdes3 = cpu_to_le32(db->first_tx_desc_dma);
  1058. tmp_tx->next_tx_desc = db->first_tx_desc;
  1059.  /* Init Receive descriptor chain */
  1060. tmp_rx_dma=db->first_rx_desc_dma;
  1061. for (tmp_rx = db->first_rx_desc, i = 0; i < RX_DESC_CNT; i++, tmp_rx++) {
  1062. tmp_rx->rdes0 = cpu_to_le32(0);
  1063. tmp_rx->rdes1 = cpu_to_le32(0x01000600);
  1064. tmp_rx_dma += sizeof(struct rx_desc);
  1065. tmp_rx->rdes3 = cpu_to_le32(tmp_rx_dma);
  1066. tmp_rx->next_rx_desc = tmp_rx + 1;
  1067. }
  1068. (--tmp_rx)->rdes3 = cpu_to_le32(db->first_rx_desc_dma);
  1069. tmp_rx->next_rx_desc = db->first_rx_desc;
  1070. /* pre-allocate Rx buffer */
  1071. allocate_rx_buffer(db);
  1072. }
  1073. /*
  1074.  * Update CR6 value
  1075.  * Firstly stop DM910X , then written value and start
  1076.  */
  1077. static void update_cr6(u32 cr6_data, unsigned long ioaddr)
  1078. {
  1079. u32 cr6_tmp;
  1080. cr6_tmp = cr6_data & ~0x2002;           /* stop Tx/Rx */
  1081. outl(cr6_tmp, ioaddr + DCR6);
  1082. udelay(5);
  1083. outl(cr6_data, ioaddr + DCR6);
  1084. udelay(5);
  1085. }
  1086. /*
  1087.  * Send a setup frame for DM9132
  1088.  * This setup frame initilize DM910X addres filter mode
  1089. */
  1090. static void dm9132_id_table(struct DEVICE *dev, int mc_cnt)
  1091. {
  1092. struct dev_mc_list *mcptr;
  1093. u16 * addrptr;
  1094. unsigned long ioaddr = dev->base_addr+0xc0; /* ID Table */
  1095. u32 hash_val;
  1096. u16 i, hash_table[4];
  1097. DMFE_DBUG(0, "dm9132_id_table()", 0);
  1098. /* Node address */
  1099. addrptr = (u16 *) dev->dev_addr;
  1100. outw(addrptr[0], ioaddr);
  1101. ioaddr += 4;
  1102. outw(addrptr[1], ioaddr);
  1103. ioaddr += 4;
  1104. outw(addrptr[2], ioaddr);
  1105. ioaddr += 4;
  1106. /* Clear Hash Table */
  1107. for (i = 0; i < 4; i++)
  1108. hash_table[i] = 0x0;
  1109. /* broadcast address */
  1110. hash_table[3] = 0x8000;
  1111. /* the multicast address in Hash Table : 64 bits */
  1112. for (mcptr = dev->mc_list, i = 0; i < mc_cnt; i++, mcptr = mcptr->next) {
  1113. hash_val = cal_CRC( (char *) mcptr->dmi_addr, 6, 0) & 0x3f;
  1114. hash_table[hash_val / 16] |= (u16) 1 << (hash_val % 16);
  1115. }
  1116. /* Write the hash table to MAC MD table */
  1117. for (i = 0; i < 4; i++, ioaddr += 4)
  1118. outw(hash_table[i], ioaddr);
  1119. }
  1120. /*
  1121.  * Send a setup frame for DM9102/DM9102A
  1122.  * This setup frame initilize DM910X addres filter mode
  1123.  */
  1124. static void send_filter_frame(struct DEVICE *dev, int mc_cnt)
  1125. {
  1126. struct dmfe_board_info *db = dev->priv;
  1127. struct dev_mc_list *mcptr;
  1128. struct tx_desc *txptr;
  1129. u16 * addrptr;
  1130. u32 * suptr;
  1131. int i;
  1132. DMFE_DBUG(0, "send_filter_frame()", 0);
  1133. txptr = db->tx_insert_ptr;
  1134. suptr = (u32 *) txptr->tx_buf_ptr;
  1135. /* Node address */
  1136. addrptr = (u16 *) dev->dev_addr;
  1137. *suptr++ = addrptr[0];
  1138. *suptr++ = addrptr[1];
  1139. *suptr++ = addrptr[2];
  1140. /* broadcast address */
  1141. *suptr++ = 0xffff;
  1142. *suptr++ = 0xffff;
  1143. *suptr++ = 0xffff;
  1144. /* fit the multicast address */
  1145. for (mcptr = dev->mc_list, i = 0; i < mc_cnt; i++, mcptr = mcptr->next) {
  1146. addrptr = (u16 *) mcptr->dmi_addr;
  1147. *suptr++ = addrptr[0];
  1148. *suptr++ = addrptr[1];
  1149. *suptr++ = addrptr[2];
  1150. }
  1151. for (; i<14; i++) {
  1152. *suptr++ = 0xffff;
  1153. *suptr++ = 0xffff;
  1154. *suptr++ = 0xffff;
  1155. }
  1156. /* prepare the setup frame */
  1157. db->tx_insert_ptr = txptr->next_tx_desc;
  1158. txptr->tdes1 = cpu_to_le32(0x890000c0);
  1159. /* Resource Check and Send the setup packet */
  1160. if (!db->tx_packet_cnt) {
  1161. /* Resource Empty */
  1162. db->tx_packet_cnt++;
  1163. txptr->tdes0 = cpu_to_le32(0x80000000);
  1164. update_cr6(db->cr6_data | 0x2000, dev->base_addr);
  1165. outl(0x1, dev->base_addr + DCR1); /* Issue Tx polling */
  1166. update_cr6(db->cr6_data, dev->base_addr);
  1167. dev->trans_start = jiffies;
  1168. } else
  1169. db->tx_queue_cnt++; /* Put in TX queue */
  1170. }
  1171. /*
  1172.  * Allocate rx buffer,
  1173.  * As possible as allocate maxiumn Rx buffer
  1174.  */
  1175. static void allocate_rx_buffer(struct dmfe_board_info *db)
  1176. {
  1177. struct rx_desc *rxptr;
  1178. struct sk_buff *skb;
  1179. rxptr = db->rx_insert_ptr;
  1180. while(db->rx_avail_cnt < RX_DESC_CNT) {
  1181. if ( ( skb = dev_alloc_skb(RX_ALLOC_SIZE) ) == NULL )
  1182. break;
  1183. rxptr->rx_skb_ptr = skb; /* FIXME (?) */
  1184. rxptr->rdes2 = cpu_to_le32( pci_map_single(db->pdev, skb->tail, RX_ALLOC_SIZE, PCI_DMA_FROMDEVICE) );
  1185. wmb();
  1186. rxptr->rdes0 = cpu_to_le32(0x80000000);
  1187. rxptr = rxptr->next_rx_desc;
  1188. db->rx_avail_cnt++;
  1189. }
  1190. db->rx_insert_ptr = rxptr;
  1191. }
  1192. /*
  1193.  * Read one word data from the serial ROM
  1194.  */
  1195. static u16 read_srom_word(long ioaddr, int offset)
  1196. {
  1197. int i;
  1198. u16 srom_data = 0;
  1199. long cr9_ioaddr = ioaddr + DCR9;
  1200. outl(CR9_SROM_READ, cr9_ioaddr);
  1201. outl(CR9_SROM_READ | CR9_SRCS, cr9_ioaddr);
  1202. /* Send the Read Command 110b */
  1203. SROM_CLK_WRITE(SROM_DATA_1, cr9_ioaddr);
  1204. SROM_CLK_WRITE(SROM_DATA_1, cr9_ioaddr);
  1205. SROM_CLK_WRITE(SROM_DATA_0, cr9_ioaddr);
  1206. /* Send the offset */
  1207. for (i = 5; i >= 0; i--) {
  1208. srom_data = (offset & (1 << i)) ? SROM_DATA_1 : SROM_DATA_0;
  1209. SROM_CLK_WRITE(srom_data, cr9_ioaddr);
  1210. }
  1211. outl(CR9_SROM_READ | CR9_SRCS, cr9_ioaddr);
  1212. for (i = 16; i > 0; i--) {
  1213. outl(CR9_SROM_READ | CR9_SRCS | CR9_SRCLK, cr9_ioaddr);
  1214. udelay(5);
  1215. srom_data = (srom_data << 1) | ((inl(cr9_ioaddr) & CR9_CRDOUT) ? 1 : 0);
  1216. outl(CR9_SROM_READ | CR9_SRCS, cr9_ioaddr);
  1217. udelay(5);
  1218. }
  1219. outl(CR9_SROM_READ, cr9_ioaddr);
  1220. return srom_data;
  1221. }
  1222. /*
  1223.  * Auto sense the media mode
  1224.  */
  1225. static u8 dmfe_sense_speed(struct dmfe_board_info * db)
  1226. {
  1227. u8 ErrFlag = 0;
  1228. u16 phy_mode;
  1229. /* CR6 bit18=0, select 10/100M */
  1230. update_cr6( (db->cr6_data & ~0x40000), db->ioaddr);
  1231. phy_mode = phy_read(db->ioaddr, db->phy_addr, 1, db->chip_id);
  1232. phy_mode = phy_read(db->ioaddr, db->phy_addr, 1, db->chip_id);
  1233. if ( (phy_mode & 0x24) == 0x24 ) {
  1234. if (db->chip_id == PCI_DM9132_ID) /* DM9132 */
  1235. phy_mode = phy_read(db->ioaddr, db->phy_addr, 7, db->chip_id) & 0xf000;
  1236. else  /* DM9102/DM9102A */
  1237. phy_mode = phy_read(db->ioaddr, db->phy_addr, 17, db->chip_id) & 0xf000;
  1238. /* printk(DRV_NAME ": Phy_mode %x ",phy_mode); */
  1239. switch (phy_mode) {
  1240. case 0x1000: db->op_mode = DMFE_10MHF; break;
  1241. case 0x2000: db->op_mode = DMFE_10MFD; break;
  1242. case 0x4000: db->op_mode = DMFE_100MHF; break;
  1243. case 0x8000: db->op_mode = DMFE_100MFD; break;
  1244. default: db->op_mode = DMFE_10MHF;
  1245. ErrFlag = 1;
  1246. break;
  1247. }
  1248. } else {
  1249. db->op_mode = DMFE_10MHF;
  1250. DMFE_DBUG(0, "Link Failed :", phy_mode);
  1251. ErrFlag = 1;
  1252. }
  1253. return ErrFlag;
  1254. }
  1255. /*
  1256.  * Set 10/100 phyxcer capability
  1257.  * AUTO mode : phyxcer register4 is NIC capability
  1258.  * Force mode: phyxcer register4 is the force media
  1259.  */
  1260. static void dmfe_set_phyxcer(struct dmfe_board_info *db)
  1261. {
  1262. u16 phy_reg;
  1263. /* Select 10/100M phyxcer */
  1264. db->cr6_data &= ~0x40000;
  1265. update_cr6(db->cr6_data, db->ioaddr);
  1266. /* DM9009 Chip: Phyxcer reg18 bit12=0 */
  1267. if (db->chip_id == PCI_DM9009_ID) {
  1268. phy_reg = phy_read(db->ioaddr, db->phy_addr, 18, db->chip_id) & ~0x1000;
  1269. phy_write(db->ioaddr, db->phy_addr, 18, phy_reg, db->chip_id);
  1270. }
  1271. /* Phyxcer capability setting */
  1272. phy_reg = phy_read(db->ioaddr, db->phy_addr, 4, db->chip_id) & ~0x01e0;
  1273. if (db->media_mode & DMFE_AUTO) {
  1274. /* AUTO Mode */
  1275. phy_reg |= db->PHY_reg4;
  1276. } else {
  1277. /* Force Mode */
  1278. switch(db->media_mode) {
  1279. case DMFE_10MHF: phy_reg |= 0x20; break;
  1280. case DMFE_10MFD: phy_reg |= 0x40; break;
  1281. case DMFE_100MHF: phy_reg |= 0x80; break;
  1282. case DMFE_100MFD: phy_reg |= 0x100; break;
  1283. }
  1284. if (db->chip_id == PCI_DM9009_ID) phy_reg &= 0x61;
  1285. }
  1286.    /* Write new capability to Phyxcer Reg4 */
  1287. if ( !(phy_reg & 0x01e0)) {
  1288. phy_reg|=db->PHY_reg4;
  1289. db->media_mode|=DMFE_AUTO;
  1290. }
  1291. phy_write(db->ioaddr, db->phy_addr, 4, phy_reg, db->chip_id);
  1292.   /* Restart Auto-Negotiation */
  1293. if ( db->chip_type && (db->chip_id == PCI_DM9102_ID) )
  1294. phy_write(db->ioaddr, db->phy_addr, 0, 0x1800, db->chip_id);
  1295. if ( !db->chip_type )
  1296. phy_write(db->ioaddr, db->phy_addr, 0, 0x1200, db->chip_id);
  1297. }
  1298. /*
  1299.  * Process op-mode
  1300.  * AUTO mode : PHY controller in Auto-negotiation Mode
  1301.  * Force mode: PHY controller in force mode with HUB
  1302.  * N-way force capability with SWITCH
  1303.  */
  1304. static void dmfe_process_mode(struct dmfe_board_info *db)
  1305. {
  1306. u16 phy_reg;
  1307. /* Full Duplex Mode Check */
  1308. if (db->op_mode & 0x4)
  1309. db->cr6_data |= CR6_FDM; /* Set Full Duplex Bit */
  1310. else
  1311. db->cr6_data &= ~CR6_FDM; /* Clear Full Duplex Bit */
  1312. /* Transciver Selection */
  1313. if (db->op_mode & 0x10) /* 1M HomePNA */
  1314. db->cr6_data |= 0x40000;/* External MII select */
  1315. else
  1316. db->cr6_data &= ~0x40000;/* Internal 10/100 transciver */
  1317. update_cr6(db->cr6_data, db->ioaddr);
  1318. /* 10/100M phyxcer force mode need */
  1319. if ( !(db->media_mode & 0x18)) {
  1320. /* Forece Mode */
  1321. phy_reg = phy_read(db->ioaddr, db->phy_addr, 6, db->chip_id);
  1322. if ( !(phy_reg & 0x1) ) {
  1323. /* parter without N-Way capability */
  1324. phy_reg = 0x0;
  1325. switch(db->op_mode) {
  1326. case DMFE_10MHF: phy_reg = 0x0; break;
  1327. case DMFE_10MFD: phy_reg = 0x100; break;
  1328. case DMFE_100MHF: phy_reg = 0x2000; break;
  1329. case DMFE_100MFD: phy_reg = 0x2100; break;
  1330. }
  1331. phy_write(db->ioaddr, db->phy_addr, 0, phy_reg, db->chip_id);
  1332.         if ( db->chip_type && (db->chip_id == PCI_DM9102_ID) )
  1333. mdelay(20);
  1334. phy_write(db->ioaddr, db->phy_addr, 0, phy_reg, db->chip_id);
  1335. }
  1336. }
  1337. }
  1338. /*
  1339.  * Write a word to Phy register
  1340.  */
  1341. static void phy_write(unsigned long iobase, u8 phy_addr, u8 offset, u16 phy_data, u32 chip_id)
  1342. {
  1343. u16 i;
  1344. unsigned long ioaddr;
  1345. if (chip_id == PCI_DM9132_ID) {
  1346. ioaddr = iobase + 0x80 + offset * 4;
  1347. outw(phy_data, ioaddr);
  1348. } else {
  1349. /* DM9102/DM9102A Chip */
  1350. ioaddr = iobase + DCR9;
  1351. /* Send 33 synchronization clock to Phy controller */
  1352. for (i = 0; i < 35; i++)
  1353. phy_write_1bit(ioaddr, PHY_DATA_1);
  1354. /* Send start command(01) to Phy */
  1355. phy_write_1bit(ioaddr, PHY_DATA_0);
  1356. phy_write_1bit(ioaddr, PHY_DATA_1);
  1357. /* Send write command(01) to Phy */
  1358. phy_write_1bit(ioaddr, PHY_DATA_0);
  1359. phy_write_1bit(ioaddr, PHY_DATA_1);
  1360. /* Send Phy addres */
  1361. for (i = 0x10; i > 0; i = i >> 1)
  1362. phy_write_1bit(ioaddr, phy_addr & i ? PHY_DATA_1 : PHY_DATA_0);
  1363. /* Send register addres */
  1364. for (i = 0x10; i > 0; i = i >> 1)
  1365. phy_write_1bit(ioaddr, offset & i ? PHY_DATA_1 : PHY_DATA_0);
  1366. /* written trasnition */
  1367. phy_write_1bit(ioaddr, PHY_DATA_1);
  1368. phy_write_1bit(ioaddr, PHY_DATA_0);
  1369. /* Write a word data to PHY controller */
  1370. for ( i = 0x8000; i > 0; i >>= 1)
  1371. phy_write_1bit(ioaddr, phy_data & i ? PHY_DATA_1 : PHY_DATA_0);
  1372. }
  1373. }
  1374. /*
  1375.  * Read a word data from phy register
  1376.  */
  1377. static u16 phy_read(unsigned long iobase, u8 phy_addr, u8 offset, u32 chip_id)
  1378. {
  1379. int i;
  1380. u16 phy_data;
  1381. unsigned long ioaddr;
  1382. if (chip_id == PCI_DM9132_ID) {
  1383. /* DM9132 Chip */
  1384. ioaddr = iobase + 0x80 + offset * 4;
  1385. phy_data = inw(ioaddr);
  1386. } else {
  1387. /* DM9102/DM9102A Chip */
  1388. ioaddr = iobase + DCR9;
  1389. /* Send 33 synchronization clock to Phy controller */
  1390. for (i = 0; i < 35; i++)
  1391. phy_write_1bit(ioaddr, PHY_DATA_1);
  1392. /* Send start command(01) to Phy */
  1393. phy_write_1bit(ioaddr, PHY_DATA_0);
  1394. phy_write_1bit(ioaddr, PHY_DATA_1);
  1395. /* Send read command(10) to Phy */
  1396. phy_write_1bit(ioaddr, PHY_DATA_1);
  1397. phy_write_1bit(ioaddr, PHY_DATA_0);
  1398. /* Send Phy addres */
  1399. for (i = 0x10; i > 0; i = i >> 1)
  1400. phy_write_1bit(ioaddr, phy_addr & i ? PHY_DATA_1 : PHY_DATA_0);
  1401. /* Send register addres */
  1402. for (i = 0x10; i > 0; i = i >> 1)
  1403. phy_write_1bit(ioaddr, offset & i ? PHY_DATA_1 : PHY_DATA_0);
  1404. /* Skip transition state */
  1405. phy_read_1bit(ioaddr);
  1406. /* read 16bit data */
  1407. for (phy_data = 0, i = 0; i < 16; i++) {
  1408. phy_data <<= 1;
  1409. phy_data |= phy_read_1bit(ioaddr);
  1410. }
  1411. }
  1412. return phy_data;
  1413. }
  1414. /*
  1415.  * Write one bit data to Phy Controller
  1416.  */
  1417. static void phy_write_1bit(unsigned long ioaddr, u32 phy_data)
  1418. {
  1419. outl(phy_data, ioaddr); /* MII Clock Low */
  1420. udelay(1);
  1421. outl(phy_data | MDCLKH, ioaddr); /* MII Clock High */
  1422. udelay(1);
  1423. outl(phy_data, ioaddr); /* MII Clock Low */
  1424. udelay(1);
  1425. }
  1426. /*
  1427.  * Read one bit phy data from PHY controller
  1428.  */
  1429. static u16 phy_read_1bit(unsigned long ioaddr)
  1430. {
  1431. u16 phy_data;
  1432. outl(0x50000, ioaddr);
  1433. udelay(1);
  1434. phy_data = ( inl(ioaddr) >> 19 ) & 0x1;
  1435. outl(0x40000, ioaddr);
  1436. udelay(1);
  1437. return phy_data;
  1438. }
  1439. /*
  1440.  * Calculate the CRC valude of the Rx packet
  1441.  * flag =  1 : return the reverse CRC (for the received packet CRC)
  1442.  * 0 : return the normal CRC (for Hash Table index)
  1443.  */
  1444. static inline u32 cal_CRC(unsigned char * Data, unsigned int Len, u8 flag)
  1445. {
  1446. u32 crc = ether_crc_le(Len, Data);
  1447. if (flag) crc = ~crc;
  1448. return crc;
  1449. }
  1450. /*
  1451.  * Parser SROM and media mode
  1452.  */
  1453. static void dmfe_parse_srom(struct dmfe_board_info * db)
  1454. {
  1455. char * srom = db->srom;
  1456. int dmfe_mode, tmp_reg;
  1457. DMFE_DBUG(0, "dmfe_parse_srom() ", 0);
  1458. /* Init CR15 */
  1459. db->cr15_data = CR15_DEFAULT;
  1460. /* Check SROM Version */
  1461. if ( ( (int) srom[18] & 0xff) == SROM_V41_CODE) {
  1462. /* SROM V4.01 */
  1463. /* Get NIC support media mode */
  1464. db->NIC_capability = le16_to_cpup(srom + 34);
  1465. db->PHY_reg4 = 0;
  1466. for (tmp_reg = 1; tmp_reg < 0x10; tmp_reg <<= 1) {
  1467. switch( db->NIC_capability & tmp_reg ) {
  1468. case 0x1: db->PHY_reg4 |= 0x0020; break;
  1469. case 0x2: db->PHY_reg4 |= 0x0040; break;
  1470. case 0x4: db->PHY_reg4 |= 0x0080; break;
  1471. case 0x8: db->PHY_reg4 |= 0x0100; break;
  1472. }
  1473. }
  1474. /* Media Mode Force or not check */
  1475. dmfe_mode = le32_to_cpup(srom + 34) & le32_to_cpup(srom + 36);
  1476. switch(dmfe_mode) {
  1477. case 0x4: dmfe_media_mode = DMFE_100MHF; break; /* 100MHF */
  1478. case 0x2: dmfe_media_mode = DMFE_10MFD; break; /* 10MFD */
  1479. case 0x8: dmfe_media_mode = DMFE_100MFD; break; /* 100MFD */
  1480. case 0x100:
  1481. case 0x200: dmfe_media_mode = DMFE_1M_HPNA; break;/* HomePNA */
  1482. }
  1483. /* Special Function setting */
  1484. /* VLAN function */
  1485. if ( (SF_mode & 0x1) || (srom[43] & 0x80) )
  1486. db->cr15_data |= 0x40;
  1487. /* Flow Control */
  1488. if ( (SF_mode & 0x2) || (srom[40] & 0x1) )
  1489. db->cr15_data |= 0x400;
  1490. /* TX pause packet */
  1491. if ( (SF_mode & 0x4) || (srom[40] & 0xe) )
  1492. db->cr15_data |= 0x9800;
  1493. }
  1494. /* Parse HPNA parameter */
  1495. db->HPNA_command = 1;
  1496. /* Accept remote command or not */
  1497. if (HPNA_rx_cmd == 0)
  1498. db->HPNA_command |= 0x8000;
  1499.  /* Issue remote command & operation mode */
  1500. if (HPNA_tx_cmd == 1)
  1501. switch(HPNA_mode) { /* Issue Remote Command */
  1502. case 0: db->HPNA_command |= 0x0904; break;
  1503. case 1: db->HPNA_command |= 0x0a00; break;
  1504. case 2: db->HPNA_command |= 0x0506; break;
  1505. case 3: db->HPNA_command |= 0x0602; break;
  1506. }
  1507. else
  1508. switch(HPNA_mode) { /* Don't Issue */
  1509. case 0: db->HPNA_command |= 0x0004; break;
  1510. case 1: db->HPNA_command |= 0x0000; break;
  1511. case 2: db->HPNA_command |= 0x0006; break;
  1512. case 3: db->HPNA_command |= 0x0002; break;
  1513. }
  1514. /* Check DM9801 or DM9802 present or not */
  1515. db->HPNA_present = 0;
  1516. update_cr6(db->cr6_data|0x40000, db->ioaddr);
  1517. tmp_reg = phy_read(db->ioaddr, db->phy_addr, 3, db->chip_id);
  1518. if ( ( tmp_reg & 0xfff0 ) == 0xb900 ) {
  1519. /* DM9801 or DM9802 present */
  1520. db->HPNA_timer = 8;
  1521. if ( phy_read(db->ioaddr, db->phy_addr, 31, db->chip_id) == 0x4404) {
  1522. /* DM9801 HomeRun */
  1523. db->HPNA_present = 1;
  1524. dmfe_program_DM9801(db, tmp_reg);
  1525. } else {
  1526. /* DM9802 LongRun */
  1527. db->HPNA_present = 2;
  1528. dmfe_program_DM9802(db);
  1529. }
  1530. }
  1531. }
  1532. /*
  1533.  * Init HomeRun DM9801
  1534.  */
  1535. static void dmfe_program_DM9801(struct dmfe_board_info * db, int HPNA_rev)
  1536. {
  1537. uint reg17, reg25;
  1538. if ( !HPNA_NoiseFloor ) HPNA_NoiseFloor = DM9801_NOISE_FLOOR;
  1539. switch(HPNA_rev) {
  1540. case 0xb900: /* DM9801 E3 */
  1541. db->HPNA_command |= 0x1000;
  1542. reg25 = phy_read(db->ioaddr, db->phy_addr, 24, db->chip_id);
  1543. reg25 = ( (reg25 + HPNA_NoiseFloor) & 0xff) | 0xf000;
  1544. reg17 = phy_read(db->ioaddr, db->phy_addr, 17, db->chip_id);
  1545. break;
  1546. case 0xb901: /* DM9801 E4 */
  1547. reg25 = phy_read(db->ioaddr, db->phy_addr, 25, db->chip_id);
  1548. reg25 = (reg25 & 0xff00) + HPNA_NoiseFloor;
  1549. reg17 = phy_read(db->ioaddr, db->phy_addr, 17, db->chip_id);
  1550. reg17 = (reg17 & 0xfff0) + HPNA_NoiseFloor + 3;
  1551. break;
  1552. case 0xb902: /* DM9801 E5 */
  1553. case 0xb903: /* DM9801 E6 */
  1554. default:
  1555. db->HPNA_command |= 0x1000;
  1556. reg25 = phy_read(db->ioaddr, db->phy_addr, 25, db->chip_id);
  1557. reg25 = (reg25 & 0xff00) + HPNA_NoiseFloor - 5;
  1558. reg17 = phy_read(db->ioaddr, db->phy_addr, 17, db->chip_id);
  1559. reg17 = (reg17 & 0xfff0) + HPNA_NoiseFloor;
  1560. break;
  1561. }
  1562. phy_write(db->ioaddr, db->phy_addr, 16, db->HPNA_command, db->chip_id);
  1563. phy_write(db->ioaddr, db->phy_addr, 17, reg17, db->chip_id);
  1564. phy_write(db->ioaddr, db->phy_addr, 25, reg25, db->chip_id);
  1565. }
  1566. /*
  1567.  * Init HomeRun DM9802
  1568.  */
  1569. static void dmfe_program_DM9802(struct dmfe_board_info * db)
  1570. {
  1571. uint phy_reg;
  1572. if ( !HPNA_NoiseFloor ) HPNA_NoiseFloor = DM9802_NOISE_FLOOR;
  1573. phy_write(db->ioaddr, db->phy_addr, 16, db->HPNA_command, db->chip_id);
  1574. phy_reg = phy_read(db->ioaddr, db->phy_addr, 25, db->chip_id);
  1575. phy_reg = ( phy_reg & 0xff00) + HPNA_NoiseFloor;
  1576. phy_write(db->ioaddr, db->phy_addr, 25, phy_reg, db->chip_id);
  1577. }
  1578. /*
  1579.  * Check remote HPNA power and speed status. If not correct,
  1580.  * issue command again.
  1581. */
  1582. static void dmfe_HPNA_remote_cmd_chk(struct dmfe_board_info * db)
  1583. {
  1584. uint phy_reg;
  1585. /* Got remote device status */
  1586. phy_reg = phy_read(db->ioaddr, db->phy_addr, 17, db->chip_id) & 0x60;
  1587. switch(phy_reg) {
  1588. case 0x00: phy_reg = 0x0a00;break; /* LP/LS */
  1589. case 0x20: phy_reg = 0x0900;break; /* LP/HS */
  1590. case 0x40: phy_reg = 0x0600;break; /* HP/LS */
  1591. case 0x60: phy_reg = 0x0500;break; /* HP/HS */
  1592. }
  1593. /* Check remote device status match our setting ot not */
  1594. if ( phy_reg != (db->HPNA_command & 0x0f00) ) {
  1595. phy_write(db->ioaddr, db->phy_addr, 16, db->HPNA_command, db->chip_id);
  1596. db->HPNA_timer=8;
  1597. } else
  1598. db->HPNA_timer=600; /* Match, every 10 minutes, check */
  1599. }
  1600. static struct pci_device_id dmfe_pci_tbl[] __devinitdata = {
  1601. { 0x1282, 0x9132, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PCI_DM9132_ID },
  1602. { 0x1282, 0x9102, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PCI_DM9102_ID },
  1603. { 0x1282, 0x9100, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PCI_DM9100_ID },
  1604. { 0x1282, 0x9009, PCI_ANY_ID, PCI_ANY_ID, 0, 0, PCI_DM9009_ID },
  1605. { 0, }
  1606. };
  1607. MODULE_DEVICE_TABLE(pci, dmfe_pci_tbl);
  1608. static struct pci_driver dmfe_driver = {
  1609. name: "dmfe",
  1610. id_table: dmfe_pci_tbl,
  1611. probe: dmfe_init_one,
  1612. remove: __devexit_p(dmfe_remove_one),
  1613. };
  1614. MODULE_AUTHOR("Sten Wang, sten_wang@davicom.com.tw");
  1615. MODULE_DESCRIPTION("Davicom DM910X fast ethernet driver");
  1616. MODULE_LICENSE("GPL");
  1617. MODULE_PARM(debug, "i");
  1618. MODULE_PARM(mode, "i");
  1619. MODULE_PARM(cr6set, "i");
  1620. MODULE_PARM(chkmode, "i");
  1621. MODULE_PARM(HPNA_mode, "i");
  1622. MODULE_PARM(HPNA_rx_cmd, "i");
  1623. MODULE_PARM(HPNA_tx_cmd, "i");
  1624. MODULE_PARM(HPNA_NoiseFloor, "i");
  1625. MODULE_PARM(SF_mode, "i");
  1626. MODULE_PARM_DESC(debug, "Davicom DM9xxx enable debugging (0-1)");
  1627. MODULE_PARM_DESC(mode, "Davicom DM9xxx: Bit 0: 10/100Mbps, bit 2: duplex, bit 8: HomePNA");
  1628. MODULE_PARM_DESC(SF_mode, "Davicom DM9xxx special function (bit 0: VLAN, bit 1 Flow Control, bit 2: TX pause packet)");
  1629. /* Description:
  1630.  * when user used insmod to add module, system invoked init_module()
  1631.  * to initilize and register.
  1632.  */
  1633. static int __init dmfe_init_module(void)
  1634. {
  1635. int rc;
  1636. printk(version);
  1637. printed_version = 1;
  1638. DMFE_DBUG(0, "init_module() ", debug);
  1639. if (debug)
  1640. dmfe_debug = debug; /* set debug flag */
  1641. if (cr6set)
  1642. dmfe_cr6_user_set = cr6set;
  1643.   switch(mode) {
  1644.     case DMFE_10MHF:
  1645. case DMFE_100MHF:
  1646. case DMFE_10MFD:
  1647. case DMFE_100MFD:
  1648. case DMFE_1M_HPNA:
  1649. dmfe_media_mode = mode;
  1650. break;
  1651. default:dmfe_media_mode = DMFE_AUTO;
  1652. break;
  1653. }
  1654. if (HPNA_mode > 4)
  1655. HPNA_mode = 0; /* Default: LP/HS */
  1656. if (HPNA_rx_cmd > 1)
  1657. HPNA_rx_cmd = 0; /* Default: Ignored remote cmd */
  1658. if (HPNA_tx_cmd > 1)
  1659. HPNA_tx_cmd = 0; /* Default: Don't issue remote cmd */
  1660. if (HPNA_NoiseFloor > 15)
  1661. HPNA_NoiseFloor = 0;
  1662. rc = pci_module_init(&dmfe_driver);
  1663. if (rc < 0)
  1664. return rc;
  1665. return 0;
  1666. }
  1667. /*
  1668.  * Description:
  1669.  * when user used rmmod to delete module, system invoked clean_module()
  1670.  * to un-register all registered services.
  1671.  */
  1672. static void __exit dmfe_cleanup_module(void)
  1673. {
  1674. DMFE_DBUG(0, "dmfe_clean_module() ", debug);
  1675. pci_unregister_driver(&dmfe_driver);
  1676. }
  1677. module_init(dmfe_init_module);
  1678. module_exit(dmfe_cleanup_module);