rtl8150.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958
  1. /*
  2. * Copyright (c) 2002 Petko Manolov (petkan@users.sourceforge.net)
  3. *
  4. * This program is free software; you can redistribute it and/or
  5. * modify it under the terms of the GNU General Public License
  6. * version 2 as published by the Free Software Foundation.
  7. */
  8. #include <linux/init.h>
  9. #include <linux/signal.h>
  10. #include <linux/slab.h>
  11. #include <linux/module.h>
  12. #include <linux/netdevice.h>
  13. #include <linux/etherdevice.h>
  14. #include <linux/mii.h>
  15. #include <linux/ethtool.h>
  16. #include <linux/usb.h>
  17. #include <asm/uaccess.h>
  18. /* Version Information */
  19. #define DRIVER_VERSION "v0.6.2 (2004/08/27)"
  20. #define DRIVER_AUTHOR "Petko Manolov <petkan@users.sourceforge.net>"
  21. #define DRIVER_DESC "rtl8150 based usb-ethernet driver"
  22. #define IDR 0x0120
  23. #define MAR 0x0126
  24. #define CR 0x012e
  25. #define TCR 0x012f
  26. #define RCR 0x0130
  27. #define TSR 0x0132
  28. #define RSR 0x0133
  29. #define CON0 0x0135
  30. #define CON1 0x0136
  31. #define MSR 0x0137
  32. #define PHYADD 0x0138
  33. #define PHYDAT 0x0139
  34. #define PHYCNT 0x013b
  35. #define GPPC 0x013d
  36. #define BMCR 0x0140
  37. #define BMSR 0x0142
  38. #define ANAR 0x0144
  39. #define ANLP 0x0146
  40. #define AER 0x0148
  41. #define CSCR 0x014C /* This one has the link status */
  42. #define CSCR_LINK_STATUS (1 << 3)
  43. #define IDR_EEPROM 0x1202
  44. #define PHY_READ 0
  45. #define PHY_WRITE 0x20
  46. #define PHY_GO 0x40
  47. #define MII_TIMEOUT 10
  48. #define INTBUFSIZE 8
  49. #define RTL8150_REQT_READ 0xc0
  50. #define RTL8150_REQT_WRITE 0x40
  51. #define RTL8150_REQ_GET_REGS 0x05
  52. #define RTL8150_REQ_SET_REGS 0x05
  53. /* Transmit status register errors */
  54. #define TSR_ECOL (1<<5)
  55. #define TSR_LCOL (1<<4)
  56. #define TSR_LOSS_CRS (1<<3)
  57. #define TSR_JBR (1<<2)
  58. #define TSR_ERRORS (TSR_ECOL | TSR_LCOL | TSR_LOSS_CRS | TSR_JBR)
  59. /* Receive status register errors */
  60. #define RSR_CRC (1<<2)
  61. #define RSR_FAE (1<<1)
  62. #define RSR_ERRORS (RSR_CRC | RSR_FAE)
  63. /* Media status register definitions */
  64. #define MSR_DUPLEX (1<<4)
  65. #define MSR_SPEED (1<<3)
  66. #define MSR_LINK (1<<2)
  67. /* Interrupt pipe data */
  68. #define INT_TSR 0x00
  69. #define INT_RSR 0x01
  70. #define INT_MSR 0x02
  71. #define INT_WAKSR 0x03
  72. #define INT_TXOK_CNT 0x04
  73. #define INT_RXLOST_CNT 0x05
  74. #define INT_CRERR_CNT 0x06
  75. #define INT_COL_CNT 0x07
  76. #define RTL8150_MTU 1540
  77. #define RTL8150_TX_TIMEOUT (HZ)
  78. #define RX_SKB_POOL_SIZE 4
  79. /* rtl8150 flags */
  80. #define RTL8150_HW_CRC 0
  81. #define RX_REG_SET 1
  82. #define RTL8150_UNPLUG 2
  83. #define RX_URB_FAIL 3
  84. /* Define these values to match your device */
  85. #define VENDOR_ID_REALTEK 0x0bda
  86. #define VENDOR_ID_MELCO 0x0411
  87. #define VENDOR_ID_MICRONET 0x3980
  88. #define VENDOR_ID_LONGSHINE 0x07b8
  89. #define VENDOR_ID_OQO 0x1557
  90. #define VENDOR_ID_ZYXEL 0x0586
  91. #define PRODUCT_ID_RTL8150 0x8150
  92. #define PRODUCT_ID_LUAKTX 0x0012
  93. #define PRODUCT_ID_LCS8138TX 0x401a
  94. #define PRODUCT_ID_SP128AR 0x0003
  95. #define PRODUCT_ID_PRESTIGE 0x401a
  96. #undef EEPROM_WRITE
  97. /* table of devices that work with this driver */
  98. static struct usb_device_id rtl8150_table[] = {
  99. {USB_DEVICE(VENDOR_ID_REALTEK, PRODUCT_ID_RTL8150)},
  100. {USB_DEVICE(VENDOR_ID_MELCO, PRODUCT_ID_LUAKTX)},
  101. {USB_DEVICE(VENDOR_ID_MICRONET, PRODUCT_ID_SP128AR)},
  102. {USB_DEVICE(VENDOR_ID_LONGSHINE, PRODUCT_ID_LCS8138TX)},
  103. {USB_DEVICE(VENDOR_ID_OQO, PRODUCT_ID_RTL8150)},
  104. {USB_DEVICE(VENDOR_ID_ZYXEL, PRODUCT_ID_PRESTIGE)},
  105. {}
  106. };
  107. MODULE_DEVICE_TABLE(usb, rtl8150_table);
  108. struct rtl8150 {
  109. unsigned long flags;
  110. struct usb_device *udev;
  111. struct tasklet_struct tl;
  112. struct net_device *netdev;
  113. struct urb *rx_urb, *tx_urb, *intr_urb, *ctrl_urb;
  114. struct sk_buff *tx_skb, *rx_skb;
  115. struct sk_buff *rx_skb_pool[RX_SKB_POOL_SIZE];
  116. spinlock_t rx_pool_lock;
  117. struct usb_ctrlrequest dr;
  118. int intr_interval;
  119. __le16 rx_creg;
  120. u8 *intr_buff;
  121. u8 phy;
  122. };
  123. typedef struct rtl8150 rtl8150_t;
  124. static const char driver_name [] = "rtl8150";
  125. /*
  126. **
  127. ** device related part of the code
  128. **
  129. */
  130. static int get_registers(rtl8150_t * dev, u16 indx, u16 size, void *data)
  131. {
  132. return usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0),
  133. RTL8150_REQ_GET_REGS, RTL8150_REQT_READ,
  134. indx, 0, data, size, 500);
  135. }
  136. static int set_registers(rtl8150_t * dev, u16 indx, u16 size, void *data)
  137. {
  138. return usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0),
  139. RTL8150_REQ_SET_REGS, RTL8150_REQT_WRITE,
  140. indx, 0, data, size, 500);
  141. }
  142. static void ctrl_callback(struct urb *urb)
  143. {
  144. rtl8150_t *dev;
  145. int status = urb->status;
  146. switch (status) {
  147. case 0:
  148. break;
  149. case -EINPROGRESS:
  150. break;
  151. case -ENOENT:
  152. break;
  153. default:
  154. if (printk_ratelimit())
  155. dev_warn(&urb->dev->dev, "ctrl urb status %d\n", status);
  156. }
  157. dev = urb->context;
  158. clear_bit(RX_REG_SET, &dev->flags);
  159. }
  160. static int async_set_registers(rtl8150_t * dev, u16 indx, u16 size)
  161. {
  162. int ret;
  163. if (test_bit(RX_REG_SET, &dev->flags))
  164. return -EAGAIN;
  165. dev->dr.bRequestType = RTL8150_REQT_WRITE;
  166. dev->dr.bRequest = RTL8150_REQ_SET_REGS;
  167. dev->dr.wValue = cpu_to_le16(indx);
  168. dev->dr.wIndex = 0;
  169. dev->dr.wLength = cpu_to_le16(size);
  170. dev->ctrl_urb->transfer_buffer_length = size;
  171. usb_fill_control_urb(dev->ctrl_urb, dev->udev,
  172. usb_sndctrlpipe(dev->udev, 0), (char *) &dev->dr,
  173. &dev->rx_creg, size, ctrl_callback, dev);
  174. if ((ret = usb_submit_urb(dev->ctrl_urb, GFP_ATOMIC))) {
  175. if (ret == -ENODEV)
  176. netif_device_detach(dev->netdev);
  177. err("control request submission failed: %d", ret);
  178. } else
  179. set_bit(RX_REG_SET, &dev->flags);
  180. return ret;
  181. }
  182. static int read_mii_word(rtl8150_t * dev, u8 phy, __u8 indx, u16 * reg)
  183. {
  184. int i;
  185. u8 data[3], tmp;
  186. data[0] = phy;
  187. data[1] = data[2] = 0;
  188. tmp = indx | PHY_READ | PHY_GO;
  189. i = 0;
  190. set_registers(dev, PHYADD, sizeof(data), data);
  191. set_registers(dev, PHYCNT, 1, &tmp);
  192. do {
  193. get_registers(dev, PHYCNT, 1, data);
  194. } while ((data[0] & PHY_GO) && (i++ < MII_TIMEOUT));
  195. if (i <= MII_TIMEOUT) {
  196. get_registers(dev, PHYDAT, 2, data);
  197. *reg = data[0] | (data[1] << 8);
  198. return 0;
  199. } else
  200. return 1;
  201. }
  202. static int write_mii_word(rtl8150_t * dev, u8 phy, __u8 indx, u16 reg)
  203. {
  204. int i;
  205. u8 data[3], tmp;
  206. data[0] = phy;
  207. data[1] = reg & 0xff;
  208. data[2] = (reg >> 8) & 0xff;
  209. tmp = indx | PHY_WRITE | PHY_GO;
  210. i = 0;
  211. set_registers(dev, PHYADD, sizeof(data), data);
  212. set_registers(dev, PHYCNT, 1, &tmp);
  213. do {
  214. get_registers(dev, PHYCNT, 1, data);
  215. } while ((data[0] & PHY_GO) && (i++ < MII_TIMEOUT));
  216. if (i <= MII_TIMEOUT)
  217. return 0;
  218. else
  219. return 1;
  220. }
  221. static inline void set_ethernet_addr(rtl8150_t * dev)
  222. {
  223. u8 node_id[6];
  224. get_registers(dev, IDR, sizeof(node_id), node_id);
  225. memcpy(dev->netdev->dev_addr, node_id, sizeof(node_id));
  226. }
  227. static int rtl8150_set_mac_address(struct net_device *netdev, void *p)
  228. {
  229. struct sockaddr *addr = p;
  230. rtl8150_t *dev = netdev_priv(netdev);
  231. if (netif_running(netdev))
  232. return -EBUSY;
  233. memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
  234. dbg("%s: Setting MAC address to %pM\n", netdev->name, netdev->dev_addr);
  235. /* Set the IDR registers. */
  236. set_registers(dev, IDR, netdev->addr_len, netdev->dev_addr);
  237. #ifdef EEPROM_WRITE
  238. {
  239. int i;
  240. u8 cr;
  241. /* Get the CR contents. */
  242. get_registers(dev, CR, 1, &cr);
  243. /* Set the WEPROM bit (eeprom write enable). */
  244. cr |= 0x20;
  245. set_registers(dev, CR, 1, &cr);
  246. /* Write the MAC address into eeprom. Eeprom writes must be word-sized,
  247. so we need to split them up. */
  248. for (i = 0; i * 2 < netdev->addr_len; i++) {
  249. set_registers(dev, IDR_EEPROM + (i * 2), 2,
  250. netdev->dev_addr + (i * 2));
  251. }
  252. /* Clear the WEPROM bit (preventing accidental eeprom writes). */
  253. cr &= 0xdf;
  254. set_registers(dev, CR, 1, &cr);
  255. }
  256. #endif
  257. return 0;
  258. }
  259. static int rtl8150_reset(rtl8150_t * dev)
  260. {
  261. u8 data = 0x10;
  262. int i = HZ;
  263. set_registers(dev, CR, 1, &data);
  264. do {
  265. get_registers(dev, CR, 1, &data);
  266. } while ((data & 0x10) && --i);
  267. return (i > 0) ? 1 : 0;
  268. }
  269. static int alloc_all_urbs(rtl8150_t * dev)
  270. {
  271. dev->rx_urb = usb_alloc_urb(0, GFP_KERNEL);
  272. if (!dev->rx_urb)
  273. return 0;
  274. dev->tx_urb = usb_alloc_urb(0, GFP_KERNEL);
  275. if (!dev->tx_urb) {
  276. usb_free_urb(dev->rx_urb);
  277. return 0;
  278. }
  279. dev->intr_urb = usb_alloc_urb(0, GFP_KERNEL);
  280. if (!dev->intr_urb) {
  281. usb_free_urb(dev->rx_urb);
  282. usb_free_urb(dev->tx_urb);
  283. return 0;
  284. }
  285. dev->ctrl_urb = usb_alloc_urb(0, GFP_KERNEL);
  286. if (!dev->ctrl_urb) {
  287. usb_free_urb(dev->rx_urb);
  288. usb_free_urb(dev->tx_urb);
  289. usb_free_urb(dev->intr_urb);
  290. return 0;
  291. }
  292. return 1;
  293. }
  294. static void free_all_urbs(rtl8150_t * dev)
  295. {
  296. usb_free_urb(dev->rx_urb);
  297. usb_free_urb(dev->tx_urb);
  298. usb_free_urb(dev->intr_urb);
  299. usb_free_urb(dev->ctrl_urb);
  300. }
  301. static void unlink_all_urbs(rtl8150_t * dev)
  302. {
  303. usb_kill_urb(dev->rx_urb);
  304. usb_kill_urb(dev->tx_urb);
  305. usb_kill_urb(dev->intr_urb);
  306. usb_kill_urb(dev->ctrl_urb);
  307. }
  308. static inline struct sk_buff *pull_skb(rtl8150_t *dev)
  309. {
  310. struct sk_buff *skb;
  311. int i;
  312. for (i = 0; i < RX_SKB_POOL_SIZE; i++) {
  313. if (dev->rx_skb_pool[i]) {
  314. skb = dev->rx_skb_pool[i];
  315. dev->rx_skb_pool[i] = NULL;
  316. return skb;
  317. }
  318. }
  319. return NULL;
  320. }
  321. static void read_bulk_callback(struct urb *urb)
  322. {
  323. rtl8150_t *dev;
  324. unsigned pkt_len, res;
  325. struct sk_buff *skb;
  326. struct net_device *netdev;
  327. u16 rx_stat;
  328. int status = urb->status;
  329. int result;
  330. dev = urb->context;
  331. if (!dev)
  332. return;
  333. if (test_bit(RTL8150_UNPLUG, &dev->flags))
  334. return;
  335. netdev = dev->netdev;
  336. if (!netif_device_present(netdev))
  337. return;
  338. switch (status) {
  339. case 0:
  340. break;
  341. case -ENOENT:
  342. return; /* the urb is in unlink state */
  343. case -ETIME:
  344. if (printk_ratelimit())
  345. dev_warn(&urb->dev->dev, "may be reset is needed?..\n");
  346. goto goon;
  347. default:
  348. if (printk_ratelimit())
  349. dev_warn(&urb->dev->dev, "Rx status %d\n", status);
  350. goto goon;
  351. }
  352. if (!dev->rx_skb)
  353. goto resched;
  354. /* protect against short packets (tell me why we got some?!?) */
  355. if (urb->actual_length < 4)
  356. goto goon;
  357. res = urb->actual_length;
  358. rx_stat = le16_to_cpu(*(__le16 *)(urb->transfer_buffer + res - 4));
  359. pkt_len = res - 4;
  360. skb_put(dev->rx_skb, pkt_len);
  361. dev->rx_skb->protocol = eth_type_trans(dev->rx_skb, netdev);
  362. netif_rx(dev->rx_skb);
  363. netdev->stats.rx_packets++;
  364. netdev->stats.rx_bytes += pkt_len;
  365. spin_lock(&dev->rx_pool_lock);
  366. skb = pull_skb(dev);
  367. spin_unlock(&dev->rx_pool_lock);
  368. if (!skb)
  369. goto resched;
  370. dev->rx_skb = skb;
  371. goon:
  372. usb_fill_bulk_urb(dev->rx_urb, dev->udev, usb_rcvbulkpipe(dev->udev, 1),
  373. dev->rx_skb->data, RTL8150_MTU, read_bulk_callback, dev);
  374. result = usb_submit_urb(dev->rx_urb, GFP_ATOMIC);
  375. if (result == -ENODEV)
  376. netif_device_detach(dev->netdev);
  377. else if (result) {
  378. set_bit(RX_URB_FAIL, &dev->flags);
  379. goto resched;
  380. } else {
  381. clear_bit(RX_URB_FAIL, &dev->flags);
  382. }
  383. return;
  384. resched:
  385. tasklet_schedule(&dev->tl);
  386. }
  387. static void write_bulk_callback(struct urb *urb)
  388. {
  389. rtl8150_t *dev;
  390. int status = urb->status;
  391. dev = urb->context;
  392. if (!dev)
  393. return;
  394. dev_kfree_skb_irq(dev->tx_skb);
  395. if (!netif_device_present(dev->netdev))
  396. return;
  397. if (status)
  398. dev_info(&urb->dev->dev, "%s: Tx status %d\n",
  399. dev->netdev->name, status);
  400. dev->netdev->trans_start = jiffies;
  401. netif_wake_queue(dev->netdev);
  402. }
  403. static void intr_callback(struct urb *urb)
  404. {
  405. rtl8150_t *dev;
  406. __u8 *d;
  407. int status = urb->status;
  408. int res;
  409. dev = urb->context;
  410. if (!dev)
  411. return;
  412. switch (status) {
  413. case 0: /* success */
  414. break;
  415. case -ECONNRESET: /* unlink */
  416. case -ENOENT:
  417. case -ESHUTDOWN:
  418. return;
  419. /* -EPIPE: should clear the halt */
  420. default:
  421. dev_info(&urb->dev->dev, "%s: intr status %d\n",
  422. dev->netdev->name, status);
  423. goto resubmit;
  424. }
  425. d = urb->transfer_buffer;
  426. if (d[0] & TSR_ERRORS) {
  427. dev->netdev->stats.tx_errors++;
  428. if (d[INT_TSR] & (TSR_ECOL | TSR_JBR))
  429. dev->netdev->stats.tx_aborted_errors++;
  430. if (d[INT_TSR] & TSR_LCOL)
  431. dev->netdev->stats.tx_window_errors++;
  432. if (d[INT_TSR] & TSR_LOSS_CRS)
  433. dev->netdev->stats.tx_carrier_errors++;
  434. }
  435. /* Report link status changes to the network stack */
  436. if ((d[INT_MSR] & MSR_LINK) == 0) {
  437. if (netif_carrier_ok(dev->netdev)) {
  438. netif_carrier_off(dev->netdev);
  439. dbg("%s: LINK LOST\n", __func__);
  440. }
  441. } else {
  442. if (!netif_carrier_ok(dev->netdev)) {
  443. netif_carrier_on(dev->netdev);
  444. dbg("%s: LINK CAME BACK\n", __func__);
  445. }
  446. }
  447. resubmit:
  448. res = usb_submit_urb (urb, GFP_ATOMIC);
  449. if (res == -ENODEV)
  450. netif_device_detach(dev->netdev);
  451. else if (res)
  452. err ("can't resubmit intr, %s-%s/input0, status %d",
  453. dev->udev->bus->bus_name,
  454. dev->udev->devpath, res);
  455. }
  456. static int rtl8150_suspend(struct usb_interface *intf, pm_message_t message)
  457. {
  458. rtl8150_t *dev = usb_get_intfdata(intf);
  459. netif_device_detach(dev->netdev);
  460. if (netif_running(dev->netdev)) {
  461. usb_kill_urb(dev->rx_urb);
  462. usb_kill_urb(dev->intr_urb);
  463. }
  464. return 0;
  465. }
  466. static int rtl8150_resume(struct usb_interface *intf)
  467. {
  468. rtl8150_t *dev = usb_get_intfdata(intf);
  469. netif_device_attach(dev->netdev);
  470. if (netif_running(dev->netdev)) {
  471. dev->rx_urb->status = 0;
  472. dev->rx_urb->actual_length = 0;
  473. read_bulk_callback(dev->rx_urb);
  474. dev->intr_urb->status = 0;
  475. dev->intr_urb->actual_length = 0;
  476. intr_callback(dev->intr_urb);
  477. }
  478. return 0;
  479. }
  480. /*
  481. **
  482. ** network related part of the code
  483. **
  484. */
  485. static void fill_skb_pool(rtl8150_t *dev)
  486. {
  487. struct sk_buff *skb;
  488. int i;
  489. for (i = 0; i < RX_SKB_POOL_SIZE; i++) {
  490. if (dev->rx_skb_pool[i])
  491. continue;
  492. skb = dev_alloc_skb(RTL8150_MTU + 2);
  493. if (!skb) {
  494. return;
  495. }
  496. skb_reserve(skb, 2);
  497. dev->rx_skb_pool[i] = skb;
  498. }
  499. }
  500. static void free_skb_pool(rtl8150_t *dev)
  501. {
  502. int i;
  503. for (i = 0; i < RX_SKB_POOL_SIZE; i++)
  504. if (dev->rx_skb_pool[i])
  505. dev_kfree_skb(dev->rx_skb_pool[i]);
  506. }
  507. static void rx_fixup(unsigned long data)
  508. {
  509. struct rtl8150 *dev = (struct rtl8150 *)data;
  510. struct sk_buff *skb;
  511. int status;
  512. spin_lock_irq(&dev->rx_pool_lock);
  513. fill_skb_pool(dev);
  514. spin_unlock_irq(&dev->rx_pool_lock);
  515. if (test_bit(RX_URB_FAIL, &dev->flags))
  516. if (dev->rx_skb)
  517. goto try_again;
  518. spin_lock_irq(&dev->rx_pool_lock);
  519. skb = pull_skb(dev);
  520. spin_unlock_irq(&dev->rx_pool_lock);
  521. if (skb == NULL)
  522. goto tlsched;
  523. dev->rx_skb = skb;
  524. usb_fill_bulk_urb(dev->rx_urb, dev->udev, usb_rcvbulkpipe(dev->udev, 1),
  525. dev->rx_skb->data, RTL8150_MTU, read_bulk_callback, dev);
  526. try_again:
  527. status = usb_submit_urb(dev->rx_urb, GFP_ATOMIC);
  528. if (status == -ENODEV) {
  529. netif_device_detach(dev->netdev);
  530. } else if (status) {
  531. set_bit(RX_URB_FAIL, &dev->flags);
  532. goto tlsched;
  533. } else {
  534. clear_bit(RX_URB_FAIL, &dev->flags);
  535. }
  536. return;
  537. tlsched:
  538. tasklet_schedule(&dev->tl);
  539. }
  540. static int enable_net_traffic(rtl8150_t * dev)
  541. {
  542. u8 cr, tcr, rcr, msr;
  543. if (!rtl8150_reset(dev)) {
  544. dev_warn(&dev->udev->dev, "device reset failed\n");
  545. }
  546. /* RCR bit7=1 attach Rx info at the end; =0 HW CRC (which is broken) */
  547. rcr = 0x9e;
  548. dev->rx_creg = cpu_to_le16(rcr);
  549. tcr = 0xd8;
  550. cr = 0x0c;
  551. if (!(rcr & 0x80))
  552. set_bit(RTL8150_HW_CRC, &dev->flags);
  553. set_registers(dev, RCR, 1, &rcr);
  554. set_registers(dev, TCR, 1, &tcr);
  555. set_registers(dev, CR, 1, &cr);
  556. get_registers(dev, MSR, 1, &msr);
  557. return 0;
  558. }
  559. static void disable_net_traffic(rtl8150_t * dev)
  560. {
  561. u8 cr;
  562. get_registers(dev, CR, 1, &cr);
  563. cr &= 0xf3;
  564. set_registers(dev, CR, 1, &cr);
  565. }
  566. static void rtl8150_tx_timeout(struct net_device *netdev)
  567. {
  568. rtl8150_t *dev = netdev_priv(netdev);
  569. dev_warn(&netdev->dev, "Tx timeout.\n");
  570. usb_unlink_urb(dev->tx_urb);
  571. netdev->stats.tx_errors++;
  572. }
  573. static void rtl8150_set_multicast(struct net_device *netdev)
  574. {
  575. rtl8150_t *dev = netdev_priv(netdev);
  576. netif_stop_queue(netdev);
  577. if (netdev->flags & IFF_PROMISC) {
  578. dev->rx_creg |= cpu_to_le16(0x0001);
  579. dev_info(&netdev->dev, "%s: promiscuous mode\n", netdev->name);
  580. } else if (!netdev_mc_empty(netdev) ||
  581. (netdev->flags & IFF_ALLMULTI)) {
  582. dev->rx_creg &= cpu_to_le16(0xfffe);
  583. dev->rx_creg |= cpu_to_le16(0x0002);
  584. dev_info(&netdev->dev, "%s: allmulti set\n", netdev->name);
  585. } else {
  586. /* ~RX_MULTICAST, ~RX_PROMISCUOUS */
  587. dev->rx_creg &= cpu_to_le16(0x00fc);
  588. }
  589. async_set_registers(dev, RCR, 2);
  590. netif_wake_queue(netdev);
  591. }
  592. static netdev_tx_t rtl8150_start_xmit(struct sk_buff *skb,
  593. struct net_device *netdev)
  594. {
  595. rtl8150_t *dev = netdev_priv(netdev);
  596. int count, res;
  597. netif_stop_queue(netdev);
  598. count = (skb->len < 60) ? 60 : skb->len;
  599. count = (count & 0x3f) ? count : count + 1;
  600. dev->tx_skb = skb;
  601. usb_fill_bulk_urb(dev->tx_urb, dev->udev, usb_sndbulkpipe(dev->udev, 2),
  602. skb->data, count, write_bulk_callback, dev);
  603. if ((res = usb_submit_urb(dev->tx_urb, GFP_ATOMIC))) {
  604. /* Can we get/handle EPIPE here? */
  605. if (res == -ENODEV)
  606. netif_device_detach(dev->netdev);
  607. else {
  608. dev_warn(&netdev->dev, "failed tx_urb %d\n", res);
  609. netdev->stats.tx_errors++;
  610. netif_start_queue(netdev);
  611. }
  612. } else {
  613. netdev->stats.tx_packets++;
  614. netdev->stats.tx_bytes += skb->len;
  615. netdev->trans_start = jiffies;
  616. }
  617. return NETDEV_TX_OK;
  618. }
  619. static void set_carrier(struct net_device *netdev)
  620. {
  621. rtl8150_t *dev = netdev_priv(netdev);
  622. short tmp;
  623. get_registers(dev, CSCR, 2, &tmp);
  624. if (tmp & CSCR_LINK_STATUS)
  625. netif_carrier_on(netdev);
  626. else
  627. netif_carrier_off(netdev);
  628. }
  629. static int rtl8150_open(struct net_device *netdev)
  630. {
  631. rtl8150_t *dev = netdev_priv(netdev);
  632. int res;
  633. if (dev->rx_skb == NULL)
  634. dev->rx_skb = pull_skb(dev);
  635. if (!dev->rx_skb)
  636. return -ENOMEM;
  637. set_registers(dev, IDR, 6, netdev->dev_addr);
  638. usb_fill_bulk_urb(dev->rx_urb, dev->udev, usb_rcvbulkpipe(dev->udev, 1),
  639. dev->rx_skb->data, RTL8150_MTU, read_bulk_callback, dev);
  640. if ((res = usb_submit_urb(dev->rx_urb, GFP_KERNEL))) {
  641. if (res == -ENODEV)
  642. netif_device_detach(dev->netdev);
  643. dev_warn(&netdev->dev, "rx_urb submit failed: %d\n", res);
  644. return res;
  645. }
  646. usb_fill_int_urb(dev->intr_urb, dev->udev, usb_rcvintpipe(dev->udev, 3),
  647. dev->intr_buff, INTBUFSIZE, intr_callback,
  648. dev, dev->intr_interval);
  649. if ((res = usb_submit_urb(dev->intr_urb, GFP_KERNEL))) {
  650. if (res == -ENODEV)
  651. netif_device_detach(dev->netdev);
  652. dev_warn(&netdev->dev, "intr_urb submit failed: %d\n", res);
  653. usb_kill_urb(dev->rx_urb);
  654. return res;
  655. }
  656. enable_net_traffic(dev);
  657. set_carrier(netdev);
  658. netif_start_queue(netdev);
  659. return res;
  660. }
  661. static int rtl8150_close(struct net_device *netdev)
  662. {
  663. rtl8150_t *dev = netdev_priv(netdev);
  664. int res = 0;
  665. netif_stop_queue(netdev);
  666. if (!test_bit(RTL8150_UNPLUG, &dev->flags))
  667. disable_net_traffic(dev);
  668. unlink_all_urbs(dev);
  669. return res;
  670. }
  671. static void rtl8150_get_drvinfo(struct net_device *netdev, struct ethtool_drvinfo *info)
  672. {
  673. rtl8150_t *dev = netdev_priv(netdev);
  674. strncpy(info->driver, driver_name, ETHTOOL_BUSINFO_LEN);
  675. strncpy(info->version, DRIVER_VERSION, ETHTOOL_BUSINFO_LEN);
  676. usb_make_path(dev->udev, info->bus_info, sizeof info->bus_info);
  677. }
  678. static int rtl8150_get_settings(struct net_device *netdev, struct ethtool_cmd *ecmd)
  679. {
  680. rtl8150_t *dev = netdev_priv(netdev);
  681. short lpa, bmcr;
  682. ecmd->supported = (SUPPORTED_10baseT_Half |
  683. SUPPORTED_10baseT_Full |
  684. SUPPORTED_100baseT_Half |
  685. SUPPORTED_100baseT_Full |
  686. SUPPORTED_Autoneg |
  687. SUPPORTED_TP | SUPPORTED_MII);
  688. ecmd->port = PORT_TP;
  689. ecmd->transceiver = XCVR_INTERNAL;
  690. ecmd->phy_address = dev->phy;
  691. get_registers(dev, BMCR, 2, &bmcr);
  692. get_registers(dev, ANLP, 2, &lpa);
  693. if (bmcr & BMCR_ANENABLE) {
  694. u32 speed = ((lpa & (LPA_100HALF | LPA_100FULL)) ?
  695. SPEED_100 : SPEED_10);
  696. ethtool_cmd_speed_set(ecmd, speed);
  697. ecmd->autoneg = AUTONEG_ENABLE;
  698. if (speed == SPEED_100)
  699. ecmd->duplex = (lpa & LPA_100FULL) ?
  700. DUPLEX_FULL : DUPLEX_HALF;
  701. else
  702. ecmd->duplex = (lpa & LPA_10FULL) ?
  703. DUPLEX_FULL : DUPLEX_HALF;
  704. } else {
  705. ecmd->autoneg = AUTONEG_DISABLE;
  706. ethtool_cmd_speed_set(ecmd, ((bmcr & BMCR_SPEED100) ?
  707. SPEED_100 : SPEED_10));
  708. ecmd->duplex = (bmcr & BMCR_FULLDPLX) ?
  709. DUPLEX_FULL : DUPLEX_HALF;
  710. }
  711. return 0;
  712. }
  713. static const struct ethtool_ops ops = {
  714. .get_drvinfo = rtl8150_get_drvinfo,
  715. .get_settings = rtl8150_get_settings,
  716. .get_link = ethtool_op_get_link
  717. };
  718. static int rtl8150_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)
  719. {
  720. rtl8150_t *dev = netdev_priv(netdev);
  721. u16 *data = (u16 *) & rq->ifr_ifru;
  722. int res = 0;
  723. switch (cmd) {
  724. case SIOCDEVPRIVATE:
  725. data[0] = dev->phy;
  726. case SIOCDEVPRIVATE + 1:
  727. read_mii_word(dev, dev->phy, (data[1] & 0x1f), &data[3]);
  728. break;
  729. case SIOCDEVPRIVATE + 2:
  730. if (!capable(CAP_NET_ADMIN))
  731. return -EPERM;
  732. write_mii_word(dev, dev->phy, (data[1] & 0x1f), data[2]);
  733. break;
  734. default:
  735. res = -EOPNOTSUPP;
  736. }
  737. return res;
  738. }
  739. static const struct net_device_ops rtl8150_netdev_ops = {
  740. .ndo_open = rtl8150_open,
  741. .ndo_stop = rtl8150_close,
  742. .ndo_do_ioctl = rtl8150_ioctl,
  743. .ndo_start_xmit = rtl8150_start_xmit,
  744. .ndo_tx_timeout = rtl8150_tx_timeout,
  745. .ndo_set_rx_mode = rtl8150_set_multicast,
  746. .ndo_set_mac_address = rtl8150_set_mac_address,
  747. .ndo_change_mtu = eth_change_mtu,
  748. .ndo_validate_addr = eth_validate_addr,
  749. };
  750. static int rtl8150_probe(struct usb_interface *intf,
  751. const struct usb_device_id *id)
  752. {
  753. struct usb_device *udev = interface_to_usbdev(intf);
  754. rtl8150_t *dev;
  755. struct net_device *netdev;
  756. netdev = alloc_etherdev(sizeof(rtl8150_t));
  757. if (!netdev)
  758. return -ENOMEM;
  759. dev = netdev_priv(netdev);
  760. dev->intr_buff = kmalloc(INTBUFSIZE, GFP_KERNEL);
  761. if (!dev->intr_buff) {
  762. free_netdev(netdev);
  763. return -ENOMEM;
  764. }
  765. tasklet_init(&dev->tl, rx_fixup, (unsigned long)dev);
  766. spin_lock_init(&dev->rx_pool_lock);
  767. dev->udev = udev;
  768. dev->netdev = netdev;
  769. netdev->netdev_ops = &rtl8150_netdev_ops;
  770. netdev->watchdog_timeo = RTL8150_TX_TIMEOUT;
  771. SET_ETHTOOL_OPS(netdev, &ops);
  772. dev->intr_interval = 100; /* 100ms */
  773. if (!alloc_all_urbs(dev)) {
  774. err("out of memory");
  775. goto out;
  776. }
  777. if (!rtl8150_reset(dev)) {
  778. err("couldn't reset the device");
  779. goto out1;
  780. }
  781. fill_skb_pool(dev);
  782. set_ethernet_addr(dev);
  783. usb_set_intfdata(intf, dev);
  784. SET_NETDEV_DEV(netdev, &intf->dev);
  785. if (register_netdev(netdev) != 0) {
  786. err("couldn't register the device");
  787. goto out2;
  788. }
  789. dev_info(&intf->dev, "%s: rtl8150 is detected\n", netdev->name);
  790. return 0;
  791. out2:
  792. usb_set_intfdata(intf, NULL);
  793. free_skb_pool(dev);
  794. out1:
  795. free_all_urbs(dev);
  796. out:
  797. kfree(dev->intr_buff);
  798. free_netdev(netdev);
  799. return -EIO;
  800. }
  801. static void rtl8150_disconnect(struct usb_interface *intf)
  802. {
  803. rtl8150_t *dev = usb_get_intfdata(intf);
  804. usb_set_intfdata(intf, NULL);
  805. if (dev) {
  806. set_bit(RTL8150_UNPLUG, &dev->flags);
  807. tasklet_kill(&dev->tl);
  808. unregister_netdev(dev->netdev);
  809. unlink_all_urbs(dev);
  810. free_all_urbs(dev);
  811. free_skb_pool(dev);
  812. if (dev->rx_skb)
  813. dev_kfree_skb(dev->rx_skb);
  814. kfree(dev->intr_buff);
  815. free_netdev(dev->netdev);
  816. }
  817. }
  818. static struct usb_driver rtl8150_driver = {
  819. .name = driver_name,
  820. .probe = rtl8150_probe,
  821. .disconnect = rtl8150_disconnect,
  822. .id_table = rtl8150_table,
  823. .suspend = rtl8150_suspend,
  824. .resume = rtl8150_resume
  825. };
  826. module_usb_driver(rtl8150_driver);
  827. MODULE_AUTHOR(DRIVER_AUTHOR);
  828. MODULE_DESCRIPTION(DRIVER_DESC);
  829. MODULE_LICENSE("GPL");