smsc95xx.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879
  1. /*
  2. * Copyright (c) 2011 The Chromium OS Authors.
  3. * Copyright (C) 2009 NVIDIA, Corporation
  4. * See file CREDITS for list of people who contributed to this
  5. * project.
  6. *
  7. * This program is free software; you can redistribute it and/or
  8. * modify it under the terms of the GNU General Public License as
  9. * published by the Free Software Foundation; either version 2 of
  10. * the License, or (at your option) any later version.
  11. *
  12. * This program is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  15. * GNU General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU General Public License
  18. * along with this program; if not, write to the Free Software
  19. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  20. * MA 02111-1307 USA
  21. */
  22. #include <common.h>
  23. #include <usb.h>
  24. #include <linux/mii.h>
  25. #include "usb_ether.h"
  26. /* SMSC LAN95xx based USB 2.0 Ethernet Devices */
  27. /* Tx command words */
  28. #define TX_CMD_A_FIRST_SEG_ 0x00002000
  29. #define TX_CMD_A_LAST_SEG_ 0x00001000
  30. /* Rx status word */
  31. #define RX_STS_FL_ 0x3FFF0000 /* Frame Length */
  32. #define RX_STS_ES_ 0x00008000 /* Error Summary */
  33. /* SCSRs */
  34. #define ID_REV 0x00
  35. #define INT_STS 0x08
  36. #define TX_CFG 0x10
  37. #define TX_CFG_ON_ 0x00000004
  38. #define HW_CFG 0x14
  39. #define HW_CFG_BIR_ 0x00001000
  40. #define HW_CFG_RXDOFF_ 0x00000600
  41. #define HW_CFG_MEF_ 0x00000020
  42. #define HW_CFG_BCE_ 0x00000002
  43. #define HW_CFG_LRST_ 0x00000008
  44. #define PM_CTRL 0x20
  45. #define PM_CTL_PHY_RST_ 0x00000010
  46. #define AFC_CFG 0x2C
  47. /*
  48. * Hi watermark = 15.5Kb (~10 mtu pkts)
  49. * low watermark = 3k (~2 mtu pkts)
  50. * backpressure duration = ~ 350us
  51. * Apply FC on any frame.
  52. */
  53. #define AFC_CFG_DEFAULT 0x00F830A1
  54. #define E2P_CMD 0x30
  55. #define E2P_CMD_BUSY_ 0x80000000
  56. #define E2P_CMD_READ_ 0x00000000
  57. #define E2P_CMD_TIMEOUT_ 0x00000400
  58. #define E2P_CMD_LOADED_ 0x00000200
  59. #define E2P_CMD_ADDR_ 0x000001FF
  60. #define E2P_DATA 0x34
  61. #define BURST_CAP 0x38
  62. #define INT_EP_CTL 0x68
  63. #define INT_EP_CTL_PHY_INT_ 0x00008000
  64. #define BULK_IN_DLY 0x6C
  65. /* MAC CSRs */
  66. #define MAC_CR 0x100
  67. #define MAC_CR_MCPAS_ 0x00080000
  68. #define MAC_CR_PRMS_ 0x00040000
  69. #define MAC_CR_HPFILT_ 0x00002000
  70. #define MAC_CR_TXEN_ 0x00000008
  71. #define MAC_CR_RXEN_ 0x00000004
  72. #define ADDRH 0x104
  73. #define ADDRL 0x108
  74. #define MII_ADDR 0x114
  75. #define MII_WRITE_ 0x02
  76. #define MII_BUSY_ 0x01
  77. #define MII_READ_ 0x00 /* ~of MII Write bit */
  78. #define MII_DATA 0x118
  79. #define FLOW 0x11C
  80. #define VLAN1 0x120
  81. #define COE_CR 0x130
  82. #define Tx_COE_EN_ 0x00010000
  83. #define Rx_COE_EN_ 0x00000001
  84. /* Vendor-specific PHY Definitions */
  85. #define PHY_INT_SRC 29
  86. #define PHY_INT_MASK 30
  87. #define PHY_INT_MASK_ANEG_COMP_ ((u16)0x0040)
  88. #define PHY_INT_MASK_LINK_DOWN_ ((u16)0x0010)
  89. #define PHY_INT_MASK_DEFAULT_ (PHY_INT_MASK_ANEG_COMP_ | \
  90. PHY_INT_MASK_LINK_DOWN_)
  91. /* USB Vendor Requests */
  92. #define USB_VENDOR_REQUEST_WRITE_REGISTER 0xA0
  93. #define USB_VENDOR_REQUEST_READ_REGISTER 0xA1
  94. /* Some extra defines */
  95. #define HS_USB_PKT_SIZE 512
  96. #define FS_USB_PKT_SIZE 64
  97. #define DEFAULT_HS_BURST_CAP_SIZE (16 * 1024 + 5 * HS_USB_PKT_SIZE)
  98. #define DEFAULT_FS_BURST_CAP_SIZE (6 * 1024 + 33 * FS_USB_PKT_SIZE)
  99. #define DEFAULT_BULK_IN_DELAY 0x00002000
  100. #define MAX_SINGLE_PACKET_SIZE 2048
  101. #define EEPROM_MAC_OFFSET 0x01
  102. #define SMSC95XX_INTERNAL_PHY_ID 1
  103. #define ETH_P_8021Q 0x8100 /* 802.1Q VLAN Extended Header */
  104. /* local defines */
  105. #define SMSC95XX_BASE_NAME "sms"
  106. #define USB_CTRL_SET_TIMEOUT 5000
  107. #define USB_CTRL_GET_TIMEOUT 5000
  108. #define USB_BULK_SEND_TIMEOUT 5000
  109. #define USB_BULK_RECV_TIMEOUT 5000
  110. #define AX_RX_URB_SIZE 2048
  111. #define PHY_CONNECT_TIMEOUT 5000
  112. #define TURBO_MODE
  113. /* local vars */
  114. static int curr_eth_dev; /* index for name of next device detected */
  115. /*
  116. * Smsc95xx infrastructure commands
  117. */
  118. static int smsc95xx_write_reg(struct ueth_data *dev, u32 index, u32 data)
  119. {
  120. int len;
  121. cpu_to_le32s(&data);
  122. len = usb_control_msg(dev->pusb_dev, usb_sndctrlpipe(dev->pusb_dev, 0),
  123. USB_VENDOR_REQUEST_WRITE_REGISTER,
  124. USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  125. 00, index, &data, sizeof(data), USB_CTRL_SET_TIMEOUT);
  126. if (len != sizeof(data)) {
  127. debug("smsc95xx_write_reg failed: index=%d, data=%d, len=%d",
  128. index, data, len);
  129. return -1;
  130. }
  131. return 0;
  132. }
  133. static int smsc95xx_read_reg(struct ueth_data *dev, u32 index, u32 *data)
  134. {
  135. int len;
  136. len = usb_control_msg(dev->pusb_dev, usb_rcvctrlpipe(dev->pusb_dev, 0),
  137. USB_VENDOR_REQUEST_READ_REGISTER,
  138. USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  139. 00, index, data, sizeof(data), USB_CTRL_GET_TIMEOUT);
  140. if (len != sizeof(data)) {
  141. debug("smsc95xx_read_reg failed: index=%d, len=%d",
  142. index, len);
  143. return -1;
  144. }
  145. le32_to_cpus(data);
  146. return 0;
  147. }
  148. /* Loop until the read is completed with timeout */
  149. static int smsc95xx_phy_wait_not_busy(struct ueth_data *dev)
  150. {
  151. unsigned long start_time = get_timer(0);
  152. u32 val;
  153. do {
  154. smsc95xx_read_reg(dev, MII_ADDR, &val);
  155. if (!(val & MII_BUSY_))
  156. return 0;
  157. } while (get_timer(start_time) < 1 * 1000 * 1000);
  158. return -1;
  159. }
  160. static int smsc95xx_mdio_read(struct ueth_data *dev, int phy_id, int idx)
  161. {
  162. u32 val, addr;
  163. /* confirm MII not busy */
  164. if (smsc95xx_phy_wait_not_busy(dev)) {
  165. debug("MII is busy in smsc95xx_mdio_read\n");
  166. return -1;
  167. }
  168. /* set the address, index & direction (read from PHY) */
  169. addr = (phy_id << 11) | (idx << 6) | MII_READ_;
  170. smsc95xx_write_reg(dev, MII_ADDR, addr);
  171. if (smsc95xx_phy_wait_not_busy(dev)) {
  172. debug("Timed out reading MII reg %02X\n", idx);
  173. return -1;
  174. }
  175. smsc95xx_read_reg(dev, MII_DATA, &val);
  176. return (u16)(val & 0xFFFF);
  177. }
  178. static void smsc95xx_mdio_write(struct ueth_data *dev, int phy_id, int idx,
  179. int regval)
  180. {
  181. u32 val, addr;
  182. /* confirm MII not busy */
  183. if (smsc95xx_phy_wait_not_busy(dev)) {
  184. debug("MII is busy in smsc95xx_mdio_write\n");
  185. return;
  186. }
  187. val = regval;
  188. smsc95xx_write_reg(dev, MII_DATA, val);
  189. /* set the address, index & direction (write to PHY) */
  190. addr = (phy_id << 11) | (idx << 6) | MII_WRITE_;
  191. smsc95xx_write_reg(dev, MII_ADDR, addr);
  192. if (smsc95xx_phy_wait_not_busy(dev))
  193. debug("Timed out writing MII reg %02X\n", idx);
  194. }
  195. static int smsc95xx_eeprom_confirm_not_busy(struct ueth_data *dev)
  196. {
  197. unsigned long start_time = get_timer(0);
  198. u32 val;
  199. do {
  200. smsc95xx_read_reg(dev, E2P_CMD, &val);
  201. if (!(val & E2P_CMD_LOADED_)) {
  202. debug("No EEPROM present\n");
  203. return -1;
  204. }
  205. if (!(val & E2P_CMD_BUSY_))
  206. return 0;
  207. udelay(40);
  208. } while (get_timer(start_time) < 1 * 1000 * 1000);
  209. debug("EEPROM is busy\n");
  210. return -1;
  211. }
  212. static int smsc95xx_wait_eeprom(struct ueth_data *dev)
  213. {
  214. unsigned long start_time = get_timer(0);
  215. u32 val;
  216. do {
  217. smsc95xx_read_reg(dev, E2P_CMD, &val);
  218. if (!(val & E2P_CMD_BUSY_) || (val & E2P_CMD_TIMEOUT_))
  219. break;
  220. udelay(40);
  221. } while (get_timer(start_time) < 1 * 1000 * 1000);
  222. if (val & (E2P_CMD_TIMEOUT_ | E2P_CMD_BUSY_)) {
  223. debug("EEPROM read operation timeout\n");
  224. return -1;
  225. }
  226. return 0;
  227. }
  228. static int smsc95xx_read_eeprom(struct ueth_data *dev, u32 offset, u32 length,
  229. u8 *data)
  230. {
  231. u32 val;
  232. int i, ret;
  233. ret = smsc95xx_eeprom_confirm_not_busy(dev);
  234. if (ret)
  235. return ret;
  236. for (i = 0; i < length; i++) {
  237. val = E2P_CMD_BUSY_ | E2P_CMD_READ_ | (offset & E2P_CMD_ADDR_);
  238. smsc95xx_write_reg(dev, E2P_CMD, val);
  239. ret = smsc95xx_wait_eeprom(dev);
  240. if (ret < 0)
  241. return ret;
  242. smsc95xx_read_reg(dev, E2P_DATA, &val);
  243. data[i] = val & 0xFF;
  244. offset++;
  245. }
  246. return 0;
  247. }
  248. /*
  249. * mii_nway_restart - restart NWay (autonegotiation) for this interface
  250. *
  251. * Returns 0 on success, negative on error.
  252. */
  253. static int mii_nway_restart(struct ueth_data *dev)
  254. {
  255. int bmcr;
  256. int r = -1;
  257. /* if autoneg is off, it's an error */
  258. bmcr = smsc95xx_mdio_read(dev, dev->phy_id, MII_BMCR);
  259. if (bmcr & BMCR_ANENABLE) {
  260. bmcr |= BMCR_ANRESTART;
  261. smsc95xx_mdio_write(dev, dev->phy_id, MII_BMCR, bmcr);
  262. r = 0;
  263. }
  264. return r;
  265. }
  266. static int smsc95xx_phy_initialize(struct ueth_data *dev)
  267. {
  268. smsc95xx_mdio_write(dev, dev->phy_id, MII_BMCR, BMCR_RESET);
  269. smsc95xx_mdio_write(dev, dev->phy_id, MII_ADVERTISE,
  270. ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP |
  271. ADVERTISE_PAUSE_ASYM);
  272. /* read to clear */
  273. smsc95xx_mdio_read(dev, dev->phy_id, PHY_INT_SRC);
  274. smsc95xx_mdio_write(dev, dev->phy_id, PHY_INT_MASK,
  275. PHY_INT_MASK_DEFAULT_);
  276. mii_nway_restart(dev);
  277. debug("phy initialised succesfully\n");
  278. return 0;
  279. }
  280. static int smsc95xx_init_mac_address(struct eth_device *eth,
  281. struct ueth_data *dev)
  282. {
  283. /* try reading mac address from EEPROM */
  284. if (smsc95xx_read_eeprom(dev, EEPROM_MAC_OFFSET, ETH_ALEN,
  285. eth->enetaddr) == 0) {
  286. if (is_valid_ether_addr(eth->enetaddr)) {
  287. /* eeprom values are valid so use them */
  288. debug("MAC address read from EEPROM\n");
  289. return 0;
  290. }
  291. }
  292. /*
  293. * No eeprom, or eeprom values are invalid. Generating a random MAC
  294. * address is not safe. Just return an error.
  295. */
  296. return -1;
  297. }
  298. static int smsc95xx_write_hwaddr(struct eth_device *eth)
  299. {
  300. struct ueth_data *dev = (struct ueth_data *)eth->priv;
  301. u32 addr_lo, addr_hi;
  302. int ret;
  303. /* set hardware address */
  304. debug("** %s()\n", __func__);
  305. addr_lo = cpu_to_le32(*((u32 *)eth->enetaddr));
  306. addr_hi = cpu_to_le16(*((u16 *)(eth->enetaddr + 4)));
  307. ret = smsc95xx_write_reg(dev, ADDRL, addr_lo);
  308. if (ret < 0) {
  309. debug("Failed to write ADDRL: %d\n", ret);
  310. return ret;
  311. }
  312. ret = smsc95xx_write_reg(dev, ADDRH, addr_hi);
  313. if (ret < 0)
  314. return ret;
  315. debug("MAC %02x:%02x:%02x:%02x:%02x:%02x\n",
  316. eth->enetaddr[0], eth->enetaddr[1],
  317. eth->enetaddr[2], eth->enetaddr[3],
  318. eth->enetaddr[4], eth->enetaddr[5]);
  319. dev->have_hwaddr = 1;
  320. return 0;
  321. }
  322. /* Enable or disable Tx & Rx checksum offload engines */
  323. static int smsc95xx_set_csums(struct ueth_data *dev,
  324. int use_tx_csum, int use_rx_csum)
  325. {
  326. u32 read_buf;
  327. int ret = smsc95xx_read_reg(dev, COE_CR, &read_buf);
  328. if (ret < 0)
  329. return ret;
  330. if (use_tx_csum)
  331. read_buf |= Tx_COE_EN_;
  332. else
  333. read_buf &= ~Tx_COE_EN_;
  334. if (use_rx_csum)
  335. read_buf |= Rx_COE_EN_;
  336. else
  337. read_buf &= ~Rx_COE_EN_;
  338. ret = smsc95xx_write_reg(dev, COE_CR, read_buf);
  339. if (ret < 0)
  340. return ret;
  341. debug("COE_CR = 0x%08x\n", read_buf);
  342. return 0;
  343. }
  344. static void smsc95xx_set_multicast(struct ueth_data *dev)
  345. {
  346. /* No multicast in u-boot */
  347. dev->mac_cr &= ~(MAC_CR_PRMS_ | MAC_CR_MCPAS_ | MAC_CR_HPFILT_);
  348. }
  349. /* starts the TX path */
  350. static void smsc95xx_start_tx_path(struct ueth_data *dev)
  351. {
  352. u32 reg_val;
  353. /* Enable Tx at MAC */
  354. dev->mac_cr |= MAC_CR_TXEN_;
  355. smsc95xx_write_reg(dev, MAC_CR, dev->mac_cr);
  356. /* Enable Tx at SCSRs */
  357. reg_val = TX_CFG_ON_;
  358. smsc95xx_write_reg(dev, TX_CFG, reg_val);
  359. }
  360. /* Starts the Receive path */
  361. static void smsc95xx_start_rx_path(struct ueth_data *dev)
  362. {
  363. dev->mac_cr |= MAC_CR_RXEN_;
  364. smsc95xx_write_reg(dev, MAC_CR, dev->mac_cr);
  365. }
  366. /*
  367. * Smsc95xx callbacks
  368. */
  369. static int smsc95xx_init(struct eth_device *eth, bd_t *bd)
  370. {
  371. int ret;
  372. u32 write_buf;
  373. u32 read_buf;
  374. u32 burst_cap;
  375. int timeout;
  376. struct ueth_data *dev = (struct ueth_data *)eth->priv;
  377. #define TIMEOUT_RESOLUTION 50 /* ms */
  378. int link_detected;
  379. debug("** %s()\n", __func__);
  380. dev->phy_id = SMSC95XX_INTERNAL_PHY_ID; /* fixed phy id */
  381. write_buf = HW_CFG_LRST_;
  382. ret = smsc95xx_write_reg(dev, HW_CFG, write_buf);
  383. if (ret < 0)
  384. return ret;
  385. timeout = 0;
  386. do {
  387. ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
  388. if (ret < 0)
  389. return ret;
  390. udelay(10 * 1000);
  391. timeout++;
  392. } while ((read_buf & HW_CFG_LRST_) && (timeout < 100));
  393. if (timeout >= 100) {
  394. debug("timeout waiting for completion of Lite Reset\n");
  395. return -1;
  396. }
  397. write_buf = PM_CTL_PHY_RST_;
  398. ret = smsc95xx_write_reg(dev, PM_CTRL, write_buf);
  399. if (ret < 0)
  400. return ret;
  401. timeout = 0;
  402. do {
  403. ret = smsc95xx_read_reg(dev, PM_CTRL, &read_buf);
  404. if (ret < 0)
  405. return ret;
  406. udelay(10 * 1000);
  407. timeout++;
  408. } while ((read_buf & PM_CTL_PHY_RST_) && (timeout < 100));
  409. if (timeout >= 100) {
  410. debug("timeout waiting for PHY Reset\n");
  411. return -1;
  412. }
  413. if (!dev->have_hwaddr && smsc95xx_init_mac_address(eth, dev) == 0)
  414. dev->have_hwaddr = 1;
  415. if (!dev->have_hwaddr) {
  416. puts("Error: SMSC95xx: No MAC address set - set usbethaddr\n");
  417. return -1;
  418. }
  419. if (smsc95xx_write_hwaddr(eth) < 0)
  420. return -1;
  421. ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
  422. if (ret < 0)
  423. return ret;
  424. debug("Read Value from HW_CFG : 0x%08x\n", read_buf);
  425. read_buf |= HW_CFG_BIR_;
  426. ret = smsc95xx_write_reg(dev, HW_CFG, read_buf);
  427. if (ret < 0)
  428. return ret;
  429. ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
  430. if (ret < 0)
  431. return ret;
  432. debug("Read Value from HW_CFG after writing "
  433. "HW_CFG_BIR_: 0x%08x\n", read_buf);
  434. #ifdef TURBO_MODE
  435. if (dev->pusb_dev->speed == USB_SPEED_HIGH) {
  436. burst_cap = DEFAULT_HS_BURST_CAP_SIZE / HS_USB_PKT_SIZE;
  437. dev->rx_urb_size = DEFAULT_HS_BURST_CAP_SIZE;
  438. } else {
  439. burst_cap = DEFAULT_FS_BURST_CAP_SIZE / FS_USB_PKT_SIZE;
  440. dev->rx_urb_size = DEFAULT_FS_BURST_CAP_SIZE;
  441. }
  442. #else
  443. burst_cap = 0;
  444. dev->rx_urb_size = MAX_SINGLE_PACKET_SIZE;
  445. #endif
  446. debug("rx_urb_size=%ld\n", (ulong)dev->rx_urb_size);
  447. ret = smsc95xx_write_reg(dev, BURST_CAP, burst_cap);
  448. if (ret < 0)
  449. return ret;
  450. ret = smsc95xx_read_reg(dev, BURST_CAP, &read_buf);
  451. if (ret < 0)
  452. return ret;
  453. debug("Read Value from BURST_CAP after writing: 0x%08x\n", read_buf);
  454. read_buf = DEFAULT_BULK_IN_DELAY;
  455. ret = smsc95xx_write_reg(dev, BULK_IN_DLY, read_buf);
  456. if (ret < 0)
  457. return ret;
  458. ret = smsc95xx_read_reg(dev, BULK_IN_DLY, &read_buf);
  459. if (ret < 0)
  460. return ret;
  461. debug("Read Value from BULK_IN_DLY after writing: "
  462. "0x%08x\n", read_buf);
  463. ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
  464. if (ret < 0)
  465. return ret;
  466. debug("Read Value from HW_CFG: 0x%08x\n", read_buf);
  467. #ifdef TURBO_MODE
  468. read_buf |= (HW_CFG_MEF_ | HW_CFG_BCE_);
  469. #endif
  470. read_buf &= ~HW_CFG_RXDOFF_;
  471. #define NET_IP_ALIGN 0
  472. read_buf |= NET_IP_ALIGN << 9;
  473. ret = smsc95xx_write_reg(dev, HW_CFG, read_buf);
  474. if (ret < 0)
  475. return ret;
  476. ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
  477. if (ret < 0)
  478. return ret;
  479. debug("Read Value from HW_CFG after writing: 0x%08x\n", read_buf);
  480. write_buf = 0xFFFFFFFF;
  481. ret = smsc95xx_write_reg(dev, INT_STS, write_buf);
  482. if (ret < 0)
  483. return ret;
  484. ret = smsc95xx_read_reg(dev, ID_REV, &read_buf);
  485. if (ret < 0)
  486. return ret;
  487. debug("ID_REV = 0x%08x\n", read_buf);
  488. /* Init Tx */
  489. write_buf = 0;
  490. ret = smsc95xx_write_reg(dev, FLOW, write_buf);
  491. if (ret < 0)
  492. return ret;
  493. read_buf = AFC_CFG_DEFAULT;
  494. ret = smsc95xx_write_reg(dev, AFC_CFG, read_buf);
  495. if (ret < 0)
  496. return ret;
  497. ret = smsc95xx_read_reg(dev, MAC_CR, &dev->mac_cr);
  498. if (ret < 0)
  499. return ret;
  500. /* Init Rx. Set Vlan */
  501. write_buf = (u32)ETH_P_8021Q;
  502. ret = smsc95xx_write_reg(dev, VLAN1, write_buf);
  503. if (ret < 0)
  504. return ret;
  505. /* Disable checksum offload engines */
  506. ret = smsc95xx_set_csums(dev, 0, 0);
  507. if (ret < 0) {
  508. debug("Failed to set csum offload: %d\n", ret);
  509. return ret;
  510. }
  511. smsc95xx_set_multicast(dev);
  512. if (smsc95xx_phy_initialize(dev) < 0)
  513. return -1;
  514. ret = smsc95xx_read_reg(dev, INT_EP_CTL, &read_buf);
  515. if (ret < 0)
  516. return ret;
  517. /* enable PHY interrupts */
  518. read_buf |= INT_EP_CTL_PHY_INT_;
  519. ret = smsc95xx_write_reg(dev, INT_EP_CTL, read_buf);
  520. if (ret < 0)
  521. return ret;
  522. smsc95xx_start_tx_path(dev);
  523. smsc95xx_start_rx_path(dev);
  524. timeout = 0;
  525. do {
  526. link_detected = smsc95xx_mdio_read(dev, dev->phy_id, MII_BMSR)
  527. & BMSR_LSTATUS;
  528. if (!link_detected) {
  529. if (timeout == 0)
  530. printf("Waiting for Ethernet connection... ");
  531. udelay(TIMEOUT_RESOLUTION * 1000);
  532. timeout += TIMEOUT_RESOLUTION;
  533. }
  534. } while (!link_detected && timeout < PHY_CONNECT_TIMEOUT);
  535. if (link_detected) {
  536. if (timeout != 0)
  537. printf("done.\n");
  538. } else {
  539. printf("unable to connect.\n");
  540. return -1;
  541. }
  542. return 0;
  543. }
  544. static int smsc95xx_send(struct eth_device *eth, volatile void* packet,
  545. int length)
  546. {
  547. struct ueth_data *dev = (struct ueth_data *)eth->priv;
  548. int err;
  549. int actual_len;
  550. u32 tx_cmd_a;
  551. u32 tx_cmd_b;
  552. unsigned char msg[PKTSIZE + sizeof(tx_cmd_a) + sizeof(tx_cmd_b)];
  553. debug("** %s(), len %d, buf %#x\n", __func__, length, (int)msg);
  554. if (length > PKTSIZE)
  555. return -1;
  556. tx_cmd_a = (u32)length | TX_CMD_A_FIRST_SEG_ | TX_CMD_A_LAST_SEG_;
  557. tx_cmd_b = (u32)length;
  558. cpu_to_le32s(&tx_cmd_a);
  559. cpu_to_le32s(&tx_cmd_b);
  560. /* prepend cmd_a and cmd_b */
  561. memcpy(msg, &tx_cmd_a, sizeof(tx_cmd_a));
  562. memcpy(msg + sizeof(tx_cmd_a), &tx_cmd_b, sizeof(tx_cmd_b));
  563. memcpy(msg + sizeof(tx_cmd_a) + sizeof(tx_cmd_b), (void *)packet,
  564. length);
  565. err = usb_bulk_msg(dev->pusb_dev,
  566. usb_sndbulkpipe(dev->pusb_dev, dev->ep_out),
  567. (void *)msg,
  568. length + sizeof(tx_cmd_a) + sizeof(tx_cmd_b),
  569. &actual_len,
  570. USB_BULK_SEND_TIMEOUT);
  571. debug("Tx: len = %u, actual = %u, err = %d\n",
  572. length + sizeof(tx_cmd_a) + sizeof(tx_cmd_b),
  573. actual_len, err);
  574. return err;
  575. }
  576. static int smsc95xx_recv(struct eth_device *eth)
  577. {
  578. struct ueth_data *dev = (struct ueth_data *)eth->priv;
  579. static unsigned char recv_buf[AX_RX_URB_SIZE];
  580. unsigned char *buf_ptr;
  581. int err;
  582. int actual_len;
  583. u32 packet_len;
  584. int cur_buf_align;
  585. debug("** %s()\n", __func__);
  586. err = usb_bulk_msg(dev->pusb_dev,
  587. usb_rcvbulkpipe(dev->pusb_dev, dev->ep_in),
  588. (void *)recv_buf,
  589. AX_RX_URB_SIZE,
  590. &actual_len,
  591. USB_BULK_RECV_TIMEOUT);
  592. debug("Rx: len = %u, actual = %u, err = %d\n", AX_RX_URB_SIZE,
  593. actual_len, err);
  594. if (err != 0) {
  595. debug("Rx: failed to receive\n");
  596. return -1;
  597. }
  598. if (actual_len > AX_RX_URB_SIZE) {
  599. debug("Rx: received too many bytes %d\n", actual_len);
  600. return -1;
  601. }
  602. buf_ptr = recv_buf;
  603. while (actual_len > 0) {
  604. /*
  605. * 1st 4 bytes contain the length of the actual data plus error
  606. * info. Extract data length.
  607. */
  608. if (actual_len < sizeof(packet_len)) {
  609. debug("Rx: incomplete packet length\n");
  610. return -1;
  611. }
  612. memcpy(&packet_len, buf_ptr, sizeof(packet_len));
  613. le32_to_cpus(&packet_len);
  614. if (packet_len & RX_STS_ES_) {
  615. debug("Rx: Error header=%#x", packet_len);
  616. return -1;
  617. }
  618. packet_len = ((packet_len & RX_STS_FL_) >> 16);
  619. if (packet_len > actual_len - sizeof(packet_len)) {
  620. debug("Rx: too large packet: %d\n", packet_len);
  621. return -1;
  622. }
  623. /* Notify net stack */
  624. NetReceive(buf_ptr + sizeof(packet_len), packet_len - 4);
  625. /* Adjust for next iteration */
  626. actual_len -= sizeof(packet_len) + packet_len;
  627. buf_ptr += sizeof(packet_len) + packet_len;
  628. cur_buf_align = (int)buf_ptr - (int)recv_buf;
  629. if (cur_buf_align & 0x03) {
  630. int align = 4 - (cur_buf_align & 0x03);
  631. actual_len -= align;
  632. buf_ptr += align;
  633. }
  634. }
  635. return err;
  636. }
  637. static void smsc95xx_halt(struct eth_device *eth)
  638. {
  639. debug("** %s()\n", __func__);
  640. }
  641. /*
  642. * SMSC probing functions
  643. */
  644. void smsc95xx_eth_before_probe(void)
  645. {
  646. curr_eth_dev = 0;
  647. }
  648. struct smsc95xx_dongle {
  649. unsigned short vendor;
  650. unsigned short product;
  651. };
  652. static const struct smsc95xx_dongle smsc95xx_dongles[] = {
  653. { 0x0424, 0xec00 }, /* LAN9512/LAN9514 Ethernet */
  654. { 0x0424, 0x9500 }, /* LAN9500 Ethernet */
  655. { 0x0000, 0x0000 } /* END - Do not remove */
  656. };
  657. /* Probe to see if a new device is actually an SMSC device */
  658. int smsc95xx_eth_probe(struct usb_device *dev, unsigned int ifnum,
  659. struct ueth_data *ss)
  660. {
  661. struct usb_interface *iface;
  662. struct usb_interface_descriptor *iface_desc;
  663. int i;
  664. /* let's examine the device now */
  665. iface = &dev->config.if_desc[ifnum];
  666. iface_desc = &dev->config.if_desc[ifnum].desc;
  667. for (i = 0; smsc95xx_dongles[i].vendor != 0; i++) {
  668. if (dev->descriptor.idVendor == smsc95xx_dongles[i].vendor &&
  669. dev->descriptor.idProduct == smsc95xx_dongles[i].product)
  670. /* Found a supported dongle */
  671. break;
  672. }
  673. if (smsc95xx_dongles[i].vendor == 0)
  674. return 0;
  675. /* At this point, we know we've got a live one */
  676. debug("\n\nUSB Ethernet device detected\n");
  677. memset(ss, '\0', sizeof(struct ueth_data));
  678. /* Initialize the ueth_data structure with some useful info */
  679. ss->ifnum = ifnum;
  680. ss->pusb_dev = dev;
  681. ss->subclass = iface_desc->bInterfaceSubClass;
  682. ss->protocol = iface_desc->bInterfaceProtocol;
  683. /*
  684. * We are expecting a minimum of 3 endpoints - in, out (bulk), and int.
  685. * We will ignore any others.
  686. */
  687. for (i = 0; i < iface_desc->bNumEndpoints; i++) {
  688. /* is it an BULK endpoint? */
  689. if ((iface->ep_desc[i].bmAttributes &
  690. USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_BULK) {
  691. if (iface->ep_desc[i].bEndpointAddress & USB_DIR_IN)
  692. ss->ep_in =
  693. iface->ep_desc[i].bEndpointAddress &
  694. USB_ENDPOINT_NUMBER_MASK;
  695. else
  696. ss->ep_out =
  697. iface->ep_desc[i].bEndpointAddress &
  698. USB_ENDPOINT_NUMBER_MASK;
  699. }
  700. /* is it an interrupt endpoint? */
  701. if ((iface->ep_desc[i].bmAttributes &
  702. USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_INT) {
  703. ss->ep_int = iface->ep_desc[i].bEndpointAddress &
  704. USB_ENDPOINT_NUMBER_MASK;
  705. ss->irqinterval = iface->ep_desc[i].bInterval;
  706. }
  707. }
  708. debug("Endpoints In %d Out %d Int %d\n",
  709. ss->ep_in, ss->ep_out, ss->ep_int);
  710. /* Do some basic sanity checks, and bail if we find a problem */
  711. if (usb_set_interface(dev, iface_desc->bInterfaceNumber, 0) ||
  712. !ss->ep_in || !ss->ep_out || !ss->ep_int) {
  713. debug("Problems with device\n");
  714. return 0;
  715. }
  716. dev->privptr = (void *)ss;
  717. return 1;
  718. }
  719. int smsc95xx_eth_get_info(struct usb_device *dev, struct ueth_data *ss,
  720. struct eth_device *eth)
  721. {
  722. debug("** %s()\n", __func__);
  723. if (!eth) {
  724. debug("%s: missing parameter.\n", __func__);
  725. return 0;
  726. }
  727. sprintf(eth->name, "%s%d", SMSC95XX_BASE_NAME, curr_eth_dev++);
  728. eth->init = smsc95xx_init;
  729. eth->send = smsc95xx_send;
  730. eth->recv = smsc95xx_recv;
  731. eth->halt = smsc95xx_halt;
  732. eth->write_hwaddr = smsc95xx_write_hwaddr;
  733. eth->priv = ss;
  734. return 1;
  735. }