smsc95xx.c 53 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /***************************************************************************
  3. *
  4. * Copyright (C) 2007-2008 SMSC
  5. *
  6. *****************************************************************************/
  7. #include <linux/module.h>
  8. #include <linux/kmod.h>
  9. #include <linux/netdevice.h>
  10. #include <linux/etherdevice.h>
  11. #include <linux/ethtool.h>
  12. #include <linux/mii.h>
  13. #include <linux/usb.h>
  14. #include <linux/bitrev.h>
  15. #include <linux/crc16.h>
  16. #include <linux/crc32.h>
  17. #include <linux/usb/usbnet.h>
  18. #include <linux/slab.h>
  19. #include <linux/of_net.h>
  20. #include <linux/irq.h>
  21. #include <linux/irqdomain.h>
  22. #include <linux/mdio.h>
  23. #include <linux/phy.h>
  24. #include <net/selftests.h>
  25. #include "smsc95xx.h"
  26. #define SMSC_CHIPNAME "smsc95xx"
  27. #define HS_USB_PKT_SIZE (512)
  28. #define FS_USB_PKT_SIZE (64)
  29. #define DEFAULT_HS_BURST_CAP_SIZE (16 * 1024 + 5 * HS_USB_PKT_SIZE)
  30. #define DEFAULT_FS_BURST_CAP_SIZE (6 * 1024 + 33 * FS_USB_PKT_SIZE)
  31. #define DEFAULT_BULK_IN_DELAY (0x00002000)
  32. #define MAX_SINGLE_PACKET_SIZE (2048)
  33. #define LAN95XX_EEPROM_MAGIC (0x9500)
  34. #define EEPROM_MAC_OFFSET (0x01)
  35. #define DEFAULT_TX_CSUM_ENABLE (true)
  36. #define DEFAULT_RX_CSUM_ENABLE (true)
  37. #define SMSC95XX_INTERNAL_PHY_ID (1)
  38. #define SMSC95XX_TX_OVERHEAD (8)
  39. #define SMSC95XX_TX_OVERHEAD_CSUM (12)
  40. #define SUPPORTED_WAKE (WAKE_PHY | WAKE_UCAST | WAKE_BCAST | \
  41. WAKE_MCAST | WAKE_ARP | WAKE_MAGIC)
  42. #define FEATURE_8_WAKEUP_FILTERS (0x01)
  43. #define FEATURE_PHY_NLP_CROSSOVER (0x02)
  44. #define FEATURE_REMOTE_WAKEUP (0x04)
  45. #define SUSPEND_SUSPEND0 (0x01)
  46. #define SUSPEND_SUSPEND1 (0x02)
  47. #define SUSPEND_SUSPEND2 (0x04)
  48. #define SUSPEND_SUSPEND3 (0x08)
  49. #define SUSPEND_ALLMODES (SUSPEND_SUSPEND0 | SUSPEND_SUSPEND1 | \
  50. SUSPEND_SUSPEND2 | SUSPEND_SUSPEND3)
  51. #define SMSC95XX_NR_IRQS (1) /* raise to 12 for GPIOs */
  52. #define PHY_HWIRQ (SMSC95XX_NR_IRQS - 1)
  53. struct smsc95xx_priv {
  54. u32 mac_cr;
  55. u32 hash_hi;
  56. u32 hash_lo;
  57. u32 wolopts;
  58. bool pause_rx;
  59. bool pause_tx;
  60. bool pause_autoneg;
  61. spinlock_t mac_cr_lock;
  62. u8 features;
  63. u8 suspend_flags;
  64. bool is_internal_phy;
  65. struct irq_chip irqchip;
  66. struct irq_domain *irqdomain;
  67. struct fwnode_handle *irqfwnode;
  68. struct mii_bus *mdiobus;
  69. struct phy_device *phydev;
  70. struct task_struct *pm_task;
  71. };
  72. static bool turbo_mode = true;
  73. module_param(turbo_mode, bool, 0644);
  74. MODULE_PARM_DESC(turbo_mode, "Enable multiple frames per Rx transaction");
  75. static int __must_check smsc95xx_read_reg(struct usbnet *dev, u32 index,
  76. u32 *data)
  77. {
  78. struct smsc95xx_priv *pdata = dev->driver_priv;
  79. u32 buf;
  80. int ret;
  81. int (*fn)(struct usbnet *, u8, u8, u16, u16, void *, u16);
  82. if (current != pdata->pm_task)
  83. fn = usbnet_read_cmd;
  84. else
  85. fn = usbnet_read_cmd_nopm;
  86. ret = fn(dev, USB_VENDOR_REQUEST_READ_REGISTER, USB_DIR_IN
  87. | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  88. 0, index, &buf, 4);
  89. if (ret < 4) {
  90. ret = ret < 0 ? ret : -ENODATA;
  91. if (ret != -ENODEV)
  92. netdev_warn(dev->net, "Failed to read reg index 0x%08x: %d\n",
  93. index, ret);
  94. return ret;
  95. }
  96. le32_to_cpus(&buf);
  97. *data = buf;
  98. return ret;
  99. }
  100. static int __must_check smsc95xx_write_reg(struct usbnet *dev, u32 index,
  101. u32 data)
  102. {
  103. struct smsc95xx_priv *pdata = dev->driver_priv;
  104. u32 buf;
  105. int ret;
  106. int (*fn)(struct usbnet *, u8, u8, u16, u16, const void *, u16);
  107. if (current != pdata->pm_task)
  108. fn = usbnet_write_cmd;
  109. else
  110. fn = usbnet_write_cmd_nopm;
  111. buf = data;
  112. cpu_to_le32s(&buf);
  113. ret = fn(dev, USB_VENDOR_REQUEST_WRITE_REGISTER, USB_DIR_OUT
  114. | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  115. 0, index, &buf, 4);
  116. if (ret < 0 && ret != -ENODEV)
  117. netdev_warn(dev->net, "Failed to write reg index 0x%08x: %d\n",
  118. index, ret);
  119. return ret;
  120. }
  121. /* Loop until the read is completed with timeout
  122. * called with phy_mutex held */
  123. static int __must_check smsc95xx_phy_wait_not_busy(struct usbnet *dev)
  124. {
  125. unsigned long start_time = jiffies;
  126. u32 val;
  127. int ret;
  128. do {
  129. ret = smsc95xx_read_reg(dev, MII_ADDR, &val);
  130. if (ret < 0) {
  131. /* Ignore -ENODEV error during disconnect() */
  132. if (ret == -ENODEV)
  133. return 0;
  134. netdev_warn(dev->net, "Error reading MII_ACCESS\n");
  135. return ret;
  136. }
  137. if (!(val & MII_BUSY_))
  138. return 0;
  139. } while (!time_after(jiffies, start_time + HZ));
  140. return -EIO;
  141. }
  142. static u32 mii_address_cmd(int phy_id, int idx, u16 op)
  143. {
  144. return (phy_id & 0x1f) << 11 | (idx & 0x1f) << 6 | op;
  145. }
  146. static int smsc95xx_mdio_read(struct usbnet *dev, int phy_id, int idx)
  147. {
  148. u32 val, addr;
  149. int ret;
  150. mutex_lock(&dev->phy_mutex);
  151. /* confirm MII not busy */
  152. ret = smsc95xx_phy_wait_not_busy(dev);
  153. if (ret < 0) {
  154. netdev_warn(dev->net, "%s: MII is busy\n", __func__);
  155. goto done;
  156. }
  157. /* set the address, index & direction (read from PHY) */
  158. addr = mii_address_cmd(phy_id, idx, MII_READ_ | MII_BUSY_);
  159. ret = smsc95xx_write_reg(dev, MII_ADDR, addr);
  160. if (ret < 0) {
  161. if (ret != -ENODEV)
  162. netdev_warn(dev->net, "Error writing MII_ADDR\n");
  163. goto done;
  164. }
  165. ret = smsc95xx_phy_wait_not_busy(dev);
  166. if (ret < 0) {
  167. netdev_warn(dev->net, "Timed out reading MII reg %02X\n", idx);
  168. goto done;
  169. }
  170. ret = smsc95xx_read_reg(dev, MII_DATA, &val);
  171. if (ret < 0) {
  172. if (ret != -ENODEV)
  173. netdev_warn(dev->net, "Error reading MII_DATA\n");
  174. goto done;
  175. }
  176. ret = (u16)(val & 0xFFFF);
  177. done:
  178. mutex_unlock(&dev->phy_mutex);
  179. /* Ignore -ENODEV error during disconnect() */
  180. if (ret == -ENODEV)
  181. return 0;
  182. return ret;
  183. }
  184. static void smsc95xx_mdio_write(struct usbnet *dev, int phy_id, int idx,
  185. int regval)
  186. {
  187. u32 val, addr;
  188. int ret;
  189. mutex_lock(&dev->phy_mutex);
  190. /* confirm MII not busy */
  191. ret = smsc95xx_phy_wait_not_busy(dev);
  192. if (ret < 0) {
  193. netdev_warn(dev->net, "%s: MII is busy\n", __func__);
  194. goto done;
  195. }
  196. val = regval;
  197. ret = smsc95xx_write_reg(dev, MII_DATA, val);
  198. if (ret < 0) {
  199. if (ret != -ENODEV)
  200. netdev_warn(dev->net, "Error writing MII_DATA\n");
  201. goto done;
  202. }
  203. /* set the address, index & direction (write to PHY) */
  204. addr = mii_address_cmd(phy_id, idx, MII_WRITE_ | MII_BUSY_);
  205. ret = smsc95xx_write_reg(dev, MII_ADDR, addr);
  206. if (ret < 0) {
  207. if (ret != -ENODEV)
  208. netdev_warn(dev->net, "Error writing MII_ADDR\n");
  209. goto done;
  210. }
  211. ret = smsc95xx_phy_wait_not_busy(dev);
  212. if (ret < 0) {
  213. netdev_warn(dev->net, "Timed out writing MII reg %02X\n", idx);
  214. goto done;
  215. }
  216. done:
  217. mutex_unlock(&dev->phy_mutex);
  218. }
  219. static int smsc95xx_mdiobus_reset(struct mii_bus *bus)
  220. {
  221. struct smsc95xx_priv *pdata;
  222. struct usbnet *dev;
  223. u32 val;
  224. int ret;
  225. dev = bus->priv;
  226. pdata = dev->driver_priv;
  227. if (pdata->is_internal_phy)
  228. return 0;
  229. mutex_lock(&dev->phy_mutex);
  230. ret = smsc95xx_read_reg(dev, PM_CTRL, &val);
  231. if (ret < 0)
  232. goto reset_out;
  233. val |= PM_CTL_PHY_RST_;
  234. ret = smsc95xx_write_reg(dev, PM_CTRL, val);
  235. if (ret < 0)
  236. goto reset_out;
  237. /* Driver has no knowledge at this point about the external PHY.
  238. * The 802.3 specifies that the reset process shall
  239. * be completed within 0.5 s.
  240. */
  241. fsleep(500000);
  242. reset_out:
  243. mutex_unlock(&dev->phy_mutex);
  244. return 0;
  245. }
  246. static int smsc95xx_mdiobus_read(struct mii_bus *bus, int phy_id, int idx)
  247. {
  248. struct usbnet *dev = bus->priv;
  249. return smsc95xx_mdio_read(dev, phy_id, idx);
  250. }
  251. static int smsc95xx_mdiobus_write(struct mii_bus *bus, int phy_id, int idx,
  252. u16 regval)
  253. {
  254. struct usbnet *dev = bus->priv;
  255. smsc95xx_mdio_write(dev, phy_id, idx, regval);
  256. return 0;
  257. }
  258. static int __must_check smsc95xx_wait_eeprom(struct usbnet *dev)
  259. {
  260. unsigned long start_time = jiffies;
  261. u32 val;
  262. int ret;
  263. do {
  264. ret = smsc95xx_read_reg(dev, E2P_CMD, &val);
  265. if (ret < 0) {
  266. netdev_warn(dev->net, "Error reading E2P_CMD\n");
  267. return ret;
  268. }
  269. if (!(val & E2P_CMD_BUSY_) || (val & E2P_CMD_TIMEOUT_))
  270. break;
  271. udelay(40);
  272. } while (!time_after(jiffies, start_time + HZ));
  273. if (val & (E2P_CMD_TIMEOUT_ | E2P_CMD_BUSY_)) {
  274. netdev_warn(dev->net, "EEPROM read operation timeout\n");
  275. return -EIO;
  276. }
  277. return 0;
  278. }
  279. static int __must_check smsc95xx_eeprom_confirm_not_busy(struct usbnet *dev)
  280. {
  281. unsigned long start_time = jiffies;
  282. u32 val;
  283. int ret;
  284. do {
  285. ret = smsc95xx_read_reg(dev, E2P_CMD, &val);
  286. if (ret < 0) {
  287. netdev_warn(dev->net, "Error reading E2P_CMD\n");
  288. return ret;
  289. }
  290. if (!(val & E2P_CMD_BUSY_))
  291. return 0;
  292. udelay(40);
  293. } while (!time_after(jiffies, start_time + HZ));
  294. netdev_warn(dev->net, "EEPROM is busy\n");
  295. return -EIO;
  296. }
  297. static int smsc95xx_read_eeprom(struct usbnet *dev, u32 offset, u32 length,
  298. u8 *data)
  299. {
  300. u32 val;
  301. int i, ret;
  302. BUG_ON(!dev);
  303. BUG_ON(!data);
  304. ret = smsc95xx_eeprom_confirm_not_busy(dev);
  305. if (ret)
  306. return ret;
  307. for (i = 0; i < length; i++) {
  308. val = E2P_CMD_BUSY_ | E2P_CMD_READ_ | (offset & E2P_CMD_ADDR_);
  309. ret = smsc95xx_write_reg(dev, E2P_CMD, val);
  310. if (ret < 0) {
  311. netdev_warn(dev->net, "Error writing E2P_CMD\n");
  312. return ret;
  313. }
  314. ret = smsc95xx_wait_eeprom(dev);
  315. if (ret < 0)
  316. return ret;
  317. ret = smsc95xx_read_reg(dev, E2P_DATA, &val);
  318. if (ret < 0) {
  319. netdev_warn(dev->net, "Error reading E2P_DATA\n");
  320. return ret;
  321. }
  322. data[i] = val & 0xFF;
  323. offset++;
  324. }
  325. return 0;
  326. }
  327. static int smsc95xx_write_eeprom(struct usbnet *dev, u32 offset, u32 length,
  328. u8 *data)
  329. {
  330. u32 val;
  331. int i, ret;
  332. BUG_ON(!dev);
  333. BUG_ON(!data);
  334. ret = smsc95xx_eeprom_confirm_not_busy(dev);
  335. if (ret)
  336. return ret;
  337. /* Issue write/erase enable command */
  338. val = E2P_CMD_BUSY_ | E2P_CMD_EWEN_;
  339. ret = smsc95xx_write_reg(dev, E2P_CMD, val);
  340. if (ret < 0) {
  341. netdev_warn(dev->net, "Error writing E2P_DATA\n");
  342. return ret;
  343. }
  344. ret = smsc95xx_wait_eeprom(dev);
  345. if (ret < 0)
  346. return ret;
  347. for (i = 0; i < length; i++) {
  348. /* Fill data register */
  349. val = data[i];
  350. ret = smsc95xx_write_reg(dev, E2P_DATA, val);
  351. if (ret < 0) {
  352. netdev_warn(dev->net, "Error writing E2P_DATA\n");
  353. return ret;
  354. }
  355. /* Send "write" command */
  356. val = E2P_CMD_BUSY_ | E2P_CMD_WRITE_ | (offset & E2P_CMD_ADDR_);
  357. ret = smsc95xx_write_reg(dev, E2P_CMD, val);
  358. if (ret < 0) {
  359. netdev_warn(dev->net, "Error writing E2P_CMD\n");
  360. return ret;
  361. }
  362. ret = smsc95xx_wait_eeprom(dev);
  363. if (ret < 0)
  364. return ret;
  365. offset++;
  366. }
  367. return 0;
  368. }
  369. static int __must_check smsc95xx_write_reg_async(struct usbnet *dev, u16 index,
  370. u32 data)
  371. {
  372. const u16 size = 4;
  373. u32 buf;
  374. int ret;
  375. buf = data;
  376. cpu_to_le32s(&buf);
  377. ret = usbnet_write_cmd_async(dev, USB_VENDOR_REQUEST_WRITE_REGISTER,
  378. USB_DIR_OUT | USB_TYPE_VENDOR |
  379. USB_RECIP_DEVICE,
  380. 0, index, &buf, size);
  381. if (ret < 0)
  382. netdev_warn(dev->net, "Error write async cmd, sts=%d\n",
  383. ret);
  384. return ret;
  385. }
  386. /* returns hash bit number for given MAC address
  387. * example:
  388. * 01 00 5E 00 00 01 -> returns bit number 31 */
  389. static unsigned int smsc95xx_hash(char addr[ETH_ALEN])
  390. {
  391. return (ether_crc(ETH_ALEN, addr) >> 26) & 0x3f;
  392. }
  393. static void smsc95xx_set_multicast(struct net_device *netdev)
  394. {
  395. struct usbnet *dev = netdev_priv(netdev);
  396. struct smsc95xx_priv *pdata = dev->driver_priv;
  397. unsigned long flags;
  398. int ret;
  399. pdata->hash_hi = 0;
  400. pdata->hash_lo = 0;
  401. spin_lock_irqsave(&pdata->mac_cr_lock, flags);
  402. if (dev->net->flags & IFF_PROMISC) {
  403. netif_dbg(dev, drv, dev->net, "promiscuous mode enabled\n");
  404. pdata->mac_cr |= MAC_CR_PRMS_;
  405. pdata->mac_cr &= ~(MAC_CR_MCPAS_ | MAC_CR_HPFILT_);
  406. } else if (dev->net->flags & IFF_ALLMULTI) {
  407. netif_dbg(dev, drv, dev->net, "receive all multicast enabled\n");
  408. pdata->mac_cr |= MAC_CR_MCPAS_;
  409. pdata->mac_cr &= ~(MAC_CR_PRMS_ | MAC_CR_HPFILT_);
  410. } else if (!netdev_mc_empty(dev->net)) {
  411. struct netdev_hw_addr *ha;
  412. pdata->mac_cr |= MAC_CR_HPFILT_;
  413. pdata->mac_cr &= ~(MAC_CR_PRMS_ | MAC_CR_MCPAS_);
  414. netdev_for_each_mc_addr(ha, netdev) {
  415. u32 bitnum = smsc95xx_hash(ha->addr);
  416. u32 mask = 0x01 << (bitnum & 0x1F);
  417. if (bitnum & 0x20)
  418. pdata->hash_hi |= mask;
  419. else
  420. pdata->hash_lo |= mask;
  421. }
  422. netif_dbg(dev, drv, dev->net, "HASHH=0x%08X, HASHL=0x%08X\n",
  423. pdata->hash_hi, pdata->hash_lo);
  424. } else {
  425. netif_dbg(dev, drv, dev->net, "receive own packets only\n");
  426. pdata->mac_cr &=
  427. ~(MAC_CR_PRMS_ | MAC_CR_MCPAS_ | MAC_CR_HPFILT_);
  428. }
  429. spin_unlock_irqrestore(&pdata->mac_cr_lock, flags);
  430. /* Initiate async writes, as we can't wait for completion here */
  431. ret = smsc95xx_write_reg_async(dev, HASHH, pdata->hash_hi);
  432. if (ret < 0)
  433. netdev_warn(dev->net, "failed to initiate async write to HASHH\n");
  434. ret = smsc95xx_write_reg_async(dev, HASHL, pdata->hash_lo);
  435. if (ret < 0)
  436. netdev_warn(dev->net, "failed to initiate async write to HASHL\n");
  437. ret = smsc95xx_write_reg_async(dev, MAC_CR, pdata->mac_cr);
  438. if (ret < 0)
  439. netdev_warn(dev->net, "failed to initiate async write to MAC_CR\n");
  440. }
  441. static int smsc95xx_phy_update_flowcontrol(struct usbnet *dev)
  442. {
  443. struct smsc95xx_priv *pdata = dev->driver_priv;
  444. u32 flow = 0, afc_cfg;
  445. int ret = smsc95xx_read_reg(dev, AFC_CFG, &afc_cfg);
  446. if (ret < 0)
  447. return ret;
  448. if (pdata->phydev->duplex == DUPLEX_FULL) {
  449. bool tx_pause, rx_pause;
  450. if (pdata->phydev->autoneg == AUTONEG_ENABLE &&
  451. pdata->pause_autoneg) {
  452. phy_get_pause(pdata->phydev, &tx_pause, &rx_pause);
  453. } else {
  454. tx_pause = pdata->pause_tx;
  455. rx_pause = pdata->pause_rx;
  456. }
  457. if (rx_pause)
  458. flow = 0xFFFF0002;
  459. if (tx_pause) {
  460. afc_cfg |= 0xF;
  461. flow |= 0xFFFF0000;
  462. } else {
  463. afc_cfg &= ~0xF;
  464. }
  465. netif_dbg(dev, link, dev->net, "rx pause %s, tx pause %s\n",
  466. rx_pause ? "enabled" : "disabled",
  467. tx_pause ? "enabled" : "disabled");
  468. } else {
  469. netif_dbg(dev, link, dev->net, "half duplex\n");
  470. afc_cfg |= 0xF;
  471. }
  472. ret = smsc95xx_write_reg(dev, FLOW, flow);
  473. if (ret < 0)
  474. return ret;
  475. return smsc95xx_write_reg(dev, AFC_CFG, afc_cfg);
  476. }
  477. static void smsc95xx_mac_update_fullduplex(struct usbnet *dev)
  478. {
  479. struct smsc95xx_priv *pdata = dev->driver_priv;
  480. unsigned long flags;
  481. int ret;
  482. spin_lock_irqsave(&pdata->mac_cr_lock, flags);
  483. if (pdata->phydev->duplex != DUPLEX_FULL) {
  484. pdata->mac_cr &= ~MAC_CR_FDPX_;
  485. pdata->mac_cr |= MAC_CR_RCVOWN_;
  486. } else {
  487. pdata->mac_cr &= ~MAC_CR_RCVOWN_;
  488. pdata->mac_cr |= MAC_CR_FDPX_;
  489. }
  490. spin_unlock_irqrestore(&pdata->mac_cr_lock, flags);
  491. ret = smsc95xx_write_reg(dev, MAC_CR, pdata->mac_cr);
  492. if (ret < 0) {
  493. if (ret != -ENODEV)
  494. netdev_warn(dev->net,
  495. "Error updating MAC full duplex mode\n");
  496. return;
  497. }
  498. ret = smsc95xx_phy_update_flowcontrol(dev);
  499. if (ret < 0)
  500. netdev_warn(dev->net, "Error updating PHY flow control\n");
  501. }
  502. static void smsc95xx_status(struct usbnet *dev, struct urb *urb)
  503. {
  504. struct smsc95xx_priv *pdata = dev->driver_priv;
  505. unsigned long flags;
  506. u32 intdata;
  507. if (urb->actual_length != 4) {
  508. netdev_warn(dev->net, "unexpected urb length %d\n",
  509. urb->actual_length);
  510. return;
  511. }
  512. intdata = get_unaligned_le32(urb->transfer_buffer);
  513. netif_dbg(dev, link, dev->net, "intdata: 0x%08X\n", intdata);
  514. local_irq_save(flags);
  515. if (intdata & INT_ENP_PHY_INT_)
  516. generic_handle_domain_irq(pdata->irqdomain, PHY_HWIRQ);
  517. else
  518. netdev_warn(dev->net, "unexpected interrupt, intdata=0x%08X\n",
  519. intdata);
  520. local_irq_restore(flags);
  521. }
  522. /* Enable or disable Tx & Rx checksum offload engines */
  523. static int smsc95xx_set_features(struct net_device *netdev,
  524. netdev_features_t features)
  525. {
  526. struct usbnet *dev = netdev_priv(netdev);
  527. u32 read_buf;
  528. int ret;
  529. ret = smsc95xx_read_reg(dev, COE_CR, &read_buf);
  530. if (ret < 0)
  531. return ret;
  532. if (features & NETIF_F_IP_CSUM)
  533. read_buf |= Tx_COE_EN_;
  534. else
  535. read_buf &= ~Tx_COE_EN_;
  536. if (features & NETIF_F_RXCSUM)
  537. read_buf |= Rx_COE_EN_;
  538. else
  539. read_buf &= ~Rx_COE_EN_;
  540. ret = smsc95xx_write_reg(dev, COE_CR, read_buf);
  541. if (ret < 0)
  542. return ret;
  543. netif_dbg(dev, hw, dev->net, "COE_CR = 0x%08x\n", read_buf);
  544. return 0;
  545. }
  546. static int smsc95xx_ethtool_get_eeprom_len(struct net_device *net)
  547. {
  548. return MAX_EEPROM_SIZE;
  549. }
  550. static int smsc95xx_ethtool_get_eeprom(struct net_device *netdev,
  551. struct ethtool_eeprom *ee, u8 *data)
  552. {
  553. struct usbnet *dev = netdev_priv(netdev);
  554. ee->magic = LAN95XX_EEPROM_MAGIC;
  555. return smsc95xx_read_eeprom(dev, ee->offset, ee->len, data);
  556. }
  557. static int smsc95xx_ethtool_set_eeprom(struct net_device *netdev,
  558. struct ethtool_eeprom *ee, u8 *data)
  559. {
  560. struct usbnet *dev = netdev_priv(netdev);
  561. if (ee->magic != LAN95XX_EEPROM_MAGIC) {
  562. netdev_warn(dev->net, "EEPROM: magic value mismatch, magic = 0x%x\n",
  563. ee->magic);
  564. return -EINVAL;
  565. }
  566. return smsc95xx_write_eeprom(dev, ee->offset, ee->len, data);
  567. }
  568. static int smsc95xx_ethtool_getregslen(struct net_device *netdev)
  569. {
  570. /* all smsc95xx registers */
  571. return COE_CR - ID_REV + sizeof(u32);
  572. }
  573. static void
  574. smsc95xx_ethtool_getregs(struct net_device *netdev, struct ethtool_regs *regs,
  575. void *buf)
  576. {
  577. struct usbnet *dev = netdev_priv(netdev);
  578. unsigned int i, j;
  579. int retval;
  580. u32 *data = buf;
  581. retval = smsc95xx_read_reg(dev, ID_REV, &regs->version);
  582. if (retval < 0) {
  583. netdev_warn(netdev, "REGS: cannot read ID_REV\n");
  584. return;
  585. }
  586. for (i = ID_REV, j = 0; i <= COE_CR; i += (sizeof(u32)), j++) {
  587. retval = smsc95xx_read_reg(dev, i, &data[j]);
  588. if (retval < 0) {
  589. netdev_warn(netdev, "REGS: cannot read reg[%x]\n", i);
  590. return;
  591. }
  592. }
  593. }
  594. static void smsc95xx_ethtool_get_wol(struct net_device *net,
  595. struct ethtool_wolinfo *wolinfo)
  596. {
  597. struct usbnet *dev = netdev_priv(net);
  598. struct smsc95xx_priv *pdata = dev->driver_priv;
  599. wolinfo->supported = SUPPORTED_WAKE;
  600. wolinfo->wolopts = pdata->wolopts;
  601. }
  602. static int smsc95xx_ethtool_set_wol(struct net_device *net,
  603. struct ethtool_wolinfo *wolinfo)
  604. {
  605. struct usbnet *dev = netdev_priv(net);
  606. struct smsc95xx_priv *pdata = dev->driver_priv;
  607. int ret;
  608. if (wolinfo->wolopts & ~SUPPORTED_WAKE)
  609. return -EINVAL;
  610. pdata->wolopts = wolinfo->wolopts & SUPPORTED_WAKE;
  611. ret = device_set_wakeup_enable(&dev->udev->dev, pdata->wolopts);
  612. if (ret < 0)
  613. netdev_warn(dev->net, "device_set_wakeup_enable error %d\n", ret);
  614. return ret;
  615. }
  616. static u32 smsc95xx_get_link(struct net_device *net)
  617. {
  618. phy_read_status(net->phydev);
  619. return net->phydev->link;
  620. }
  621. static void smsc95xx_ethtool_get_strings(struct net_device *netdev, u32 sset,
  622. u8 *data)
  623. {
  624. switch (sset) {
  625. case ETH_SS_TEST:
  626. net_selftest_get_strings(data);
  627. break;
  628. }
  629. }
  630. static int smsc95xx_ethtool_get_sset_count(struct net_device *ndev, int sset)
  631. {
  632. switch (sset) {
  633. case ETH_SS_TEST:
  634. return net_selftest_get_count();
  635. default:
  636. return -EOPNOTSUPP;
  637. }
  638. }
  639. static void smsc95xx_get_pauseparam(struct net_device *ndev,
  640. struct ethtool_pauseparam *pause)
  641. {
  642. struct smsc95xx_priv *pdata;
  643. struct usbnet *dev;
  644. dev = netdev_priv(ndev);
  645. pdata = dev->driver_priv;
  646. pause->autoneg = pdata->pause_autoneg;
  647. pause->rx_pause = pdata->pause_rx;
  648. pause->tx_pause = pdata->pause_tx;
  649. }
  650. static int smsc95xx_set_pauseparam(struct net_device *ndev,
  651. struct ethtool_pauseparam *pause)
  652. {
  653. bool pause_autoneg_rx, pause_autoneg_tx;
  654. struct smsc95xx_priv *pdata;
  655. struct phy_device *phydev;
  656. struct usbnet *dev;
  657. dev = netdev_priv(ndev);
  658. pdata = dev->driver_priv;
  659. phydev = ndev->phydev;
  660. if (!phydev)
  661. return -ENODEV;
  662. pdata->pause_rx = pause->rx_pause;
  663. pdata->pause_tx = pause->tx_pause;
  664. pdata->pause_autoneg = pause->autoneg;
  665. if (pause->autoneg) {
  666. pause_autoneg_rx = pause->rx_pause;
  667. pause_autoneg_tx = pause->tx_pause;
  668. } else {
  669. pause_autoneg_rx = false;
  670. pause_autoneg_tx = false;
  671. }
  672. phy_set_asym_pause(ndev->phydev, pause_autoneg_rx, pause_autoneg_tx);
  673. if (phydev->link && (!pause->autoneg ||
  674. phydev->autoneg == AUTONEG_DISABLE))
  675. smsc95xx_mac_update_fullduplex(dev);
  676. return 0;
  677. }
  678. static const struct ethtool_ops smsc95xx_ethtool_ops = {
  679. .get_link = smsc95xx_get_link,
  680. .nway_reset = phy_ethtool_nway_reset,
  681. .get_drvinfo = usbnet_get_drvinfo,
  682. .get_msglevel = usbnet_get_msglevel,
  683. .set_msglevel = usbnet_set_msglevel,
  684. .get_eeprom_len = smsc95xx_ethtool_get_eeprom_len,
  685. .get_eeprom = smsc95xx_ethtool_get_eeprom,
  686. .set_eeprom = smsc95xx_ethtool_set_eeprom,
  687. .get_regs_len = smsc95xx_ethtool_getregslen,
  688. .get_regs = smsc95xx_ethtool_getregs,
  689. .get_wol = smsc95xx_ethtool_get_wol,
  690. .set_wol = smsc95xx_ethtool_set_wol,
  691. .get_link_ksettings = phy_ethtool_get_link_ksettings,
  692. .set_link_ksettings = phy_ethtool_set_link_ksettings,
  693. .get_ts_info = ethtool_op_get_ts_info,
  694. .self_test = net_selftest,
  695. .get_strings = smsc95xx_ethtool_get_strings,
  696. .get_sset_count = smsc95xx_ethtool_get_sset_count,
  697. .get_pauseparam = smsc95xx_get_pauseparam,
  698. .set_pauseparam = smsc95xx_set_pauseparam,
  699. };
  700. static void smsc95xx_init_mac_address(struct usbnet *dev)
  701. {
  702. u8 addr[ETH_ALEN];
  703. /* maybe the boot loader passed the MAC address in devicetree */
  704. if (!platform_get_ethdev_address(&dev->udev->dev, dev->net)) {
  705. if (is_valid_ether_addr(dev->net->dev_addr)) {
  706. /* device tree values are valid so use them */
  707. netif_dbg(dev, ifup, dev->net, "MAC address read from the device tree\n");
  708. return;
  709. }
  710. }
  711. /* try reading mac address from EEPROM */
  712. if (smsc95xx_read_eeprom(dev, EEPROM_MAC_OFFSET, ETH_ALEN, addr) == 0) {
  713. eth_hw_addr_set(dev->net, addr);
  714. if (is_valid_ether_addr(dev->net->dev_addr)) {
  715. /* eeprom values are valid so use them */
  716. netif_dbg(dev, ifup, dev->net, "MAC address read from EEPROM\n");
  717. return;
  718. }
  719. }
  720. /* no useful static MAC address found. generate a random one */
  721. eth_hw_addr_random(dev->net);
  722. netif_dbg(dev, ifup, dev->net, "MAC address set to eth_random_addr\n");
  723. }
  724. static int smsc95xx_set_mac_address(struct usbnet *dev)
  725. {
  726. u32 addr_lo = dev->net->dev_addr[0] | dev->net->dev_addr[1] << 8 |
  727. dev->net->dev_addr[2] << 16 | dev->net->dev_addr[3] << 24;
  728. u32 addr_hi = dev->net->dev_addr[4] | dev->net->dev_addr[5] << 8;
  729. int ret;
  730. ret = smsc95xx_write_reg(dev, ADDRL, addr_lo);
  731. if (ret < 0)
  732. return ret;
  733. return smsc95xx_write_reg(dev, ADDRH, addr_hi);
  734. }
  735. /* starts the TX path */
  736. static int smsc95xx_start_tx_path(struct usbnet *dev)
  737. {
  738. struct smsc95xx_priv *pdata = dev->driver_priv;
  739. unsigned long flags;
  740. int ret;
  741. /* Enable Tx at MAC */
  742. spin_lock_irqsave(&pdata->mac_cr_lock, flags);
  743. pdata->mac_cr |= MAC_CR_TXEN_;
  744. spin_unlock_irqrestore(&pdata->mac_cr_lock, flags);
  745. ret = smsc95xx_write_reg(dev, MAC_CR, pdata->mac_cr);
  746. if (ret < 0)
  747. return ret;
  748. /* Enable Tx at SCSRs */
  749. return smsc95xx_write_reg(dev, TX_CFG, TX_CFG_ON_);
  750. }
  751. /* Starts the Receive path */
  752. static int smsc95xx_start_rx_path(struct usbnet *dev)
  753. {
  754. struct smsc95xx_priv *pdata = dev->driver_priv;
  755. unsigned long flags;
  756. spin_lock_irqsave(&pdata->mac_cr_lock, flags);
  757. pdata->mac_cr |= MAC_CR_RXEN_;
  758. spin_unlock_irqrestore(&pdata->mac_cr_lock, flags);
  759. return smsc95xx_write_reg(dev, MAC_CR, pdata->mac_cr);
  760. }
  761. static int smsc95xx_reset(struct usbnet *dev)
  762. {
  763. struct smsc95xx_priv *pdata = dev->driver_priv;
  764. u32 read_buf, burst_cap;
  765. int ret = 0, timeout;
  766. netif_dbg(dev, ifup, dev->net, "entering smsc95xx_reset\n");
  767. ret = smsc95xx_write_reg(dev, HW_CFG, HW_CFG_LRST_);
  768. if (ret < 0)
  769. return ret;
  770. timeout = 0;
  771. do {
  772. msleep(10);
  773. ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
  774. if (ret < 0)
  775. return ret;
  776. timeout++;
  777. } while ((read_buf & HW_CFG_LRST_) && (timeout < 100));
  778. if (timeout >= 100) {
  779. netdev_warn(dev->net, "timeout waiting for completion of Lite Reset\n");
  780. return -ETIMEDOUT;
  781. }
  782. ret = smsc95xx_set_mac_address(dev);
  783. if (ret < 0)
  784. return ret;
  785. netif_dbg(dev, ifup, dev->net, "MAC Address: %pM\n",
  786. dev->net->dev_addr);
  787. ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
  788. if (ret < 0)
  789. return ret;
  790. netif_dbg(dev, ifup, dev->net, "Read Value from HW_CFG : 0x%08x\n",
  791. read_buf);
  792. read_buf |= HW_CFG_BIR_;
  793. ret = smsc95xx_write_reg(dev, HW_CFG, read_buf);
  794. if (ret < 0)
  795. return ret;
  796. ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
  797. if (ret < 0)
  798. return ret;
  799. netif_dbg(dev, ifup, dev->net,
  800. "Read Value from HW_CFG after writing HW_CFG_BIR_: 0x%08x\n",
  801. read_buf);
  802. if (!turbo_mode) {
  803. burst_cap = 0;
  804. dev->rx_urb_size = MAX_SINGLE_PACKET_SIZE;
  805. } else if (dev->udev->speed == USB_SPEED_HIGH) {
  806. burst_cap = DEFAULT_HS_BURST_CAP_SIZE / HS_USB_PKT_SIZE;
  807. dev->rx_urb_size = DEFAULT_HS_BURST_CAP_SIZE;
  808. } else {
  809. burst_cap = DEFAULT_FS_BURST_CAP_SIZE / FS_USB_PKT_SIZE;
  810. dev->rx_urb_size = DEFAULT_FS_BURST_CAP_SIZE;
  811. }
  812. netif_dbg(dev, ifup, dev->net, "rx_urb_size=%ld\n",
  813. (ulong)dev->rx_urb_size);
  814. ret = smsc95xx_write_reg(dev, BURST_CAP, burst_cap);
  815. if (ret < 0)
  816. return ret;
  817. ret = smsc95xx_read_reg(dev, BURST_CAP, &read_buf);
  818. if (ret < 0)
  819. return ret;
  820. netif_dbg(dev, ifup, dev->net,
  821. "Read Value from BURST_CAP after writing: 0x%08x\n",
  822. read_buf);
  823. ret = smsc95xx_write_reg(dev, BULK_IN_DLY, DEFAULT_BULK_IN_DELAY);
  824. if (ret < 0)
  825. return ret;
  826. ret = smsc95xx_read_reg(dev, BULK_IN_DLY, &read_buf);
  827. if (ret < 0)
  828. return ret;
  829. netif_dbg(dev, ifup, dev->net,
  830. "Read Value from BULK_IN_DLY after writing: 0x%08x\n",
  831. read_buf);
  832. ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
  833. if (ret < 0)
  834. return ret;
  835. netif_dbg(dev, ifup, dev->net, "Read Value from HW_CFG: 0x%08x\n",
  836. read_buf);
  837. if (turbo_mode)
  838. read_buf |= (HW_CFG_MEF_ | HW_CFG_BCE_);
  839. read_buf &= ~HW_CFG_RXDOFF_;
  840. /* set Rx data offset=2, Make IP header aligns on word boundary. */
  841. read_buf |= NET_IP_ALIGN << 9;
  842. ret = smsc95xx_write_reg(dev, HW_CFG, read_buf);
  843. if (ret < 0)
  844. return ret;
  845. ret = smsc95xx_read_reg(dev, HW_CFG, &read_buf);
  846. if (ret < 0)
  847. return ret;
  848. netif_dbg(dev, ifup, dev->net,
  849. "Read Value from HW_CFG after writing: 0x%08x\n", read_buf);
  850. ret = smsc95xx_write_reg(dev, INT_STS, INT_STS_CLEAR_ALL_);
  851. if (ret < 0)
  852. return ret;
  853. ret = smsc95xx_read_reg(dev, ID_REV, &read_buf);
  854. if (ret < 0)
  855. return ret;
  856. netif_dbg(dev, ifup, dev->net, "ID_REV = 0x%08x\n", read_buf);
  857. ret = smsc95xx_read_reg(dev, LED_GPIO_CFG, &read_buf);
  858. if (ret < 0)
  859. return ret;
  860. /* Configure GPIO pins as LED outputs */
  861. read_buf |= LED_GPIO_CFG_SPD_LED | LED_GPIO_CFG_LNK_LED |
  862. LED_GPIO_CFG_FDX_LED;
  863. ret = smsc95xx_write_reg(dev, LED_GPIO_CFG, read_buf);
  864. if (ret < 0)
  865. return ret;
  866. /* Init Tx */
  867. ret = smsc95xx_write_reg(dev, FLOW, 0);
  868. if (ret < 0)
  869. return ret;
  870. ret = smsc95xx_write_reg(dev, AFC_CFG, AFC_CFG_DEFAULT);
  871. if (ret < 0)
  872. return ret;
  873. /* Don't need mac_cr_lock during initialisation */
  874. ret = smsc95xx_read_reg(dev, MAC_CR, &pdata->mac_cr);
  875. if (ret < 0)
  876. return ret;
  877. /* Init Rx */
  878. /* Set Vlan */
  879. ret = smsc95xx_write_reg(dev, VLAN1, (u32)ETH_P_8021Q);
  880. if (ret < 0)
  881. return ret;
  882. /* Enable or disable checksum offload engines */
  883. ret = smsc95xx_set_features(dev->net, dev->net->features);
  884. if (ret < 0) {
  885. netdev_warn(dev->net, "Failed to set checksum offload features\n");
  886. return ret;
  887. }
  888. smsc95xx_set_multicast(dev->net);
  889. ret = smsc95xx_read_reg(dev, INT_EP_CTL, &read_buf);
  890. if (ret < 0)
  891. return ret;
  892. /* enable PHY interrupts */
  893. read_buf |= INT_EP_CTL_PHY_INT_;
  894. ret = smsc95xx_write_reg(dev, INT_EP_CTL, read_buf);
  895. if (ret < 0)
  896. return ret;
  897. ret = smsc95xx_start_tx_path(dev);
  898. if (ret < 0) {
  899. netdev_warn(dev->net, "Failed to start TX path\n");
  900. return ret;
  901. }
  902. ret = smsc95xx_start_rx_path(dev);
  903. if (ret < 0) {
  904. netdev_warn(dev->net, "Failed to start RX path\n");
  905. return ret;
  906. }
  907. netif_dbg(dev, ifup, dev->net, "smsc95xx_reset, return 0\n");
  908. return 0;
  909. }
  910. static const struct net_device_ops smsc95xx_netdev_ops = {
  911. .ndo_open = usbnet_open,
  912. .ndo_stop = usbnet_stop,
  913. .ndo_start_xmit = usbnet_start_xmit,
  914. .ndo_tx_timeout = usbnet_tx_timeout,
  915. .ndo_change_mtu = usbnet_change_mtu,
  916. .ndo_get_stats64 = dev_get_tstats64,
  917. .ndo_set_mac_address = eth_mac_addr,
  918. .ndo_validate_addr = eth_validate_addr,
  919. .ndo_eth_ioctl = phy_do_ioctl_running,
  920. .ndo_set_rx_mode = smsc95xx_set_multicast,
  921. .ndo_set_features = smsc95xx_set_features,
  922. };
  923. static void smsc95xx_handle_link_change(struct net_device *net)
  924. {
  925. struct usbnet *dev = netdev_priv(net);
  926. phy_print_status(net->phydev);
  927. smsc95xx_mac_update_fullduplex(dev);
  928. usbnet_defer_kevent(dev, EVENT_LINK_CHANGE);
  929. }
  930. static int smsc95xx_bind(struct usbnet *dev, struct usb_interface *intf)
  931. {
  932. struct smsc95xx_priv *pdata;
  933. char usb_path[64];
  934. int ret, phy_irq;
  935. u32 val;
  936. ret = usbnet_get_endpoints(dev, intf);
  937. if (ret < 0) {
  938. netdev_warn(dev->net, "usbnet_get_endpoints failed: %d\n", ret);
  939. return ret;
  940. }
  941. pdata = kzalloc_obj(*pdata);
  942. if (!pdata)
  943. return -ENOMEM;
  944. dev->driver_priv = pdata;
  945. spin_lock_init(&pdata->mac_cr_lock);
  946. /* LAN95xx devices do not alter the computed checksum of 0 to 0xffff.
  947. * RFC 2460, ipv6 UDP calculated checksum yields a result of zero must
  948. * be changed to 0xffff. RFC 768, ipv4 UDP computed checksum is zero,
  949. * it is transmitted as all ones. The zero transmitted checksum means
  950. * transmitter generated no checksum. Hence, enable csum offload only
  951. * for ipv4 packets.
  952. */
  953. if (DEFAULT_TX_CSUM_ENABLE)
  954. dev->net->features |= NETIF_F_IP_CSUM;
  955. if (DEFAULT_RX_CSUM_ENABLE)
  956. dev->net->features |= NETIF_F_RXCSUM;
  957. dev->net->hw_features = NETIF_F_IP_CSUM | NETIF_F_RXCSUM;
  958. set_bit(EVENT_NO_IP_ALIGN, &dev->flags);
  959. smsc95xx_init_mac_address(dev);
  960. /* Init all registers */
  961. ret = smsc95xx_reset(dev);
  962. if (ret)
  963. goto free_pdata;
  964. /* create irq domain for use by PHY driver and GPIO consumers */
  965. usb_make_path(dev->udev, usb_path, sizeof(usb_path));
  966. pdata->irqfwnode = irq_domain_alloc_named_fwnode(usb_path);
  967. if (!pdata->irqfwnode) {
  968. ret = -ENOMEM;
  969. goto free_pdata;
  970. }
  971. pdata->irqdomain = irq_domain_create_linear(pdata->irqfwnode,
  972. SMSC95XX_NR_IRQS,
  973. &irq_domain_simple_ops,
  974. pdata);
  975. if (!pdata->irqdomain) {
  976. ret = -ENOMEM;
  977. goto free_irqfwnode;
  978. }
  979. phy_irq = irq_create_mapping(pdata->irqdomain, PHY_HWIRQ);
  980. if (!phy_irq) {
  981. ret = -ENOENT;
  982. goto remove_irqdomain;
  983. }
  984. pdata->irqchip = dummy_irq_chip;
  985. pdata->irqchip.name = SMSC_CHIPNAME;
  986. irq_set_chip_and_handler_name(phy_irq, &pdata->irqchip,
  987. handle_simple_irq, "phy");
  988. pdata->mdiobus = mdiobus_alloc();
  989. if (!pdata->mdiobus) {
  990. ret = -ENOMEM;
  991. goto dispose_irq;
  992. }
  993. ret = smsc95xx_read_reg(dev, HW_CFG, &val);
  994. if (ret < 0)
  995. goto free_mdio;
  996. pdata->is_internal_phy = !(val & HW_CFG_PSEL_);
  997. if (pdata->is_internal_phy)
  998. pdata->mdiobus->phy_mask = ~(1u << SMSC95XX_INTERNAL_PHY_ID);
  999. pdata->mdiobus->priv = dev;
  1000. pdata->mdiobus->read = smsc95xx_mdiobus_read;
  1001. pdata->mdiobus->write = smsc95xx_mdiobus_write;
  1002. pdata->mdiobus->reset = smsc95xx_mdiobus_reset;
  1003. pdata->mdiobus->name = "smsc95xx-mdiobus";
  1004. pdata->mdiobus->parent = &dev->udev->dev;
  1005. snprintf(pdata->mdiobus->id, ARRAY_SIZE(pdata->mdiobus->id),
  1006. "usb-%03d:%03d", dev->udev->bus->busnum, dev->udev->devnum);
  1007. ret = mdiobus_register(pdata->mdiobus);
  1008. if (ret) {
  1009. netdev_err(dev->net, "Could not register MDIO bus\n");
  1010. goto free_mdio;
  1011. }
  1012. pdata->phydev = phy_find_first(pdata->mdiobus);
  1013. if (!pdata->phydev) {
  1014. netdev_err(dev->net, "no PHY found\n");
  1015. ret = -ENODEV;
  1016. goto unregister_mdio;
  1017. }
  1018. pdata->phydev->irq = phy_irq;
  1019. pdata->phydev->is_internal = pdata->is_internal_phy;
  1020. /* detect device revision as different features may be available */
  1021. ret = smsc95xx_read_reg(dev, ID_REV, &val);
  1022. if (ret < 0)
  1023. goto unregister_mdio;
  1024. val >>= 16;
  1025. if ((val == ID_REV_CHIP_ID_9500A_) || (val == ID_REV_CHIP_ID_9530_) ||
  1026. (val == ID_REV_CHIP_ID_89530_) || (val == ID_REV_CHIP_ID_9730_))
  1027. pdata->features = (FEATURE_8_WAKEUP_FILTERS |
  1028. FEATURE_PHY_NLP_CROSSOVER |
  1029. FEATURE_REMOTE_WAKEUP);
  1030. else if (val == ID_REV_CHIP_ID_9512_)
  1031. pdata->features = FEATURE_8_WAKEUP_FILTERS;
  1032. dev->net->netdev_ops = &smsc95xx_netdev_ops;
  1033. dev->net->ethtool_ops = &smsc95xx_ethtool_ops;
  1034. dev->net->flags |= IFF_MULTICAST;
  1035. dev->net->hard_header_len += SMSC95XX_TX_OVERHEAD_CSUM;
  1036. dev->net->min_mtu = ETH_MIN_MTU;
  1037. dev->net->max_mtu = ETH_DATA_LEN;
  1038. dev->hard_mtu = dev->net->mtu + dev->net->hard_header_len;
  1039. pdata->pause_tx = true;
  1040. pdata->pause_rx = true;
  1041. pdata->pause_autoneg = true;
  1042. phy_support_asym_pause(pdata->phydev);
  1043. ret = phy_connect_direct(dev->net, pdata->phydev,
  1044. &smsc95xx_handle_link_change,
  1045. PHY_INTERFACE_MODE_MII);
  1046. if (ret) {
  1047. netdev_err(dev->net, "can't attach PHY to %s\n", pdata->mdiobus->id);
  1048. goto unregister_mdio;
  1049. }
  1050. phy_attached_info(dev->net->phydev);
  1051. return 0;
  1052. unregister_mdio:
  1053. mdiobus_unregister(pdata->mdiobus);
  1054. free_mdio:
  1055. mdiobus_free(pdata->mdiobus);
  1056. dispose_irq:
  1057. irq_dispose_mapping(phy_irq);
  1058. remove_irqdomain:
  1059. irq_domain_remove(pdata->irqdomain);
  1060. free_irqfwnode:
  1061. irq_domain_free_fwnode(pdata->irqfwnode);
  1062. free_pdata:
  1063. kfree(pdata);
  1064. return ret;
  1065. }
  1066. static void smsc95xx_unbind(struct usbnet *dev, struct usb_interface *intf)
  1067. {
  1068. struct smsc95xx_priv *pdata = dev->driver_priv;
  1069. phy_disconnect(dev->net->phydev);
  1070. mdiobus_unregister(pdata->mdiobus);
  1071. mdiobus_free(pdata->mdiobus);
  1072. irq_dispose_mapping(irq_find_mapping(pdata->irqdomain, PHY_HWIRQ));
  1073. irq_domain_remove(pdata->irqdomain);
  1074. irq_domain_free_fwnode(pdata->irqfwnode);
  1075. netif_dbg(dev, ifdown, dev->net, "free pdata\n");
  1076. kfree(pdata);
  1077. }
  1078. static int smsc95xx_start_phy(struct usbnet *dev)
  1079. {
  1080. phy_start(dev->net->phydev);
  1081. return 0;
  1082. }
  1083. static int smsc95xx_stop(struct usbnet *dev)
  1084. {
  1085. phy_stop(dev->net->phydev);
  1086. return 0;
  1087. }
  1088. static u32 smsc_crc(const u8 *buffer, size_t len, int filter)
  1089. {
  1090. u32 crc = bitrev16(crc16(0xFFFF, buffer, len));
  1091. return crc << ((filter % 2) * 16);
  1092. }
  1093. static int smsc95xx_link_ok(struct usbnet *dev)
  1094. {
  1095. struct smsc95xx_priv *pdata = dev->driver_priv;
  1096. int ret;
  1097. /* first, a dummy read, needed to latch some MII phys */
  1098. ret = smsc95xx_mdio_read(dev, pdata->phydev->mdio.addr, MII_BMSR);
  1099. if (ret < 0)
  1100. return ret;
  1101. ret = smsc95xx_mdio_read(dev, pdata->phydev->mdio.addr, MII_BMSR);
  1102. if (ret < 0)
  1103. return ret;
  1104. return !!(ret & BMSR_LSTATUS);
  1105. }
  1106. static int smsc95xx_enter_suspend0(struct usbnet *dev)
  1107. {
  1108. struct smsc95xx_priv *pdata = dev->driver_priv;
  1109. u32 val;
  1110. int ret;
  1111. ret = smsc95xx_read_reg(dev, PM_CTRL, &val);
  1112. if (ret < 0)
  1113. return ret;
  1114. val &= (~(PM_CTL_SUS_MODE_ | PM_CTL_WUPS_ | PM_CTL_PHY_RST_));
  1115. val |= PM_CTL_SUS_MODE_0;
  1116. ret = smsc95xx_write_reg(dev, PM_CTRL, val);
  1117. if (ret < 0)
  1118. return ret;
  1119. /* clear wol status */
  1120. val &= ~PM_CTL_WUPS_;
  1121. val |= PM_CTL_WUPS_WOL_;
  1122. /* enable energy detection */
  1123. if (pdata->wolopts & WAKE_PHY)
  1124. val |= PM_CTL_WUPS_ED_;
  1125. ret = smsc95xx_write_reg(dev, PM_CTRL, val);
  1126. if (ret < 0)
  1127. return ret;
  1128. /* read back PM_CTRL */
  1129. ret = smsc95xx_read_reg(dev, PM_CTRL, &val);
  1130. if (ret < 0)
  1131. return ret;
  1132. pdata->suspend_flags |= SUSPEND_SUSPEND0;
  1133. return 0;
  1134. }
  1135. static int smsc95xx_enter_suspend1(struct usbnet *dev)
  1136. {
  1137. struct smsc95xx_priv *pdata = dev->driver_priv;
  1138. int ret, phy_id = pdata->phydev->mdio.addr;
  1139. u32 val;
  1140. /* reconfigure link pulse detection timing for
  1141. * compatibility with non-standard link partners
  1142. */
  1143. if (pdata->features & FEATURE_PHY_NLP_CROSSOVER)
  1144. smsc95xx_mdio_write(dev, phy_id, PHY_EDPD_CONFIG,
  1145. PHY_EDPD_CONFIG_DEFAULT);
  1146. /* enable energy detect power-down mode */
  1147. ret = smsc95xx_mdio_read(dev, phy_id, PHY_MODE_CTRL_STS);
  1148. if (ret < 0)
  1149. return ret;
  1150. ret |= MODE_CTRL_STS_EDPWRDOWN_;
  1151. smsc95xx_mdio_write(dev, phy_id, PHY_MODE_CTRL_STS, ret);
  1152. /* enter SUSPEND1 mode */
  1153. ret = smsc95xx_read_reg(dev, PM_CTRL, &val);
  1154. if (ret < 0)
  1155. return ret;
  1156. val &= ~(PM_CTL_SUS_MODE_ | PM_CTL_WUPS_ | PM_CTL_PHY_RST_);
  1157. val |= PM_CTL_SUS_MODE_1;
  1158. ret = smsc95xx_write_reg(dev, PM_CTRL, val);
  1159. if (ret < 0)
  1160. return ret;
  1161. /* clear wol status, enable energy detection */
  1162. val &= ~PM_CTL_WUPS_;
  1163. val |= (PM_CTL_WUPS_ED_ | PM_CTL_ED_EN_);
  1164. ret = smsc95xx_write_reg(dev, PM_CTRL, val);
  1165. if (ret < 0)
  1166. return ret;
  1167. pdata->suspend_flags |= SUSPEND_SUSPEND1;
  1168. return 0;
  1169. }
  1170. static int smsc95xx_enter_suspend2(struct usbnet *dev)
  1171. {
  1172. struct smsc95xx_priv *pdata = dev->driver_priv;
  1173. u32 val;
  1174. int ret;
  1175. ret = smsc95xx_read_reg(dev, PM_CTRL, &val);
  1176. if (ret < 0)
  1177. return ret;
  1178. val &= ~(PM_CTL_SUS_MODE_ | PM_CTL_WUPS_ | PM_CTL_PHY_RST_);
  1179. val |= PM_CTL_SUS_MODE_2;
  1180. ret = smsc95xx_write_reg(dev, PM_CTRL, val);
  1181. if (ret < 0)
  1182. return ret;
  1183. pdata->suspend_flags |= SUSPEND_SUSPEND2;
  1184. return 0;
  1185. }
  1186. static int smsc95xx_enter_suspend3(struct usbnet *dev)
  1187. {
  1188. struct smsc95xx_priv *pdata = dev->driver_priv;
  1189. u32 val;
  1190. int ret;
  1191. ret = smsc95xx_read_reg(dev, RX_FIFO_INF, &val);
  1192. if (ret < 0)
  1193. return ret;
  1194. if (val & RX_FIFO_INF_USED_) {
  1195. netdev_info(dev->net, "rx fifo not empty in autosuspend\n");
  1196. return -EBUSY;
  1197. }
  1198. ret = smsc95xx_read_reg(dev, PM_CTRL, &val);
  1199. if (ret < 0)
  1200. return ret;
  1201. val &= ~(PM_CTL_SUS_MODE_ | PM_CTL_WUPS_ | PM_CTL_PHY_RST_);
  1202. val |= PM_CTL_SUS_MODE_3 | PM_CTL_RES_CLR_WKP_STS;
  1203. ret = smsc95xx_write_reg(dev, PM_CTRL, val);
  1204. if (ret < 0)
  1205. return ret;
  1206. /* clear wol status */
  1207. val &= ~PM_CTL_WUPS_;
  1208. val |= PM_CTL_WUPS_WOL_;
  1209. ret = smsc95xx_write_reg(dev, PM_CTRL, val);
  1210. if (ret < 0)
  1211. return ret;
  1212. pdata->suspend_flags |= SUSPEND_SUSPEND3;
  1213. return 0;
  1214. }
  1215. static int smsc95xx_autosuspend(struct usbnet *dev, u32 link_up)
  1216. {
  1217. struct smsc95xx_priv *pdata = dev->driver_priv;
  1218. if (!netif_running(dev->net)) {
  1219. /* interface is ifconfig down so fully power down hw */
  1220. netdev_dbg(dev->net, "autosuspend entering SUSPEND2\n");
  1221. return smsc95xx_enter_suspend2(dev);
  1222. }
  1223. if (!link_up) {
  1224. /* link is down so enter EDPD mode, but only if device can
  1225. * reliably resume from it. This check should be redundant
  1226. * as current FEATURE_REMOTE_WAKEUP parts also support
  1227. * FEATURE_PHY_NLP_CROSSOVER but it's included for clarity */
  1228. if (!(pdata->features & FEATURE_PHY_NLP_CROSSOVER)) {
  1229. netdev_warn(dev->net, "EDPD not supported\n");
  1230. return -EBUSY;
  1231. }
  1232. netdev_dbg(dev->net, "autosuspend entering SUSPEND1\n");
  1233. netdev_info(dev->net, "entering SUSPEND1 mode\n");
  1234. return smsc95xx_enter_suspend1(dev);
  1235. }
  1236. netdev_dbg(dev->net, "autosuspend entering SUSPEND3\n");
  1237. return smsc95xx_enter_suspend3(dev);
  1238. }
  1239. static int smsc95xx_suspend(struct usb_interface *intf, pm_message_t message)
  1240. {
  1241. struct usbnet *dev = usb_get_intfdata(intf);
  1242. struct smsc95xx_priv *pdata = dev->driver_priv;
  1243. u32 val, link_up;
  1244. int ret;
  1245. pdata->pm_task = current;
  1246. ret = usbnet_suspend(intf, message);
  1247. if (ret < 0) {
  1248. netdev_warn(dev->net, "usbnet_suspend error\n");
  1249. pdata->pm_task = NULL;
  1250. return ret;
  1251. }
  1252. if (pdata->suspend_flags) {
  1253. netdev_warn(dev->net, "error during last resume\n");
  1254. pdata->suspend_flags = 0;
  1255. }
  1256. link_up = smsc95xx_link_ok(dev);
  1257. if (message.event == PM_EVENT_AUTO_SUSPEND &&
  1258. (pdata->features & FEATURE_REMOTE_WAKEUP)) {
  1259. ret = smsc95xx_autosuspend(dev, link_up);
  1260. goto done;
  1261. }
  1262. /* if we get this far we're not autosuspending */
  1263. /* if no wol options set, or if link is down and we're not waking on
  1264. * PHY activity, enter lowest power SUSPEND2 mode
  1265. */
  1266. if (!(pdata->wolopts & SUPPORTED_WAKE) ||
  1267. !(link_up || (pdata->wolopts & WAKE_PHY))) {
  1268. netdev_info(dev->net, "entering SUSPEND2 mode\n");
  1269. /* disable energy detect (link up) & wake up events */
  1270. ret = smsc95xx_read_reg(dev, WUCSR, &val);
  1271. if (ret < 0)
  1272. goto done;
  1273. val &= ~(WUCSR_MPEN_ | WUCSR_WAKE_EN_);
  1274. ret = smsc95xx_write_reg(dev, WUCSR, val);
  1275. if (ret < 0)
  1276. goto done;
  1277. ret = smsc95xx_read_reg(dev, PM_CTRL, &val);
  1278. if (ret < 0)
  1279. goto done;
  1280. val &= ~(PM_CTL_ED_EN_ | PM_CTL_WOL_EN_);
  1281. ret = smsc95xx_write_reg(dev, PM_CTRL, val);
  1282. if (ret < 0)
  1283. goto done;
  1284. ret = smsc95xx_enter_suspend2(dev);
  1285. goto done;
  1286. }
  1287. if (pdata->wolopts & WAKE_PHY) {
  1288. /* if link is down then configure EDPD and enter SUSPEND1,
  1289. * otherwise enter SUSPEND0 below
  1290. */
  1291. if (!link_up) {
  1292. netdev_info(dev->net, "entering SUSPEND1 mode\n");
  1293. ret = smsc95xx_enter_suspend1(dev);
  1294. goto done;
  1295. }
  1296. }
  1297. if (pdata->wolopts & (WAKE_BCAST | WAKE_MCAST | WAKE_ARP | WAKE_UCAST)) {
  1298. u32 *filter_mask = kcalloc(32, sizeof(u32), GFP_KERNEL);
  1299. u32 command[2];
  1300. u32 offset[2];
  1301. u32 crc[4];
  1302. int wuff_filter_count =
  1303. (pdata->features & FEATURE_8_WAKEUP_FILTERS) ?
  1304. LAN9500A_WUFF_NUM : LAN9500_WUFF_NUM;
  1305. int i, filter = 0;
  1306. if (!filter_mask) {
  1307. netdev_warn(dev->net, "Unable to allocate filter_mask\n");
  1308. ret = -ENOMEM;
  1309. goto done;
  1310. }
  1311. memset(command, 0, sizeof(command));
  1312. memset(offset, 0, sizeof(offset));
  1313. memset(crc, 0, sizeof(crc));
  1314. if (pdata->wolopts & WAKE_BCAST) {
  1315. const u8 bcast[] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
  1316. netdev_info(dev->net, "enabling broadcast detection\n");
  1317. filter_mask[filter * 4] = 0x003F;
  1318. filter_mask[filter * 4 + 1] = 0x00;
  1319. filter_mask[filter * 4 + 2] = 0x00;
  1320. filter_mask[filter * 4 + 3] = 0x00;
  1321. command[filter/4] |= 0x05UL << ((filter % 4) * 8);
  1322. offset[filter/4] |= 0x00 << ((filter % 4) * 8);
  1323. crc[filter/2] |= smsc_crc(bcast, 6, filter);
  1324. filter++;
  1325. }
  1326. if (pdata->wolopts & WAKE_MCAST) {
  1327. const u8 mcast[] = {0x01, 0x00, 0x5E};
  1328. netdev_info(dev->net, "enabling multicast detection\n");
  1329. filter_mask[filter * 4] = 0x0007;
  1330. filter_mask[filter * 4 + 1] = 0x00;
  1331. filter_mask[filter * 4 + 2] = 0x00;
  1332. filter_mask[filter * 4 + 3] = 0x00;
  1333. command[filter/4] |= 0x09UL << ((filter % 4) * 8);
  1334. offset[filter/4] |= 0x00 << ((filter % 4) * 8);
  1335. crc[filter/2] |= smsc_crc(mcast, 3, filter);
  1336. filter++;
  1337. }
  1338. if (pdata->wolopts & WAKE_ARP) {
  1339. const u8 arp[] = {0x08, 0x06};
  1340. netdev_info(dev->net, "enabling ARP detection\n");
  1341. filter_mask[filter * 4] = 0x0003;
  1342. filter_mask[filter * 4 + 1] = 0x00;
  1343. filter_mask[filter * 4 + 2] = 0x00;
  1344. filter_mask[filter * 4 + 3] = 0x00;
  1345. command[filter/4] |= 0x05UL << ((filter % 4) * 8);
  1346. offset[filter/4] |= 0x0C << ((filter % 4) * 8);
  1347. crc[filter/2] |= smsc_crc(arp, 2, filter);
  1348. filter++;
  1349. }
  1350. if (pdata->wolopts & WAKE_UCAST) {
  1351. netdev_info(dev->net, "enabling unicast detection\n");
  1352. filter_mask[filter * 4] = 0x003F;
  1353. filter_mask[filter * 4 + 1] = 0x00;
  1354. filter_mask[filter * 4 + 2] = 0x00;
  1355. filter_mask[filter * 4 + 3] = 0x00;
  1356. command[filter/4] |= 0x01UL << ((filter % 4) * 8);
  1357. offset[filter/4] |= 0x00 << ((filter % 4) * 8);
  1358. crc[filter/2] |= smsc_crc(dev->net->dev_addr, ETH_ALEN, filter);
  1359. filter++;
  1360. }
  1361. for (i = 0; i < (wuff_filter_count * 4); i++) {
  1362. ret = smsc95xx_write_reg(dev, WUFF, filter_mask[i]);
  1363. if (ret < 0) {
  1364. kfree(filter_mask);
  1365. goto done;
  1366. }
  1367. }
  1368. kfree(filter_mask);
  1369. for (i = 0; i < (wuff_filter_count / 4); i++) {
  1370. ret = smsc95xx_write_reg(dev, WUFF, command[i]);
  1371. if (ret < 0)
  1372. goto done;
  1373. }
  1374. for (i = 0; i < (wuff_filter_count / 4); i++) {
  1375. ret = smsc95xx_write_reg(dev, WUFF, offset[i]);
  1376. if (ret < 0)
  1377. goto done;
  1378. }
  1379. for (i = 0; i < (wuff_filter_count / 2); i++) {
  1380. ret = smsc95xx_write_reg(dev, WUFF, crc[i]);
  1381. if (ret < 0)
  1382. goto done;
  1383. }
  1384. /* clear any pending pattern match packet status */
  1385. ret = smsc95xx_read_reg(dev, WUCSR, &val);
  1386. if (ret < 0)
  1387. goto done;
  1388. val |= WUCSR_WUFR_;
  1389. ret = smsc95xx_write_reg(dev, WUCSR, val);
  1390. if (ret < 0)
  1391. goto done;
  1392. }
  1393. if (pdata->wolopts & WAKE_MAGIC) {
  1394. /* clear any pending magic packet status */
  1395. ret = smsc95xx_read_reg(dev, WUCSR, &val);
  1396. if (ret < 0)
  1397. goto done;
  1398. val |= WUCSR_MPR_;
  1399. ret = smsc95xx_write_reg(dev, WUCSR, val);
  1400. if (ret < 0)
  1401. goto done;
  1402. }
  1403. /* enable/disable wakeup sources */
  1404. ret = smsc95xx_read_reg(dev, WUCSR, &val);
  1405. if (ret < 0)
  1406. goto done;
  1407. if (pdata->wolopts & (WAKE_BCAST | WAKE_MCAST | WAKE_ARP | WAKE_UCAST)) {
  1408. netdev_info(dev->net, "enabling pattern match wakeup\n");
  1409. val |= WUCSR_WAKE_EN_;
  1410. } else {
  1411. netdev_info(dev->net, "disabling pattern match wakeup\n");
  1412. val &= ~WUCSR_WAKE_EN_;
  1413. }
  1414. if (pdata->wolopts & WAKE_MAGIC) {
  1415. netdev_info(dev->net, "enabling magic packet wakeup\n");
  1416. val |= WUCSR_MPEN_;
  1417. } else {
  1418. netdev_info(dev->net, "disabling magic packet wakeup\n");
  1419. val &= ~WUCSR_MPEN_;
  1420. }
  1421. ret = smsc95xx_write_reg(dev, WUCSR, val);
  1422. if (ret < 0)
  1423. goto done;
  1424. /* enable wol wakeup source */
  1425. ret = smsc95xx_read_reg(dev, PM_CTRL, &val);
  1426. if (ret < 0)
  1427. goto done;
  1428. val |= PM_CTL_WOL_EN_;
  1429. /* phy energy detect wakeup source */
  1430. if (pdata->wolopts & WAKE_PHY)
  1431. val |= PM_CTL_ED_EN_;
  1432. ret = smsc95xx_write_reg(dev, PM_CTRL, val);
  1433. if (ret < 0)
  1434. goto done;
  1435. /* enable receiver to enable frame reception */
  1436. smsc95xx_start_rx_path(dev);
  1437. /* some wol options are enabled, so enter SUSPEND0 */
  1438. netdev_info(dev->net, "entering SUSPEND0 mode\n");
  1439. ret = smsc95xx_enter_suspend0(dev);
  1440. done:
  1441. /*
  1442. * TODO: resume() might need to handle the suspend failure
  1443. * in system sleep
  1444. */
  1445. if (ret && PMSG_IS_AUTO(message))
  1446. usbnet_resume(intf);
  1447. pdata->pm_task = NULL;
  1448. return ret;
  1449. }
  1450. static int smsc95xx_resume(struct usb_interface *intf)
  1451. {
  1452. struct usbnet *dev = usb_get_intfdata(intf);
  1453. struct smsc95xx_priv *pdata;
  1454. u8 suspend_flags;
  1455. int ret;
  1456. u32 val;
  1457. BUG_ON(!dev);
  1458. pdata = dev->driver_priv;
  1459. suspend_flags = pdata->suspend_flags;
  1460. netdev_dbg(dev->net, "resume suspend_flags=0x%02x\n", suspend_flags);
  1461. /* do this first to ensure it's cleared even in error case */
  1462. pdata->suspend_flags = 0;
  1463. pdata->pm_task = current;
  1464. if (suspend_flags & SUSPEND_ALLMODES) {
  1465. /* clear wake-up sources */
  1466. ret = smsc95xx_read_reg(dev, WUCSR, &val);
  1467. if (ret < 0)
  1468. goto done;
  1469. val &= ~(WUCSR_WAKE_EN_ | WUCSR_MPEN_);
  1470. ret = smsc95xx_write_reg(dev, WUCSR, val);
  1471. if (ret < 0)
  1472. goto done;
  1473. /* clear wake-up status */
  1474. ret = smsc95xx_read_reg(dev, PM_CTRL, &val);
  1475. if (ret < 0)
  1476. goto done;
  1477. val &= ~PM_CTL_WOL_EN_;
  1478. val |= PM_CTL_WUPS_;
  1479. ret = smsc95xx_write_reg(dev, PM_CTRL, val);
  1480. if (ret < 0)
  1481. goto done;
  1482. }
  1483. phy_init_hw(pdata->phydev);
  1484. ret = usbnet_resume(intf);
  1485. if (ret < 0)
  1486. netdev_warn(dev->net, "usbnet_resume error\n");
  1487. done:
  1488. pdata->pm_task = NULL;
  1489. return ret;
  1490. }
  1491. static int smsc95xx_reset_resume(struct usb_interface *intf)
  1492. {
  1493. struct usbnet *dev = usb_get_intfdata(intf);
  1494. struct smsc95xx_priv *pdata = dev->driver_priv;
  1495. int ret;
  1496. pdata->pm_task = current;
  1497. ret = smsc95xx_reset(dev);
  1498. pdata->pm_task = NULL;
  1499. if (ret < 0)
  1500. return ret;
  1501. return smsc95xx_resume(intf);
  1502. }
  1503. static void smsc95xx_rx_csum_offload(struct sk_buff *skb)
  1504. {
  1505. u16 *csum_ptr = (u16 *)(skb_tail_pointer(skb) - 2);
  1506. skb->csum = (__force __wsum)get_unaligned(csum_ptr);
  1507. skb->ip_summed = CHECKSUM_COMPLETE;
  1508. skb_trim(skb, skb->len - 2); /* remove csum */
  1509. }
  1510. static int smsc95xx_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
  1511. {
  1512. /* This check is no longer done by usbnet */
  1513. if (skb->len < dev->net->hard_header_len)
  1514. return 0;
  1515. while (skb->len > 0) {
  1516. u32 header, align_count;
  1517. struct sk_buff *ax_skb;
  1518. unsigned char *packet;
  1519. u16 size;
  1520. header = get_unaligned_le32(skb->data);
  1521. skb_pull(skb, 4 + NET_IP_ALIGN);
  1522. packet = skb->data;
  1523. /* get the packet length */
  1524. size = (u16)((header & RX_STS_FL_) >> 16);
  1525. align_count = (4 - ((size + NET_IP_ALIGN) % 4)) % 4;
  1526. if (unlikely(size > skb->len)) {
  1527. netif_dbg(dev, rx_err, dev->net,
  1528. "size err header=0x%08x\n", header);
  1529. return 0;
  1530. }
  1531. if (unlikely(header & RX_STS_ES_)) {
  1532. netif_dbg(dev, rx_err, dev->net,
  1533. "Error header=0x%08x\n", header);
  1534. dev->net->stats.rx_errors++;
  1535. dev->net->stats.rx_dropped++;
  1536. if (header & RX_STS_CRC_) {
  1537. dev->net->stats.rx_crc_errors++;
  1538. } else {
  1539. if (header & (RX_STS_TL_ | RX_STS_RF_))
  1540. dev->net->stats.rx_frame_errors++;
  1541. if ((header & RX_STS_LE_) &&
  1542. (!(header & RX_STS_FT_)))
  1543. dev->net->stats.rx_length_errors++;
  1544. }
  1545. } else {
  1546. /* ETH_FRAME_LEN + 4(CRC) + 2(COE) + 4(Vlan) */
  1547. if (unlikely(size > (ETH_FRAME_LEN + 12))) {
  1548. netif_dbg(dev, rx_err, dev->net,
  1549. "size err header=0x%08x\n", header);
  1550. return 0;
  1551. }
  1552. /* last frame in this batch */
  1553. if (skb->len == size) {
  1554. if (dev->net->features & NETIF_F_RXCSUM)
  1555. smsc95xx_rx_csum_offload(skb);
  1556. skb_trim(skb, skb->len - 4); /* remove fcs */
  1557. return 1;
  1558. }
  1559. ax_skb = netdev_alloc_skb_ip_align(dev->net, size);
  1560. if (unlikely(!ax_skb)) {
  1561. netdev_warn(dev->net, "Error allocating skb\n");
  1562. return 0;
  1563. }
  1564. skb_put(ax_skb, size);
  1565. memcpy(ax_skb->data, packet, size);
  1566. if (dev->net->features & NETIF_F_RXCSUM)
  1567. smsc95xx_rx_csum_offload(ax_skb);
  1568. skb_trim(ax_skb, ax_skb->len - 4); /* remove fcs */
  1569. usbnet_skb_return(dev, ax_skb);
  1570. }
  1571. skb_pull(skb, size);
  1572. /* padding bytes before the next frame starts */
  1573. if (skb->len)
  1574. skb_pull(skb, align_count);
  1575. }
  1576. return 1;
  1577. }
  1578. static u32 smsc95xx_calc_csum_preamble(struct sk_buff *skb)
  1579. {
  1580. u16 low_16 = (u16)skb_checksum_start_offset(skb);
  1581. u16 high_16 = low_16 + skb->csum_offset;
  1582. return (high_16 << 16) | low_16;
  1583. }
  1584. /* The TX CSUM won't work if the checksum lies in the last 4 bytes of the
  1585. * transmission. This is fairly unlikely, only seems to trigger with some
  1586. * short TCP ACK packets sent.
  1587. *
  1588. * Note, this calculation should probably check for the alignment of the
  1589. * data as well, but a straight check for csum being in the last four bytes
  1590. * of the packet should be ok for now.
  1591. */
  1592. static bool smsc95xx_can_tx_checksum(struct sk_buff *skb)
  1593. {
  1594. unsigned int len = skb->len - skb_checksum_start_offset(skb);
  1595. if (skb->len <= 45)
  1596. return false;
  1597. return skb->csum_offset < (len - (4 + 1));
  1598. }
  1599. static struct sk_buff *smsc95xx_tx_fixup(struct usbnet *dev,
  1600. struct sk_buff *skb, gfp_t flags)
  1601. {
  1602. bool csum = skb->ip_summed == CHECKSUM_PARTIAL;
  1603. int overhead = csum ? SMSC95XX_TX_OVERHEAD_CSUM : SMSC95XX_TX_OVERHEAD;
  1604. u32 tx_cmd_a, tx_cmd_b;
  1605. void *ptr;
  1606. /* We do not advertise SG, so skbs should be already linearized */
  1607. BUG_ON(skb_shinfo(skb)->nr_frags);
  1608. /* Make writable and expand header space by overhead if required */
  1609. if (skb_cow_head(skb, overhead)) {
  1610. /* Must deallocate here as returning NULL to indicate error
  1611. * means the skb won't be deallocated in the caller.
  1612. */
  1613. dev_kfree_skb_any(skb);
  1614. return NULL;
  1615. }
  1616. tx_cmd_b = (u32)skb->len;
  1617. tx_cmd_a = tx_cmd_b | TX_CMD_A_FIRST_SEG_ | TX_CMD_A_LAST_SEG_;
  1618. if (csum) {
  1619. if (!smsc95xx_can_tx_checksum(skb)) {
  1620. /* workaround - hardware tx checksum does not work
  1621. * properly with extremely small packets */
  1622. long csstart = skb_checksum_start_offset(skb);
  1623. __wsum calc = csum_partial(skb->data + csstart,
  1624. skb->len - csstart, 0);
  1625. *((__sum16 *)(skb->data + csstart
  1626. + skb->csum_offset)) = csum_fold(calc);
  1627. csum = false;
  1628. } else {
  1629. u32 csum_preamble = smsc95xx_calc_csum_preamble(skb);
  1630. ptr = skb_push(skb, 4);
  1631. put_unaligned_le32(csum_preamble, ptr);
  1632. tx_cmd_a += 4;
  1633. tx_cmd_b += 4;
  1634. tx_cmd_b |= TX_CMD_B_CSUM_ENABLE;
  1635. }
  1636. }
  1637. ptr = skb_push(skb, 8);
  1638. put_unaligned_le32(tx_cmd_a, ptr);
  1639. put_unaligned_le32(tx_cmd_b, ptr+4);
  1640. return skb;
  1641. }
  1642. static int smsc95xx_manage_power(struct usbnet *dev, int on)
  1643. {
  1644. struct smsc95xx_priv *pdata = dev->driver_priv;
  1645. dev->intf->needs_remote_wakeup = on;
  1646. if (pdata->features & FEATURE_REMOTE_WAKEUP)
  1647. return 0;
  1648. /* this chip revision isn't capable of remote wakeup */
  1649. netdev_info(dev->net, "hardware isn't capable of remote wakeup\n");
  1650. if (on)
  1651. usb_autopm_get_interface_no_resume(dev->intf);
  1652. else
  1653. usb_autopm_put_interface(dev->intf);
  1654. return 0;
  1655. }
  1656. static const struct driver_info smsc95xx_info = {
  1657. .description = "smsc95xx USB 2.0 Ethernet",
  1658. .bind = smsc95xx_bind,
  1659. .unbind = smsc95xx_unbind,
  1660. .reset = smsc95xx_reset,
  1661. .check_connect = smsc95xx_start_phy,
  1662. .stop = smsc95xx_stop,
  1663. .rx_fixup = smsc95xx_rx_fixup,
  1664. .tx_fixup = smsc95xx_tx_fixup,
  1665. .status = smsc95xx_status,
  1666. .manage_power = smsc95xx_manage_power,
  1667. .flags = FLAG_ETHER | FLAG_SEND_ZLP | FLAG_LINK_INTR,
  1668. };
  1669. static const struct usb_device_id products[] = {
  1670. {
  1671. /* SMSC9500 USB Ethernet Device */
  1672. USB_DEVICE(0x0424, 0x9500),
  1673. .driver_info = (unsigned long) &smsc95xx_info,
  1674. },
  1675. {
  1676. /* SMSC9505 USB Ethernet Device */
  1677. USB_DEVICE(0x0424, 0x9505),
  1678. .driver_info = (unsigned long) &smsc95xx_info,
  1679. },
  1680. {
  1681. /* SMSC9500A USB Ethernet Device */
  1682. USB_DEVICE(0x0424, 0x9E00),
  1683. .driver_info = (unsigned long) &smsc95xx_info,
  1684. },
  1685. {
  1686. /* SMSC9505A USB Ethernet Device */
  1687. USB_DEVICE(0x0424, 0x9E01),
  1688. .driver_info = (unsigned long) &smsc95xx_info,
  1689. },
  1690. {
  1691. /* SMSC9512/9514 USB Hub & Ethernet Device */
  1692. USB_DEVICE(0x0424, 0xec00),
  1693. .driver_info = (unsigned long) &smsc95xx_info,
  1694. },
  1695. {
  1696. /* SMSC9500 USB Ethernet Device (SAL10) */
  1697. USB_DEVICE(0x0424, 0x9900),
  1698. .driver_info = (unsigned long) &smsc95xx_info,
  1699. },
  1700. {
  1701. /* SMSC9505 USB Ethernet Device (SAL10) */
  1702. USB_DEVICE(0x0424, 0x9901),
  1703. .driver_info = (unsigned long) &smsc95xx_info,
  1704. },
  1705. {
  1706. /* SMSC9500A USB Ethernet Device (SAL10) */
  1707. USB_DEVICE(0x0424, 0x9902),
  1708. .driver_info = (unsigned long) &smsc95xx_info,
  1709. },
  1710. {
  1711. /* SMSC9505A USB Ethernet Device (SAL10) */
  1712. USB_DEVICE(0x0424, 0x9903),
  1713. .driver_info = (unsigned long) &smsc95xx_info,
  1714. },
  1715. {
  1716. /* SMSC9512/9514 USB Hub & Ethernet Device (SAL10) */
  1717. USB_DEVICE(0x0424, 0x9904),
  1718. .driver_info = (unsigned long) &smsc95xx_info,
  1719. },
  1720. {
  1721. /* SMSC9500A USB Ethernet Device (HAL) */
  1722. USB_DEVICE(0x0424, 0x9905),
  1723. .driver_info = (unsigned long) &smsc95xx_info,
  1724. },
  1725. {
  1726. /* SMSC9505A USB Ethernet Device (HAL) */
  1727. USB_DEVICE(0x0424, 0x9906),
  1728. .driver_info = (unsigned long) &smsc95xx_info,
  1729. },
  1730. {
  1731. /* SMSC9500 USB Ethernet Device (Alternate ID) */
  1732. USB_DEVICE(0x0424, 0x9907),
  1733. .driver_info = (unsigned long) &smsc95xx_info,
  1734. },
  1735. {
  1736. /* SMSC9500A USB Ethernet Device (Alternate ID) */
  1737. USB_DEVICE(0x0424, 0x9908),
  1738. .driver_info = (unsigned long) &smsc95xx_info,
  1739. },
  1740. {
  1741. /* SMSC9512/9514 USB Hub & Ethernet Device (Alternate ID) */
  1742. USB_DEVICE(0x0424, 0x9909),
  1743. .driver_info = (unsigned long) &smsc95xx_info,
  1744. },
  1745. {
  1746. /* SMSC LAN9530 USB Ethernet Device */
  1747. USB_DEVICE(0x0424, 0x9530),
  1748. .driver_info = (unsigned long) &smsc95xx_info,
  1749. },
  1750. {
  1751. /* SMSC LAN9730 USB Ethernet Device */
  1752. USB_DEVICE(0x0424, 0x9730),
  1753. .driver_info = (unsigned long) &smsc95xx_info,
  1754. },
  1755. {
  1756. /* SMSC LAN89530 USB Ethernet Device */
  1757. USB_DEVICE(0x0424, 0x9E08),
  1758. .driver_info = (unsigned long) &smsc95xx_info,
  1759. },
  1760. {
  1761. /* SYSTEC USB-SPEmodule1 10BASE-T1L Ethernet Device */
  1762. USB_DEVICE(0x0878, 0x1400),
  1763. .driver_info = (unsigned long)&smsc95xx_info,
  1764. },
  1765. {
  1766. /* Microchip's EVB-LAN8670-USB 10BASE-T1S Ethernet Device */
  1767. USB_DEVICE(0x184F, 0x0051),
  1768. .driver_info = (unsigned long)&smsc95xx_info,
  1769. },
  1770. { }, /* END */
  1771. };
  1772. MODULE_DEVICE_TABLE(usb, products);
  1773. static struct usb_driver smsc95xx_driver = {
  1774. .name = "smsc95xx",
  1775. .id_table = products,
  1776. .probe = usbnet_probe,
  1777. .suspend = smsc95xx_suspend,
  1778. .resume = smsc95xx_resume,
  1779. .reset_resume = smsc95xx_reset_resume,
  1780. .disconnect = usbnet_disconnect,
  1781. .disable_hub_initiated_lpm = 1,
  1782. .supports_autosuspend = 1,
  1783. };
  1784. module_usb_driver(smsc95xx_driver);
  1785. MODULE_AUTHOR("Nancy Lin");
  1786. MODULE_AUTHOR("Steve Glendinning <steve.glendinning@shawell.net>");
  1787. MODULE_DESCRIPTION("SMSC95XX USB 2.0 Ethernet Devices");
  1788. MODULE_LICENSE("GPL");