usbnet.c 55 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097
  1. /*
  2. * USB Network driver infrastructure
  3. * Copyright (C) 2000-2005 by David Brownell
  4. * Copyright (C) 2003-2005 David Hollis <dhollis@davehollis.com>
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation; either version 2 of the License, or
  9. * (at your option) any later version.
  10. *
  11. * This program is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with this program; if not, see <http://www.gnu.org/licenses/>.
  18. */
  19. /*
  20. * This is a generic "USB networking" framework that works with several
  21. * kinds of full and high speed networking devices: host-to-host cables,
  22. * smart usb peripherals, and actual Ethernet adapters.
  23. *
  24. * These devices usually differ in terms of control protocols (if they
  25. * even have one!) and sometimes they define new framing to wrap or batch
  26. * Ethernet packets. Otherwise, they talk to USB pretty much the same,
  27. * so interface (un)binding, endpoint I/O queues, fault handling, and other
  28. * issues can usefully be addressed by this framework.
  29. */
  30. // #define DEBUG // error path messages, extra info
  31. // #define VERBOSE // more; success messages
  32. #include <linux/module.h>
  33. #include <linux/init.h>
  34. #include <linux/netdevice.h>
  35. #include <linux/etherdevice.h>
  36. #include <linux/ctype.h>
  37. #include <linux/ethtool.h>
  38. #include <linux/workqueue.h>
  39. #include <linux/mii.h>
  40. #include <linux/usb.h>
  41. #include <linux/usb/usbnet.h>
  42. #include <linux/slab.h>
  43. #include <linux/kernel.h>
  44. #include <linux/pm_runtime.h>
  45. #define DRIVER_VERSION "22-Aug-2005"
  46. /*-------------------------------------------------------------------------*/
  47. /*
  48. * Nineteen USB 1.1 max size bulk transactions per frame (ms), max.
  49. * Several dozen bytes of IPv4 data can fit in two such transactions.
  50. * One maximum size Ethernet packet takes twenty four of them.
  51. * For high speed, each frame comfortably fits almost 36 max size
  52. * Ethernet packets (so queues should be bigger).
  53. *
  54. * The goal is to let the USB host controller be busy for 5msec or
  55. * more before an irq is required, under load. Jumbograms change
  56. * the equation.
  57. */
  58. #define MAX_QUEUE_MEMORY (60 * 1518)
  59. #define RX_QLEN(dev) ((dev)->rx_qlen)
  60. #define TX_QLEN(dev) ((dev)->tx_qlen)
  61. // reawaken network queue this soon after stopping; else watchdog barks
  62. #define TX_TIMEOUT_JIFFIES (5*HZ)
  63. /* throttle rx/tx briefly after some faults, so hub_wq might disconnect()
  64. * us (it polls at HZ/4 usually) before we report too many false errors.
  65. */
  66. #define THROTTLE_JIFFIES (HZ/8)
  67. // between wakeups
  68. #define UNLINK_TIMEOUT_MS 3
  69. /*-------------------------------------------------------------------------*/
  70. // randomly generated ethernet address
  71. static u8 node_id [ETH_ALEN];
  72. static const char driver_name [] = "usbnet";
  73. /* use ethtool to change the level for any given device */
  74. static int msg_level = -1;
  75. module_param (msg_level, int, 0);
  76. MODULE_PARM_DESC (msg_level, "Override default message level");
  77. /*-------------------------------------------------------------------------*/
  78. /* handles CDC Ethernet and many other network "bulk data" interfaces */
  79. int usbnet_get_endpoints(struct usbnet *dev, struct usb_interface *intf)
  80. {
  81. int tmp;
  82. struct usb_host_interface *alt = NULL;
  83. struct usb_host_endpoint *in = NULL, *out = NULL;
  84. struct usb_host_endpoint *status = NULL;
  85. for (tmp = 0; tmp < intf->num_altsetting; tmp++) {
  86. unsigned ep;
  87. in = out = status = NULL;
  88. alt = intf->altsetting + tmp;
  89. /* take the first altsetting with in-bulk + out-bulk;
  90. * remember any status endpoint, just in case;
  91. * ignore other endpoints and altsettings.
  92. */
  93. for (ep = 0; ep < alt->desc.bNumEndpoints; ep++) {
  94. struct usb_host_endpoint *e;
  95. int intr = 0;
  96. e = alt->endpoint + ep;
  97. switch (e->desc.bmAttributes) {
  98. case USB_ENDPOINT_XFER_INT:
  99. if (!usb_endpoint_dir_in(&e->desc))
  100. continue;
  101. intr = 1;
  102. /* FALLTHROUGH */
  103. case USB_ENDPOINT_XFER_BULK:
  104. break;
  105. default:
  106. continue;
  107. }
  108. if (usb_endpoint_dir_in(&e->desc)) {
  109. if (!intr && !in)
  110. in = e;
  111. else if (intr && !status)
  112. status = e;
  113. } else {
  114. if (!out)
  115. out = e;
  116. }
  117. }
  118. if (in && out)
  119. break;
  120. }
  121. if (!alt || !in || !out)
  122. return -EINVAL;
  123. if (alt->desc.bAlternateSetting != 0 ||
  124. !(dev->driver_info->flags & FLAG_NO_SETINT)) {
  125. tmp = usb_set_interface (dev->udev, alt->desc.bInterfaceNumber,
  126. alt->desc.bAlternateSetting);
  127. if (tmp < 0)
  128. return tmp;
  129. }
  130. dev->in = usb_rcvbulkpipe (dev->udev,
  131. in->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK);
  132. dev->out = usb_sndbulkpipe (dev->udev,
  133. out->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK);
  134. dev->status = status;
  135. return 0;
  136. }
  137. EXPORT_SYMBOL_GPL(usbnet_get_endpoints);
  138. int usbnet_get_ethernet_addr(struct usbnet *dev, int iMACAddress)
  139. {
  140. int tmp = -1, ret;
  141. unsigned char buf [13];
  142. ret = usb_string(dev->udev, iMACAddress, buf, sizeof buf);
  143. if (ret == 12)
  144. tmp = hex2bin(dev->net->dev_addr, buf, 6);
  145. if (tmp < 0) {
  146. dev_dbg(&dev->udev->dev,
  147. "bad MAC string %d fetch, %d\n", iMACAddress, tmp);
  148. if (ret >= 0)
  149. ret = -EINVAL;
  150. return ret;
  151. }
  152. return 0;
  153. }
  154. EXPORT_SYMBOL_GPL(usbnet_get_ethernet_addr);
  155. static void intr_complete (struct urb *urb)
  156. {
  157. struct usbnet *dev = urb->context;
  158. int status = urb->status;
  159. switch (status) {
  160. /* success */
  161. case 0:
  162. dev->driver_info->status(dev, urb);
  163. break;
  164. /* software-driven interface shutdown */
  165. case -ENOENT: /* urb killed */
  166. case -ESHUTDOWN: /* hardware gone */
  167. netif_dbg(dev, ifdown, dev->net,
  168. "intr shutdown, code %d\n", status);
  169. return;
  170. /* NOTE: not throttling like RX/TX, since this endpoint
  171. * already polls infrequently
  172. */
  173. default:
  174. netdev_dbg(dev->net, "intr status %d\n", status);
  175. break;
  176. }
  177. status = usb_submit_urb (urb, GFP_ATOMIC);
  178. if (status != 0)
  179. netif_err(dev, timer, dev->net,
  180. "intr resubmit --> %d\n", status);
  181. }
  182. static int init_status (struct usbnet *dev, struct usb_interface *intf)
  183. {
  184. char *buf = NULL;
  185. unsigned pipe = 0;
  186. unsigned maxp;
  187. unsigned period;
  188. if (!dev->driver_info->status)
  189. return 0;
  190. pipe = usb_rcvintpipe (dev->udev,
  191. dev->status->desc.bEndpointAddress
  192. & USB_ENDPOINT_NUMBER_MASK);
  193. maxp = usb_maxpacket (dev->udev, pipe, 0);
  194. /* avoid 1 msec chatter: min 8 msec poll rate */
  195. period = max ((int) dev->status->desc.bInterval,
  196. (dev->udev->speed == USB_SPEED_HIGH) ? 7 : 3);
  197. buf = kmalloc (maxp, GFP_KERNEL);
  198. if (buf) {
  199. dev->interrupt = usb_alloc_urb (0, GFP_KERNEL);
  200. if (!dev->interrupt) {
  201. kfree (buf);
  202. return -ENOMEM;
  203. } else {
  204. usb_fill_int_urb(dev->interrupt, dev->udev, pipe,
  205. buf, maxp, intr_complete, dev, period);
  206. dev->interrupt->transfer_flags |= URB_FREE_BUFFER;
  207. dev_dbg(&intf->dev,
  208. "status ep%din, %d bytes period %d\n",
  209. usb_pipeendpoint(pipe), maxp, period);
  210. }
  211. }
  212. return 0;
  213. }
  214. /* Submit the interrupt URB if not previously submitted, increasing refcount */
  215. int usbnet_status_start(struct usbnet *dev, gfp_t mem_flags)
  216. {
  217. int ret = 0;
  218. WARN_ON_ONCE(dev->interrupt == NULL);
  219. if (dev->interrupt) {
  220. mutex_lock(&dev->interrupt_mutex);
  221. if (++dev->interrupt_count == 1)
  222. ret = usb_submit_urb(dev->interrupt, mem_flags);
  223. dev_dbg(&dev->udev->dev, "incremented interrupt URB count to %d\n",
  224. dev->interrupt_count);
  225. mutex_unlock(&dev->interrupt_mutex);
  226. }
  227. return ret;
  228. }
  229. EXPORT_SYMBOL_GPL(usbnet_status_start);
  230. /* For resume; submit interrupt URB if previously submitted */
  231. static int __usbnet_status_start_force(struct usbnet *dev, gfp_t mem_flags)
  232. {
  233. int ret = 0;
  234. mutex_lock(&dev->interrupt_mutex);
  235. if (dev->interrupt_count) {
  236. ret = usb_submit_urb(dev->interrupt, mem_flags);
  237. dev_dbg(&dev->udev->dev,
  238. "submitted interrupt URB for resume\n");
  239. }
  240. mutex_unlock(&dev->interrupt_mutex);
  241. return ret;
  242. }
  243. /* Kill the interrupt URB if all submitters want it killed */
  244. void usbnet_status_stop(struct usbnet *dev)
  245. {
  246. if (dev->interrupt) {
  247. mutex_lock(&dev->interrupt_mutex);
  248. WARN_ON(dev->interrupt_count == 0);
  249. if (dev->interrupt_count && --dev->interrupt_count == 0)
  250. usb_kill_urb(dev->interrupt);
  251. dev_dbg(&dev->udev->dev,
  252. "decremented interrupt URB count to %d\n",
  253. dev->interrupt_count);
  254. mutex_unlock(&dev->interrupt_mutex);
  255. }
  256. }
  257. EXPORT_SYMBOL_GPL(usbnet_status_stop);
  258. /* For suspend; always kill interrupt URB */
  259. static void __usbnet_status_stop_force(struct usbnet *dev)
  260. {
  261. if (dev->interrupt) {
  262. mutex_lock(&dev->interrupt_mutex);
  263. usb_kill_urb(dev->interrupt);
  264. dev_dbg(&dev->udev->dev, "killed interrupt URB for suspend\n");
  265. mutex_unlock(&dev->interrupt_mutex);
  266. }
  267. }
  268. /* Passes this packet up the stack, updating its accounting.
  269. * Some link protocols batch packets, so their rx_fixup paths
  270. * can return clones as well as just modify the original skb.
  271. */
  272. void usbnet_skb_return (struct usbnet *dev, struct sk_buff *skb)
  273. {
  274. int status;
  275. if (test_bit(EVENT_RX_PAUSED, &dev->flags)) {
  276. skb_queue_tail(&dev->rxq_pause, skb);
  277. return;
  278. }
  279. skb->protocol = eth_type_trans (skb, dev->net);
  280. dev->net->stats.rx_packets++;
  281. dev->net->stats.rx_bytes += skb->len;
  282. netif_dbg(dev, rx_status, dev->net, "< rx, len %zu, type 0x%x\n",
  283. skb->len + sizeof (struct ethhdr), skb->protocol);
  284. memset (skb->cb, 0, sizeof (struct skb_data));
  285. if (skb_defer_rx_timestamp(skb))
  286. return;
  287. status = netif_rx (skb);
  288. if (status != NET_RX_SUCCESS)
  289. netif_dbg(dev, rx_err, dev->net,
  290. "netif_rx status %d\n", status);
  291. }
  292. EXPORT_SYMBOL_GPL(usbnet_skb_return);
  293. /* must be called if hard_mtu or rx_urb_size changed */
  294. void usbnet_update_max_qlen(struct usbnet *dev)
  295. {
  296. enum usb_device_speed speed = dev->udev->speed;
  297. switch (speed) {
  298. case USB_SPEED_HIGH:
  299. dev->rx_qlen = MAX_QUEUE_MEMORY / dev->rx_urb_size;
  300. dev->tx_qlen = MAX_QUEUE_MEMORY / dev->hard_mtu;
  301. break;
  302. case USB_SPEED_SUPER:
  303. /*
  304. * Not take default 5ms qlen for super speed HC to
  305. * save memory, and iperf tests show 2.5ms qlen can
  306. * work well
  307. */
  308. dev->rx_qlen = 5 * MAX_QUEUE_MEMORY / dev->rx_urb_size;
  309. dev->tx_qlen = 5 * MAX_QUEUE_MEMORY / dev->hard_mtu;
  310. break;
  311. default:
  312. dev->rx_qlen = dev->tx_qlen = 4;
  313. }
  314. }
  315. EXPORT_SYMBOL_GPL(usbnet_update_max_qlen);
  316. /*-------------------------------------------------------------------------
  317. *
  318. * Network Device Driver (peer link to "Host Device", from USB host)
  319. *
  320. *-------------------------------------------------------------------------*/
  321. int usbnet_change_mtu (struct net_device *net, int new_mtu)
  322. {
  323. struct usbnet *dev = netdev_priv(net);
  324. int ll_mtu = new_mtu + net->hard_header_len;
  325. int old_hard_mtu = dev->hard_mtu;
  326. int old_rx_urb_size = dev->rx_urb_size;
  327. if (new_mtu <= 0)
  328. return -EINVAL;
  329. // no second zero-length packet read wanted after mtu-sized packets
  330. if ((ll_mtu % dev->maxpacket) == 0)
  331. return -EDOM;
  332. net->mtu = new_mtu;
  333. dev->hard_mtu = net->mtu + net->hard_header_len;
  334. if (dev->rx_urb_size == old_hard_mtu) {
  335. dev->rx_urb_size = dev->hard_mtu;
  336. if (dev->rx_urb_size > old_rx_urb_size)
  337. usbnet_unlink_rx_urbs(dev);
  338. }
  339. /* max qlen depend on hard_mtu and rx_urb_size */
  340. usbnet_update_max_qlen(dev);
  341. return 0;
  342. }
  343. EXPORT_SYMBOL_GPL(usbnet_change_mtu);
  344. /* The caller must hold list->lock */
  345. static void __usbnet_queue_skb(struct sk_buff_head *list,
  346. struct sk_buff *newsk, enum skb_state state)
  347. {
  348. struct skb_data *entry = (struct skb_data *) newsk->cb;
  349. __skb_queue_tail(list, newsk);
  350. entry->state = state;
  351. }
  352. /*-------------------------------------------------------------------------*/
  353. /* some LK 2.4 HCDs oopsed if we freed or resubmitted urbs from
  354. * completion callbacks. 2.5 should have fixed those bugs...
  355. */
  356. static enum skb_state defer_bh(struct usbnet *dev, struct sk_buff *skb,
  357. struct sk_buff_head *list, enum skb_state state)
  358. {
  359. unsigned long flags;
  360. enum skb_state old_state;
  361. struct skb_data *entry = (struct skb_data *) skb->cb;
  362. spin_lock_irqsave(&list->lock, flags);
  363. old_state = entry->state;
  364. entry->state = state;
  365. __skb_unlink(skb, list);
  366. spin_unlock(&list->lock);
  367. spin_lock(&dev->done.lock);
  368. __skb_queue_tail(&dev->done, skb);
  369. if (dev->done.qlen == 1)
  370. tasklet_schedule(&dev->bh);
  371. spin_unlock_irqrestore(&dev->done.lock, flags);
  372. return old_state;
  373. }
  374. /* some work can't be done in tasklets, so we use keventd
  375. *
  376. * NOTE: annoying asymmetry: if it's active, schedule_work() fails,
  377. * but tasklet_schedule() doesn't. hope the failure is rare.
  378. */
  379. void usbnet_defer_kevent (struct usbnet *dev, int work)
  380. {
  381. set_bit (work, &dev->flags);
  382. if (!schedule_work (&dev->kevent)) {
  383. if (net_ratelimit())
  384. netdev_err(dev->net, "kevent %d may have been dropped\n", work);
  385. } else {
  386. netdev_dbg(dev->net, "kevent %d scheduled\n", work);
  387. }
  388. }
  389. EXPORT_SYMBOL_GPL(usbnet_defer_kevent);
  390. /*-------------------------------------------------------------------------*/
  391. static void rx_complete (struct urb *urb);
  392. static int rx_submit (struct usbnet *dev, struct urb *urb, gfp_t flags)
  393. {
  394. struct sk_buff *skb;
  395. struct skb_data *entry;
  396. int retval = 0;
  397. unsigned long lockflags;
  398. size_t size = dev->rx_urb_size;
  399. /* prevent rx skb allocation when error ratio is high */
  400. if (test_bit(EVENT_RX_KILL, &dev->flags)) {
  401. usb_free_urb(urb);
  402. return -ENOLINK;
  403. }
  404. skb = __netdev_alloc_skb_ip_align(dev->net, size, flags);
  405. if (!skb) {
  406. netif_dbg(dev, rx_err, dev->net, "no rx skb\n");
  407. usbnet_defer_kevent (dev, EVENT_RX_MEMORY);
  408. usb_free_urb (urb);
  409. return -ENOMEM;
  410. }
  411. entry = (struct skb_data *) skb->cb;
  412. entry->urb = urb;
  413. entry->dev = dev;
  414. entry->length = 0;
  415. usb_fill_bulk_urb (urb, dev->udev, dev->in,
  416. skb->data, size, rx_complete, skb);
  417. spin_lock_irqsave (&dev->rxq.lock, lockflags);
  418. if (netif_running (dev->net) &&
  419. netif_device_present (dev->net) &&
  420. !test_bit (EVENT_RX_HALT, &dev->flags) &&
  421. !test_bit (EVENT_DEV_ASLEEP, &dev->flags)) {
  422. switch (retval = usb_submit_urb (urb, GFP_ATOMIC)) {
  423. case -EPIPE:
  424. usbnet_defer_kevent (dev, EVENT_RX_HALT);
  425. break;
  426. case -ENOMEM:
  427. usbnet_defer_kevent (dev, EVENT_RX_MEMORY);
  428. break;
  429. case -ENODEV:
  430. netif_dbg(dev, ifdown, dev->net, "device gone\n");
  431. netif_device_detach (dev->net);
  432. break;
  433. case -EHOSTUNREACH:
  434. retval = -ENOLINK;
  435. break;
  436. default:
  437. netif_dbg(dev, rx_err, dev->net,
  438. "rx submit, %d\n", retval);
  439. tasklet_schedule (&dev->bh);
  440. break;
  441. case 0:
  442. __usbnet_queue_skb(&dev->rxq, skb, rx_start);
  443. }
  444. } else {
  445. netif_dbg(dev, ifdown, dev->net, "rx: stopped\n");
  446. retval = -ENOLINK;
  447. }
  448. spin_unlock_irqrestore (&dev->rxq.lock, lockflags);
  449. if (retval) {
  450. dev_kfree_skb_any (skb);
  451. usb_free_urb (urb);
  452. }
  453. return retval;
  454. }
  455. /*-------------------------------------------------------------------------*/
  456. static inline void rx_process (struct usbnet *dev, struct sk_buff *skb)
  457. {
  458. if (dev->driver_info->rx_fixup &&
  459. !dev->driver_info->rx_fixup (dev, skb)) {
  460. /* With RX_ASSEMBLE, rx_fixup() must update counters */
  461. if (!(dev->driver_info->flags & FLAG_RX_ASSEMBLE))
  462. dev->net->stats.rx_errors++;
  463. goto done;
  464. }
  465. // else network stack removes extra byte if we forced a short packet
  466. /* all data was already cloned from skb inside the driver */
  467. if (dev->driver_info->flags & FLAG_MULTI_PACKET)
  468. goto done;
  469. if (skb->len < ETH_HLEN) {
  470. dev->net->stats.rx_errors++;
  471. dev->net->stats.rx_length_errors++;
  472. netif_dbg(dev, rx_err, dev->net, "rx length %d\n", skb->len);
  473. } else {
  474. usbnet_skb_return(dev, skb);
  475. return;
  476. }
  477. done:
  478. skb_queue_tail(&dev->done, skb);
  479. }
  480. /*-------------------------------------------------------------------------*/
  481. static void rx_complete (struct urb *urb)
  482. {
  483. struct sk_buff *skb = (struct sk_buff *) urb->context;
  484. struct skb_data *entry = (struct skb_data *) skb->cb;
  485. struct usbnet *dev = entry->dev;
  486. int urb_status = urb->status;
  487. enum skb_state state;
  488. skb_put (skb, urb->actual_length);
  489. state = rx_done;
  490. entry->urb = NULL;
  491. switch (urb_status) {
  492. /* success */
  493. case 0:
  494. break;
  495. /* stalls need manual reset. this is rare ... except that
  496. * when going through USB 2.0 TTs, unplug appears this way.
  497. * we avoid the highspeed version of the ETIMEDOUT/EILSEQ
  498. * storm, recovering as needed.
  499. */
  500. case -EPIPE:
  501. dev->net->stats.rx_errors++;
  502. usbnet_defer_kevent (dev, EVENT_RX_HALT);
  503. // FALLTHROUGH
  504. /* software-driven interface shutdown */
  505. case -ECONNRESET: /* async unlink */
  506. case -ESHUTDOWN: /* hardware gone */
  507. netif_dbg(dev, ifdown, dev->net,
  508. "rx shutdown, code %d\n", urb_status);
  509. goto block;
  510. /* we get controller i/o faults during hub_wq disconnect() delays.
  511. * throttle down resubmits, to avoid log floods; just temporarily,
  512. * so we still recover when the fault isn't a hub_wq delay.
  513. */
  514. case -EPROTO:
  515. case -ETIME:
  516. case -EILSEQ:
  517. dev->net->stats.rx_errors++;
  518. if (!timer_pending (&dev->delay)) {
  519. mod_timer (&dev->delay, jiffies + THROTTLE_JIFFIES);
  520. netif_dbg(dev, link, dev->net,
  521. "rx throttle %d\n", urb_status);
  522. }
  523. block:
  524. state = rx_cleanup;
  525. entry->urb = urb;
  526. urb = NULL;
  527. break;
  528. /* data overrun ... flush fifo? */
  529. case -EOVERFLOW:
  530. dev->net->stats.rx_over_errors++;
  531. // FALLTHROUGH
  532. default:
  533. state = rx_cleanup;
  534. dev->net->stats.rx_errors++;
  535. netif_dbg(dev, rx_err, dev->net, "rx status %d\n", urb_status);
  536. break;
  537. }
  538. /* stop rx if packet error rate is high */
  539. if (++dev->pkt_cnt > 30) {
  540. dev->pkt_cnt = 0;
  541. dev->pkt_err = 0;
  542. } else {
  543. if (state == rx_cleanup)
  544. dev->pkt_err++;
  545. if (dev->pkt_err > 20)
  546. set_bit(EVENT_RX_KILL, &dev->flags);
  547. }
  548. state = defer_bh(dev, skb, &dev->rxq, state);
  549. if (urb) {
  550. if (netif_running (dev->net) &&
  551. !test_bit (EVENT_RX_HALT, &dev->flags) &&
  552. state != unlink_start) {
  553. rx_submit (dev, urb, GFP_ATOMIC);
  554. usb_mark_last_busy(dev->udev);
  555. return;
  556. }
  557. usb_free_urb (urb);
  558. }
  559. netif_dbg(dev, rx_err, dev->net, "no read resubmitted\n");
  560. }
  561. /*-------------------------------------------------------------------------*/
  562. void usbnet_pause_rx(struct usbnet *dev)
  563. {
  564. set_bit(EVENT_RX_PAUSED, &dev->flags);
  565. netif_dbg(dev, rx_status, dev->net, "paused rx queue enabled\n");
  566. }
  567. EXPORT_SYMBOL_GPL(usbnet_pause_rx);
  568. void usbnet_resume_rx(struct usbnet *dev)
  569. {
  570. struct sk_buff *skb;
  571. int num = 0;
  572. clear_bit(EVENT_RX_PAUSED, &dev->flags);
  573. while ((skb = skb_dequeue(&dev->rxq_pause)) != NULL) {
  574. usbnet_skb_return(dev, skb);
  575. num++;
  576. }
  577. tasklet_schedule(&dev->bh);
  578. netif_dbg(dev, rx_status, dev->net,
  579. "paused rx queue disabled, %d skbs requeued\n", num);
  580. }
  581. EXPORT_SYMBOL_GPL(usbnet_resume_rx);
  582. void usbnet_purge_paused_rxq(struct usbnet *dev)
  583. {
  584. skb_queue_purge(&dev->rxq_pause);
  585. }
  586. EXPORT_SYMBOL_GPL(usbnet_purge_paused_rxq);
  587. /*-------------------------------------------------------------------------*/
  588. // unlink pending rx/tx; completion handlers do all other cleanup
  589. static int unlink_urbs (struct usbnet *dev, struct sk_buff_head *q)
  590. {
  591. unsigned long flags;
  592. struct sk_buff *skb;
  593. int count = 0;
  594. spin_lock_irqsave (&q->lock, flags);
  595. while (!skb_queue_empty(q)) {
  596. struct skb_data *entry;
  597. struct urb *urb;
  598. int retval;
  599. skb_queue_walk(q, skb) {
  600. entry = (struct skb_data *) skb->cb;
  601. if (entry->state != unlink_start)
  602. goto found;
  603. }
  604. break;
  605. found:
  606. entry->state = unlink_start;
  607. urb = entry->urb;
  608. /*
  609. * Get reference count of the URB to avoid it to be
  610. * freed during usb_unlink_urb, which may trigger
  611. * use-after-free problem inside usb_unlink_urb since
  612. * usb_unlink_urb is always racing with .complete
  613. * handler(include defer_bh).
  614. */
  615. usb_get_urb(urb);
  616. spin_unlock_irqrestore(&q->lock, flags);
  617. // during some PM-driven resume scenarios,
  618. // these (async) unlinks complete immediately
  619. retval = usb_unlink_urb (urb);
  620. if (retval != -EINPROGRESS && retval != 0)
  621. netdev_dbg(dev->net, "unlink urb err, %d\n", retval);
  622. else
  623. count++;
  624. usb_put_urb(urb);
  625. spin_lock_irqsave(&q->lock, flags);
  626. }
  627. spin_unlock_irqrestore (&q->lock, flags);
  628. return count;
  629. }
  630. // Flush all pending rx urbs
  631. // minidrivers may need to do this when the MTU changes
  632. void usbnet_unlink_rx_urbs(struct usbnet *dev)
  633. {
  634. if (netif_running(dev->net)) {
  635. (void) unlink_urbs (dev, &dev->rxq);
  636. tasklet_schedule(&dev->bh);
  637. }
  638. }
  639. EXPORT_SYMBOL_GPL(usbnet_unlink_rx_urbs);
  640. /*-------------------------------------------------------------------------*/
  641. // precondition: never called in_interrupt
  642. static void usbnet_terminate_urbs(struct usbnet *dev)
  643. {
  644. DECLARE_WAITQUEUE(wait, current);
  645. int temp;
  646. /* ensure there are no more active urbs */
  647. add_wait_queue(&dev->wait, &wait);
  648. set_current_state(TASK_UNINTERRUPTIBLE);
  649. temp = unlink_urbs(dev, &dev->txq) +
  650. unlink_urbs(dev, &dev->rxq);
  651. /* maybe wait for deletions to finish. */
  652. while (!skb_queue_empty(&dev->rxq)
  653. && !skb_queue_empty(&dev->txq)
  654. && !skb_queue_empty(&dev->done)) {
  655. schedule_timeout(msecs_to_jiffies(UNLINK_TIMEOUT_MS));
  656. set_current_state(TASK_UNINTERRUPTIBLE);
  657. netif_dbg(dev, ifdown, dev->net,
  658. "waited for %d urb completions\n", temp);
  659. }
  660. set_current_state(TASK_RUNNING);
  661. remove_wait_queue(&dev->wait, &wait);
  662. }
  663. int usbnet_stop (struct net_device *net)
  664. {
  665. struct usbnet *dev = netdev_priv(net);
  666. struct driver_info *info = dev->driver_info;
  667. int retval, pm;
  668. clear_bit(EVENT_DEV_OPEN, &dev->flags);
  669. netif_stop_queue (net);
  670. netif_info(dev, ifdown, dev->net,
  671. "stop stats: rx/tx %lu/%lu, errs %lu/%lu\n",
  672. net->stats.rx_packets, net->stats.tx_packets,
  673. net->stats.rx_errors, net->stats.tx_errors);
  674. /* to not race resume */
  675. pm = usb_autopm_get_interface(dev->intf);
  676. /* allow minidriver to stop correctly (wireless devices to turn off
  677. * radio etc) */
  678. if (info->stop) {
  679. retval = info->stop(dev);
  680. if (retval < 0)
  681. netif_info(dev, ifdown, dev->net,
  682. "stop fail (%d) usbnet usb-%s-%s, %s\n",
  683. retval,
  684. dev->udev->bus->bus_name, dev->udev->devpath,
  685. info->description);
  686. }
  687. if (!(info->flags & FLAG_AVOID_UNLINK_URBS))
  688. usbnet_terminate_urbs(dev);
  689. usbnet_status_stop(dev);
  690. usbnet_purge_paused_rxq(dev);
  691. /* deferred work (task, timer, softirq) must also stop.
  692. * can't flush_scheduled_work() until we drop rtnl (later),
  693. * else workers could deadlock; so make workers a NOP.
  694. */
  695. dev->flags = 0;
  696. del_timer_sync (&dev->delay);
  697. tasklet_kill (&dev->bh);
  698. if (!pm)
  699. usb_autopm_put_interface(dev->intf);
  700. if (info->manage_power &&
  701. !test_and_clear_bit(EVENT_NO_RUNTIME_PM, &dev->flags))
  702. info->manage_power(dev, 0);
  703. else
  704. usb_autopm_put_interface(dev->intf);
  705. return 0;
  706. }
  707. EXPORT_SYMBOL_GPL(usbnet_stop);
  708. /*-------------------------------------------------------------------------*/
  709. // posts reads, and enables write queuing
  710. // precondition: never called in_interrupt
  711. int usbnet_open (struct net_device *net)
  712. {
  713. struct usbnet *dev = netdev_priv(net);
  714. int retval;
  715. struct driver_info *info = dev->driver_info;
  716. if ((retval = usb_autopm_get_interface(dev->intf)) < 0) {
  717. netif_info(dev, ifup, dev->net,
  718. "resumption fail (%d) usbnet usb-%s-%s, %s\n",
  719. retval,
  720. dev->udev->bus->bus_name,
  721. dev->udev->devpath,
  722. info->description);
  723. goto done_nopm;
  724. }
  725. // put into "known safe" state
  726. if (info->reset && (retval = info->reset (dev)) < 0) {
  727. netif_info(dev, ifup, dev->net,
  728. "open reset fail (%d) usbnet usb-%s-%s, %s\n",
  729. retval,
  730. dev->udev->bus->bus_name,
  731. dev->udev->devpath,
  732. info->description);
  733. goto done;
  734. }
  735. /* hard_mtu or rx_urb_size may change in reset() */
  736. usbnet_update_max_qlen(dev);
  737. // insist peer be connected
  738. if (info->check_connect && (retval = info->check_connect (dev)) < 0) {
  739. netif_dbg(dev, ifup, dev->net, "can't open; %d\n", retval);
  740. goto done;
  741. }
  742. /* start any status interrupt transfer */
  743. if (dev->interrupt) {
  744. retval = usbnet_status_start(dev, GFP_KERNEL);
  745. if (retval < 0) {
  746. netif_err(dev, ifup, dev->net,
  747. "intr submit %d\n", retval);
  748. goto done;
  749. }
  750. }
  751. set_bit(EVENT_DEV_OPEN, &dev->flags);
  752. netif_start_queue (net);
  753. netif_info(dev, ifup, dev->net,
  754. "open: enable queueing (rx %d, tx %d) mtu %d %s framing\n",
  755. (int)RX_QLEN(dev), (int)TX_QLEN(dev),
  756. dev->net->mtu,
  757. (dev->driver_info->flags & FLAG_FRAMING_NC) ? "NetChip" :
  758. (dev->driver_info->flags & FLAG_FRAMING_GL) ? "GeneSys" :
  759. (dev->driver_info->flags & FLAG_FRAMING_Z) ? "Zaurus" :
  760. (dev->driver_info->flags & FLAG_FRAMING_RN) ? "RNDIS" :
  761. (dev->driver_info->flags & FLAG_FRAMING_AX) ? "ASIX" :
  762. "simple");
  763. /* reset rx error state */
  764. dev->pkt_cnt = 0;
  765. dev->pkt_err = 0;
  766. clear_bit(EVENT_RX_KILL, &dev->flags);
  767. // delay posting reads until we're fully open
  768. tasklet_schedule (&dev->bh);
  769. if (info->manage_power) {
  770. retval = info->manage_power(dev, 1);
  771. if (retval < 0) {
  772. retval = 0;
  773. set_bit(EVENT_NO_RUNTIME_PM, &dev->flags);
  774. } else {
  775. usb_autopm_put_interface(dev->intf);
  776. }
  777. }
  778. return retval;
  779. done:
  780. usb_autopm_put_interface(dev->intf);
  781. done_nopm:
  782. return retval;
  783. }
  784. EXPORT_SYMBOL_GPL(usbnet_open);
  785. /*-------------------------------------------------------------------------*/
  786. /* ethtool methods; minidrivers may need to add some more, but
  787. * they'll probably want to use this base set.
  788. */
  789. int usbnet_get_settings (struct net_device *net, struct ethtool_cmd *cmd)
  790. {
  791. struct usbnet *dev = netdev_priv(net);
  792. if (!dev->mii.mdio_read)
  793. return -EOPNOTSUPP;
  794. return mii_ethtool_gset(&dev->mii, cmd);
  795. }
  796. EXPORT_SYMBOL_GPL(usbnet_get_settings);
  797. int usbnet_set_settings (struct net_device *net, struct ethtool_cmd *cmd)
  798. {
  799. struct usbnet *dev = netdev_priv(net);
  800. int retval;
  801. if (!dev->mii.mdio_write)
  802. return -EOPNOTSUPP;
  803. retval = mii_ethtool_sset(&dev->mii, cmd);
  804. /* link speed/duplex might have changed */
  805. if (dev->driver_info->link_reset)
  806. dev->driver_info->link_reset(dev);
  807. /* hard_mtu or rx_urb_size may change in link_reset() */
  808. usbnet_update_max_qlen(dev);
  809. return retval;
  810. }
  811. EXPORT_SYMBOL_GPL(usbnet_set_settings);
  812. u32 usbnet_get_link (struct net_device *net)
  813. {
  814. struct usbnet *dev = netdev_priv(net);
  815. /* If a check_connect is defined, return its result */
  816. if (dev->driver_info->check_connect)
  817. return dev->driver_info->check_connect (dev) == 0;
  818. /* if the device has mii operations, use those */
  819. if (dev->mii.mdio_read)
  820. return mii_link_ok(&dev->mii);
  821. /* Otherwise, dtrt for drivers calling netif_carrier_{on,off} */
  822. return ethtool_op_get_link(net);
  823. }
  824. EXPORT_SYMBOL_GPL(usbnet_get_link);
  825. int usbnet_nway_reset(struct net_device *net)
  826. {
  827. struct usbnet *dev = netdev_priv(net);
  828. if (!dev->mii.mdio_write)
  829. return -EOPNOTSUPP;
  830. return mii_nway_restart(&dev->mii);
  831. }
  832. EXPORT_SYMBOL_GPL(usbnet_nway_reset);
  833. void usbnet_get_drvinfo (struct net_device *net, struct ethtool_drvinfo *info)
  834. {
  835. struct usbnet *dev = netdev_priv(net);
  836. strlcpy (info->driver, dev->driver_name, sizeof info->driver);
  837. strlcpy (info->version, DRIVER_VERSION, sizeof info->version);
  838. strlcpy (info->fw_version, dev->driver_info->description,
  839. sizeof info->fw_version);
  840. usb_make_path (dev->udev, info->bus_info, sizeof info->bus_info);
  841. }
  842. EXPORT_SYMBOL_GPL(usbnet_get_drvinfo);
  843. u32 usbnet_get_msglevel (struct net_device *net)
  844. {
  845. struct usbnet *dev = netdev_priv(net);
  846. return dev->msg_enable;
  847. }
  848. EXPORT_SYMBOL_GPL(usbnet_get_msglevel);
  849. void usbnet_set_msglevel (struct net_device *net, u32 level)
  850. {
  851. struct usbnet *dev = netdev_priv(net);
  852. dev->msg_enable = level;
  853. }
  854. EXPORT_SYMBOL_GPL(usbnet_set_msglevel);
  855. /* drivers may override default ethtool_ops in their bind() routine */
  856. static const struct ethtool_ops usbnet_ethtool_ops = {
  857. .get_settings = usbnet_get_settings,
  858. .set_settings = usbnet_set_settings,
  859. .get_link = usbnet_get_link,
  860. .nway_reset = usbnet_nway_reset,
  861. .get_drvinfo = usbnet_get_drvinfo,
  862. .get_msglevel = usbnet_get_msglevel,
  863. .set_msglevel = usbnet_set_msglevel,
  864. .get_ts_info = ethtool_op_get_ts_info,
  865. };
  866. /*-------------------------------------------------------------------------*/
  867. static void __handle_link_change(struct usbnet *dev)
  868. {
  869. if (!test_bit(EVENT_DEV_OPEN, &dev->flags))
  870. return;
  871. if (!netif_carrier_ok(dev->net)) {
  872. /* kill URBs for reading packets to save bus bandwidth */
  873. unlink_urbs(dev, &dev->rxq);
  874. /*
  875. * tx_timeout will unlink URBs for sending packets and
  876. * tx queue is stopped by netcore after link becomes off
  877. */
  878. } else {
  879. /* submitting URBs for reading packets */
  880. tasklet_schedule(&dev->bh);
  881. }
  882. /* hard_mtu or rx_urb_size may change during link change */
  883. usbnet_update_max_qlen(dev);
  884. clear_bit(EVENT_LINK_CHANGE, &dev->flags);
  885. }
  886. static void usbnet_set_rx_mode(struct net_device *net)
  887. {
  888. struct usbnet *dev = netdev_priv(net);
  889. usbnet_defer_kevent(dev, EVENT_SET_RX_MODE);
  890. }
  891. static void __handle_set_rx_mode(struct usbnet *dev)
  892. {
  893. if (dev->driver_info->set_rx_mode)
  894. (dev->driver_info->set_rx_mode)(dev);
  895. clear_bit(EVENT_SET_RX_MODE, &dev->flags);
  896. }
  897. /* work that cannot be done in interrupt context uses keventd.
  898. *
  899. * NOTE: with 2.5 we could do more of this using completion callbacks,
  900. * especially now that control transfers can be queued.
  901. */
  902. static void
  903. kevent (struct work_struct *work)
  904. {
  905. struct usbnet *dev =
  906. container_of(work, struct usbnet, kevent);
  907. int status;
  908. /* usb_clear_halt() needs a thread context */
  909. if (test_bit (EVENT_TX_HALT, &dev->flags)) {
  910. unlink_urbs (dev, &dev->txq);
  911. status = usb_autopm_get_interface(dev->intf);
  912. if (status < 0)
  913. goto fail_pipe;
  914. status = usb_clear_halt (dev->udev, dev->out);
  915. usb_autopm_put_interface(dev->intf);
  916. if (status < 0 &&
  917. status != -EPIPE &&
  918. status != -ESHUTDOWN) {
  919. if (netif_msg_tx_err (dev))
  920. fail_pipe:
  921. netdev_err(dev->net, "can't clear tx halt, status %d\n",
  922. status);
  923. } else {
  924. clear_bit (EVENT_TX_HALT, &dev->flags);
  925. if (status != -ESHUTDOWN)
  926. netif_wake_queue (dev->net);
  927. }
  928. }
  929. if (test_bit (EVENT_RX_HALT, &dev->flags)) {
  930. unlink_urbs (dev, &dev->rxq);
  931. status = usb_autopm_get_interface(dev->intf);
  932. if (status < 0)
  933. goto fail_halt;
  934. status = usb_clear_halt (dev->udev, dev->in);
  935. usb_autopm_put_interface(dev->intf);
  936. if (status < 0 &&
  937. status != -EPIPE &&
  938. status != -ESHUTDOWN) {
  939. if (netif_msg_rx_err (dev))
  940. fail_halt:
  941. netdev_err(dev->net, "can't clear rx halt, status %d\n",
  942. status);
  943. } else {
  944. clear_bit (EVENT_RX_HALT, &dev->flags);
  945. tasklet_schedule (&dev->bh);
  946. }
  947. }
  948. /* tasklet could resubmit itself forever if memory is tight */
  949. if (test_bit (EVENT_RX_MEMORY, &dev->flags)) {
  950. struct urb *urb = NULL;
  951. int resched = 1;
  952. if (netif_running (dev->net))
  953. urb = usb_alloc_urb (0, GFP_KERNEL);
  954. else
  955. clear_bit (EVENT_RX_MEMORY, &dev->flags);
  956. if (urb != NULL) {
  957. clear_bit (EVENT_RX_MEMORY, &dev->flags);
  958. status = usb_autopm_get_interface(dev->intf);
  959. if (status < 0) {
  960. usb_free_urb(urb);
  961. goto fail_lowmem;
  962. }
  963. if (rx_submit (dev, urb, GFP_KERNEL) == -ENOLINK)
  964. resched = 0;
  965. usb_autopm_put_interface(dev->intf);
  966. fail_lowmem:
  967. if (resched)
  968. tasklet_schedule (&dev->bh);
  969. }
  970. }
  971. if (test_bit (EVENT_LINK_RESET, &dev->flags)) {
  972. struct driver_info *info = dev->driver_info;
  973. int retval = 0;
  974. clear_bit (EVENT_LINK_RESET, &dev->flags);
  975. status = usb_autopm_get_interface(dev->intf);
  976. if (status < 0)
  977. goto skip_reset;
  978. if(info->link_reset && (retval = info->link_reset(dev)) < 0) {
  979. usb_autopm_put_interface(dev->intf);
  980. skip_reset:
  981. netdev_info(dev->net, "link reset failed (%d) usbnet usb-%s-%s, %s\n",
  982. retval,
  983. dev->udev->bus->bus_name,
  984. dev->udev->devpath,
  985. info->description);
  986. } else {
  987. usb_autopm_put_interface(dev->intf);
  988. }
  989. /* handle link change from link resetting */
  990. __handle_link_change(dev);
  991. }
  992. if (test_bit (EVENT_LINK_CHANGE, &dev->flags))
  993. __handle_link_change(dev);
  994. if (test_bit (EVENT_SET_RX_MODE, &dev->flags))
  995. __handle_set_rx_mode(dev);
  996. if (dev->flags)
  997. netdev_dbg(dev->net, "kevent done, flags = 0x%lx\n", dev->flags);
  998. }
  999. /*-------------------------------------------------------------------------*/
  1000. static void tx_complete (struct urb *urb)
  1001. {
  1002. struct sk_buff *skb = (struct sk_buff *) urb->context;
  1003. struct skb_data *entry = (struct skb_data *) skb->cb;
  1004. struct usbnet *dev = entry->dev;
  1005. if (urb->status == 0) {
  1006. dev->net->stats.tx_packets += entry->packets;
  1007. dev->net->stats.tx_bytes += entry->length;
  1008. } else {
  1009. dev->net->stats.tx_errors++;
  1010. switch (urb->status) {
  1011. case -EPIPE:
  1012. usbnet_defer_kevent (dev, EVENT_TX_HALT);
  1013. break;
  1014. /* software-driven interface shutdown */
  1015. case -ECONNRESET: // async unlink
  1016. case -ESHUTDOWN: // hardware gone
  1017. break;
  1018. /* like rx, tx gets controller i/o faults during hub_wq
  1019. * delays and so it uses the same throttling mechanism.
  1020. */
  1021. case -EPROTO:
  1022. case -ETIME:
  1023. case -EILSEQ:
  1024. usb_mark_last_busy(dev->udev);
  1025. if (!timer_pending (&dev->delay)) {
  1026. mod_timer (&dev->delay,
  1027. jiffies + THROTTLE_JIFFIES);
  1028. netif_dbg(dev, link, dev->net,
  1029. "tx throttle %d\n", urb->status);
  1030. }
  1031. netif_stop_queue (dev->net);
  1032. break;
  1033. default:
  1034. netif_dbg(dev, tx_err, dev->net,
  1035. "tx err %d\n", entry->urb->status);
  1036. break;
  1037. }
  1038. }
  1039. usb_autopm_put_interface_async(dev->intf);
  1040. (void) defer_bh(dev, skb, &dev->txq, tx_done);
  1041. }
  1042. /*-------------------------------------------------------------------------*/
  1043. void usbnet_tx_timeout (struct net_device *net)
  1044. {
  1045. struct usbnet *dev = netdev_priv(net);
  1046. unlink_urbs (dev, &dev->txq);
  1047. tasklet_schedule (&dev->bh);
  1048. /* this needs to be handled individually because the generic layer
  1049. * doesn't know what is sufficient and could not restore private
  1050. * information if a remedy of an unconditional reset were used.
  1051. */
  1052. if (dev->driver_info->recover)
  1053. (dev->driver_info->recover)(dev);
  1054. }
  1055. EXPORT_SYMBOL_GPL(usbnet_tx_timeout);
  1056. /*-------------------------------------------------------------------------*/
  1057. static int build_dma_sg(const struct sk_buff *skb, struct urb *urb)
  1058. {
  1059. unsigned num_sgs, total_len = 0;
  1060. int i, s = 0;
  1061. num_sgs = skb_shinfo(skb)->nr_frags + 1;
  1062. if (num_sgs == 1)
  1063. return 0;
  1064. /* reserve one for zero packet */
  1065. urb->sg = kmalloc((num_sgs + 1) * sizeof(struct scatterlist),
  1066. GFP_ATOMIC);
  1067. if (!urb->sg)
  1068. return -ENOMEM;
  1069. urb->num_sgs = num_sgs;
  1070. sg_init_table(urb->sg, urb->num_sgs + 1);
  1071. sg_set_buf(&urb->sg[s++], skb->data, skb_headlen(skb));
  1072. total_len += skb_headlen(skb);
  1073. for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
  1074. struct skb_frag_struct *f = &skb_shinfo(skb)->frags[i];
  1075. total_len += skb_frag_size(f);
  1076. sg_set_page(&urb->sg[i + s], f->page.p, f->size,
  1077. f->page_offset);
  1078. }
  1079. urb->transfer_buffer_length = total_len;
  1080. return 1;
  1081. }
  1082. netdev_tx_t usbnet_start_xmit (struct sk_buff *skb,
  1083. struct net_device *net)
  1084. {
  1085. struct usbnet *dev = netdev_priv(net);
  1086. int length;
  1087. struct urb *urb = NULL;
  1088. struct skb_data *entry;
  1089. struct driver_info *info = dev->driver_info;
  1090. unsigned long flags;
  1091. int retval;
  1092. if (skb)
  1093. skb_tx_timestamp(skb);
  1094. // some devices want funky USB-level framing, for
  1095. // win32 driver (usually) and/or hardware quirks
  1096. if (info->tx_fixup) {
  1097. skb = info->tx_fixup (dev, skb, GFP_ATOMIC);
  1098. if (!skb) {
  1099. /* packet collected; minidriver waiting for more */
  1100. if (info->flags & FLAG_MULTI_PACKET)
  1101. goto not_drop;
  1102. netif_dbg(dev, tx_err, dev->net, "can't tx_fixup skb\n");
  1103. goto drop;
  1104. }
  1105. }
  1106. if (!(urb = usb_alloc_urb (0, GFP_ATOMIC))) {
  1107. netif_dbg(dev, tx_err, dev->net, "no urb\n");
  1108. goto drop;
  1109. }
  1110. entry = (struct skb_data *) skb->cb;
  1111. entry->urb = urb;
  1112. entry->dev = dev;
  1113. usb_fill_bulk_urb (urb, dev->udev, dev->out,
  1114. skb->data, skb->len, tx_complete, skb);
  1115. if (dev->can_dma_sg) {
  1116. if (build_dma_sg(skb, urb) < 0)
  1117. goto drop;
  1118. }
  1119. length = urb->transfer_buffer_length;
  1120. /* don't assume the hardware handles USB_ZERO_PACKET
  1121. * NOTE: strictly conforming cdc-ether devices should expect
  1122. * the ZLP here, but ignore the one-byte packet.
  1123. * NOTE2: CDC NCM specification is different from CDC ECM when
  1124. * handling ZLP/short packets, so cdc_ncm driver will make short
  1125. * packet itself if needed.
  1126. */
  1127. if (length % dev->maxpacket == 0) {
  1128. if (!(info->flags & FLAG_SEND_ZLP)) {
  1129. if (!(info->flags & FLAG_MULTI_PACKET)) {
  1130. length++;
  1131. if (skb_tailroom(skb) && !urb->num_sgs) {
  1132. skb->data[skb->len] = 0;
  1133. __skb_put(skb, 1);
  1134. } else if (urb->num_sgs)
  1135. sg_set_buf(&urb->sg[urb->num_sgs++],
  1136. dev->padding_pkt, 1);
  1137. }
  1138. } else
  1139. urb->transfer_flags |= URB_ZERO_PACKET;
  1140. }
  1141. entry->length = urb->transfer_buffer_length = length;
  1142. if (!(info->flags & FLAG_MULTI_PACKET))
  1143. usbnet_set_skb_tx_stats(skb, 1);
  1144. spin_lock_irqsave(&dev->txq.lock, flags);
  1145. retval = usb_autopm_get_interface_async(dev->intf);
  1146. if (retval < 0) {
  1147. spin_unlock_irqrestore(&dev->txq.lock, flags);
  1148. goto drop;
  1149. }
  1150. #ifdef CONFIG_PM
  1151. /* if this triggers the device is still a sleep */
  1152. if (test_bit(EVENT_DEV_ASLEEP, &dev->flags)) {
  1153. /* transmission will be done in resume */
  1154. usb_anchor_urb(urb, &dev->deferred);
  1155. /* no use to process more packets */
  1156. netif_stop_queue(net);
  1157. usb_put_urb(urb);
  1158. spin_unlock_irqrestore(&dev->txq.lock, flags);
  1159. netdev_dbg(dev->net, "Delaying transmission for resumption\n");
  1160. goto deferred;
  1161. }
  1162. #endif
  1163. switch ((retval = usb_submit_urb (urb, GFP_ATOMIC))) {
  1164. case -EPIPE:
  1165. netif_stop_queue (net);
  1166. usbnet_defer_kevent (dev, EVENT_TX_HALT);
  1167. usb_autopm_put_interface_async(dev->intf);
  1168. break;
  1169. default:
  1170. usb_autopm_put_interface_async(dev->intf);
  1171. netif_dbg(dev, tx_err, dev->net,
  1172. "tx: submit urb err %d\n", retval);
  1173. break;
  1174. case 0:
  1175. net->trans_start = jiffies;
  1176. __usbnet_queue_skb(&dev->txq, skb, tx_start);
  1177. if (dev->txq.qlen >= TX_QLEN (dev))
  1178. netif_stop_queue (net);
  1179. }
  1180. spin_unlock_irqrestore (&dev->txq.lock, flags);
  1181. if (retval) {
  1182. netif_dbg(dev, tx_err, dev->net, "drop, code %d\n", retval);
  1183. drop:
  1184. dev->net->stats.tx_dropped++;
  1185. not_drop:
  1186. if (skb)
  1187. dev_kfree_skb_any (skb);
  1188. if (urb) {
  1189. kfree(urb->sg);
  1190. usb_free_urb(urb);
  1191. }
  1192. } else
  1193. netif_dbg(dev, tx_queued, dev->net,
  1194. "> tx, len %d, type 0x%x\n", length, skb->protocol);
  1195. #ifdef CONFIG_PM
  1196. deferred:
  1197. #endif
  1198. return NETDEV_TX_OK;
  1199. }
  1200. EXPORT_SYMBOL_GPL(usbnet_start_xmit);
  1201. static int rx_alloc_submit(struct usbnet *dev, gfp_t flags)
  1202. {
  1203. struct urb *urb;
  1204. int i;
  1205. int ret = 0;
  1206. /* don't refill the queue all at once */
  1207. for (i = 0; i < 10 && dev->rxq.qlen < RX_QLEN(dev); i++) {
  1208. urb = usb_alloc_urb(0, flags);
  1209. if (urb != NULL) {
  1210. ret = rx_submit(dev, urb, flags);
  1211. if (ret)
  1212. goto err;
  1213. } else {
  1214. ret = -ENOMEM;
  1215. goto err;
  1216. }
  1217. }
  1218. err:
  1219. return ret;
  1220. }
  1221. /*-------------------------------------------------------------------------*/
  1222. // tasklet (work deferred from completions, in_irq) or timer
  1223. static void usbnet_bh (unsigned long param)
  1224. {
  1225. struct usbnet *dev = (struct usbnet *) param;
  1226. struct sk_buff *skb;
  1227. struct skb_data *entry;
  1228. while ((skb = skb_dequeue (&dev->done))) {
  1229. entry = (struct skb_data *) skb->cb;
  1230. switch (entry->state) {
  1231. case rx_done:
  1232. entry->state = rx_cleanup;
  1233. rx_process (dev, skb);
  1234. continue;
  1235. case tx_done:
  1236. kfree(entry->urb->sg);
  1237. case rx_cleanup:
  1238. usb_free_urb (entry->urb);
  1239. dev_kfree_skb (skb);
  1240. continue;
  1241. default:
  1242. netdev_dbg(dev->net, "bogus skb state %d\n", entry->state);
  1243. }
  1244. }
  1245. /* restart RX again after disabling due to high error rate */
  1246. clear_bit(EVENT_RX_KILL, &dev->flags);
  1247. /* waiting for all pending urbs to complete?
  1248. * only then can we forgo submitting anew
  1249. */
  1250. if (waitqueue_active(&dev->wait)) {
  1251. if (dev->txq.qlen + dev->rxq.qlen + dev->done.qlen == 0)
  1252. wake_up_all(&dev->wait);
  1253. // or are we maybe short a few urbs?
  1254. } else if (netif_running (dev->net) &&
  1255. netif_device_present (dev->net) &&
  1256. netif_carrier_ok(dev->net) &&
  1257. !timer_pending (&dev->delay) &&
  1258. !test_bit (EVENT_RX_HALT, &dev->flags)) {
  1259. int temp = dev->rxq.qlen;
  1260. if (temp < RX_QLEN(dev)) {
  1261. if (rx_alloc_submit(dev, GFP_ATOMIC) == -ENOLINK)
  1262. return;
  1263. if (temp != dev->rxq.qlen)
  1264. netif_dbg(dev, link, dev->net,
  1265. "rxqlen %d --> %d\n",
  1266. temp, dev->rxq.qlen);
  1267. if (dev->rxq.qlen < RX_QLEN(dev))
  1268. tasklet_schedule (&dev->bh);
  1269. }
  1270. if (dev->txq.qlen < TX_QLEN (dev))
  1271. netif_wake_queue (dev->net);
  1272. }
  1273. }
  1274. /*-------------------------------------------------------------------------
  1275. *
  1276. * USB Device Driver support
  1277. *
  1278. *-------------------------------------------------------------------------*/
  1279. // precondition: never called in_interrupt
  1280. void usbnet_disconnect (struct usb_interface *intf)
  1281. {
  1282. struct usbnet *dev;
  1283. struct usb_device *xdev;
  1284. struct net_device *net;
  1285. dev = usb_get_intfdata(intf);
  1286. usb_set_intfdata(intf, NULL);
  1287. if (!dev)
  1288. return;
  1289. xdev = interface_to_usbdev (intf);
  1290. netif_info(dev, probe, dev->net, "unregister '%s' usb-%s-%s, %s\n",
  1291. intf->dev.driver->name,
  1292. xdev->bus->bus_name, xdev->devpath,
  1293. dev->driver_info->description);
  1294. net = dev->net;
  1295. unregister_netdev (net);
  1296. cancel_work_sync(&dev->kevent);
  1297. usb_scuttle_anchored_urbs(&dev->deferred);
  1298. if (dev->driver_info->unbind)
  1299. dev->driver_info->unbind (dev, intf);
  1300. usb_kill_urb(dev->interrupt);
  1301. usb_free_urb(dev->interrupt);
  1302. kfree(dev->padding_pkt);
  1303. free_netdev(net);
  1304. }
  1305. EXPORT_SYMBOL_GPL(usbnet_disconnect);
  1306. static const struct net_device_ops usbnet_netdev_ops = {
  1307. .ndo_open = usbnet_open,
  1308. .ndo_stop = usbnet_stop,
  1309. .ndo_start_xmit = usbnet_start_xmit,
  1310. .ndo_tx_timeout = usbnet_tx_timeout,
  1311. .ndo_set_rx_mode = usbnet_set_rx_mode,
  1312. .ndo_change_mtu = usbnet_change_mtu,
  1313. .ndo_set_mac_address = eth_mac_addr,
  1314. .ndo_validate_addr = eth_validate_addr,
  1315. };
  1316. /*-------------------------------------------------------------------------*/
  1317. // precondition: never called in_interrupt
  1318. static struct device_type wlan_type = {
  1319. .name = "wlan",
  1320. };
  1321. static struct device_type wwan_type = {
  1322. .name = "wwan",
  1323. };
  1324. int
  1325. usbnet_probe (struct usb_interface *udev, const struct usb_device_id *prod)
  1326. {
  1327. struct usbnet *dev;
  1328. struct net_device *net;
  1329. struct usb_host_interface *interface;
  1330. struct driver_info *info;
  1331. struct usb_device *xdev;
  1332. int status;
  1333. const char *name;
  1334. struct usb_driver *driver = to_usb_driver(udev->dev.driver);
  1335. /* usbnet already took usb runtime pm, so have to enable the feature
  1336. * for usb interface, otherwise usb_autopm_get_interface may return
  1337. * failure if RUNTIME_PM is enabled.
  1338. */
  1339. if (!driver->supports_autosuspend) {
  1340. driver->supports_autosuspend = 1;
  1341. pm_runtime_enable(&udev->dev);
  1342. }
  1343. name = udev->dev.driver->name;
  1344. info = (struct driver_info *) prod->driver_info;
  1345. if (!info) {
  1346. dev_dbg (&udev->dev, "blacklisted by %s\n", name);
  1347. return -ENODEV;
  1348. }
  1349. xdev = interface_to_usbdev (udev);
  1350. interface = udev->cur_altsetting;
  1351. status = -ENOMEM;
  1352. // set up our own records
  1353. net = alloc_etherdev(sizeof(*dev));
  1354. if (!net)
  1355. goto out;
  1356. /* netdev_printk() needs this so do it as early as possible */
  1357. SET_NETDEV_DEV(net, &udev->dev);
  1358. dev = netdev_priv(net);
  1359. dev->udev = xdev;
  1360. dev->intf = udev;
  1361. dev->driver_info = info;
  1362. dev->driver_name = name;
  1363. dev->msg_enable = netif_msg_init (msg_level, NETIF_MSG_DRV
  1364. | NETIF_MSG_PROBE | NETIF_MSG_LINK);
  1365. init_waitqueue_head(&dev->wait);
  1366. skb_queue_head_init (&dev->rxq);
  1367. skb_queue_head_init (&dev->txq);
  1368. skb_queue_head_init (&dev->done);
  1369. skb_queue_head_init(&dev->rxq_pause);
  1370. dev->bh.func = usbnet_bh;
  1371. dev->bh.data = (unsigned long) dev;
  1372. INIT_WORK (&dev->kevent, kevent);
  1373. init_usb_anchor(&dev->deferred);
  1374. dev->delay.function = usbnet_bh;
  1375. dev->delay.data = (unsigned long) dev;
  1376. init_timer (&dev->delay);
  1377. mutex_init (&dev->phy_mutex);
  1378. mutex_init(&dev->interrupt_mutex);
  1379. dev->interrupt_count = 0;
  1380. dev->net = net;
  1381. strcpy (net->name, "usb%d");
  1382. memcpy (net->dev_addr, node_id, sizeof node_id);
  1383. /* rx and tx sides can use different message sizes;
  1384. * bind() should set rx_urb_size in that case.
  1385. */
  1386. dev->hard_mtu = net->mtu + net->hard_header_len;
  1387. #if 0
  1388. // dma_supported() is deeply broken on almost all architectures
  1389. // possible with some EHCI controllers
  1390. if (dma_supported (&udev->dev, DMA_BIT_MASK(64)))
  1391. net->features |= NETIF_F_HIGHDMA;
  1392. #endif
  1393. net->netdev_ops = &usbnet_netdev_ops;
  1394. net->watchdog_timeo = TX_TIMEOUT_JIFFIES;
  1395. net->ethtool_ops = &usbnet_ethtool_ops;
  1396. // allow device-specific bind/init procedures
  1397. // NOTE net->name still not usable ...
  1398. if (info->bind) {
  1399. status = info->bind (dev, udev);
  1400. if (status < 0)
  1401. goto out1;
  1402. // heuristic: "usb%d" for links we know are two-host,
  1403. // else "eth%d" when there's reasonable doubt. userspace
  1404. // can rename the link if it knows better.
  1405. if ((dev->driver_info->flags & FLAG_ETHER) != 0 &&
  1406. ((dev->driver_info->flags & FLAG_POINTTOPOINT) == 0 ||
  1407. (net->dev_addr [0] & 0x02) == 0))
  1408. strcpy (net->name, "eth%d");
  1409. /* WLAN devices should always be named "wlan%d" */
  1410. if ((dev->driver_info->flags & FLAG_WLAN) != 0)
  1411. strcpy(net->name, "wlan%d");
  1412. /* WWAN devices should always be named "wwan%d" */
  1413. if ((dev->driver_info->flags & FLAG_WWAN) != 0)
  1414. strcpy(net->name, "wwan%d");
  1415. /* devices that cannot do ARP */
  1416. if ((dev->driver_info->flags & FLAG_NOARP) != 0)
  1417. net->flags |= IFF_NOARP;
  1418. /* maybe the remote can't receive an Ethernet MTU */
  1419. if (net->mtu > (dev->hard_mtu - net->hard_header_len))
  1420. net->mtu = dev->hard_mtu - net->hard_header_len;
  1421. } else if (!info->in || !info->out)
  1422. status = usbnet_get_endpoints (dev, udev);
  1423. else {
  1424. dev->in = usb_rcvbulkpipe (xdev, info->in);
  1425. dev->out = usb_sndbulkpipe (xdev, info->out);
  1426. if (!(info->flags & FLAG_NO_SETINT))
  1427. status = usb_set_interface (xdev,
  1428. interface->desc.bInterfaceNumber,
  1429. interface->desc.bAlternateSetting);
  1430. else
  1431. status = 0;
  1432. }
  1433. if (status >= 0 && dev->status)
  1434. status = init_status (dev, udev);
  1435. if (status < 0)
  1436. goto out3;
  1437. if (!dev->rx_urb_size)
  1438. dev->rx_urb_size = dev->hard_mtu;
  1439. dev->maxpacket = usb_maxpacket (dev->udev, dev->out, 1);
  1440. /* let userspace know we have a random address */
  1441. if (ether_addr_equal(net->dev_addr, node_id))
  1442. net->addr_assign_type = NET_ADDR_RANDOM;
  1443. if ((dev->driver_info->flags & FLAG_WLAN) != 0)
  1444. SET_NETDEV_DEVTYPE(net, &wlan_type);
  1445. if ((dev->driver_info->flags & FLAG_WWAN) != 0)
  1446. SET_NETDEV_DEVTYPE(net, &wwan_type);
  1447. /* initialize max rx_qlen and tx_qlen */
  1448. usbnet_update_max_qlen(dev);
  1449. if (dev->can_dma_sg && !(info->flags & FLAG_SEND_ZLP) &&
  1450. !(info->flags & FLAG_MULTI_PACKET)) {
  1451. dev->padding_pkt = kzalloc(1, GFP_KERNEL);
  1452. if (!dev->padding_pkt) {
  1453. status = -ENOMEM;
  1454. goto out4;
  1455. }
  1456. }
  1457. status = register_netdev (net);
  1458. if (status)
  1459. goto out5;
  1460. netif_info(dev, probe, dev->net,
  1461. "register '%s' at usb-%s-%s, %s, %pM\n",
  1462. udev->dev.driver->name,
  1463. xdev->bus->bus_name, xdev->devpath,
  1464. dev->driver_info->description,
  1465. net->dev_addr);
  1466. // ok, it's ready to go.
  1467. usb_set_intfdata (udev, dev);
  1468. netif_device_attach (net);
  1469. if (dev->driver_info->flags & FLAG_LINK_INTR)
  1470. usbnet_link_change(dev, 0, 0);
  1471. return 0;
  1472. out5:
  1473. kfree(dev->padding_pkt);
  1474. out4:
  1475. usb_free_urb(dev->interrupt);
  1476. out3:
  1477. if (info->unbind)
  1478. info->unbind (dev, udev);
  1479. out1:
  1480. free_netdev(net);
  1481. out:
  1482. return status;
  1483. }
  1484. EXPORT_SYMBOL_GPL(usbnet_probe);
  1485. /*-------------------------------------------------------------------------*/
  1486. /*
  1487. * suspend the whole driver as soon as the first interface is suspended
  1488. * resume only when the last interface is resumed
  1489. */
  1490. int usbnet_suspend (struct usb_interface *intf, pm_message_t message)
  1491. {
  1492. struct usbnet *dev = usb_get_intfdata(intf);
  1493. if (!dev->suspend_count++) {
  1494. spin_lock_irq(&dev->txq.lock);
  1495. /* don't autosuspend while transmitting */
  1496. if (dev->txq.qlen && PMSG_IS_AUTO(message)) {
  1497. dev->suspend_count--;
  1498. spin_unlock_irq(&dev->txq.lock);
  1499. return -EBUSY;
  1500. } else {
  1501. set_bit(EVENT_DEV_ASLEEP, &dev->flags);
  1502. spin_unlock_irq(&dev->txq.lock);
  1503. }
  1504. /*
  1505. * accelerate emptying of the rx and queues, to avoid
  1506. * having everything error out.
  1507. */
  1508. netif_device_detach (dev->net);
  1509. usbnet_terminate_urbs(dev);
  1510. __usbnet_status_stop_force(dev);
  1511. /*
  1512. * reattach so runtime management can use and
  1513. * wake the device
  1514. */
  1515. netif_device_attach (dev->net);
  1516. }
  1517. return 0;
  1518. }
  1519. EXPORT_SYMBOL_GPL(usbnet_suspend);
  1520. int usbnet_resume (struct usb_interface *intf)
  1521. {
  1522. struct usbnet *dev = usb_get_intfdata(intf);
  1523. struct sk_buff *skb;
  1524. struct urb *res;
  1525. int retval;
  1526. if (!--dev->suspend_count) {
  1527. /* resume interrupt URB if it was previously submitted */
  1528. __usbnet_status_start_force(dev, GFP_NOIO);
  1529. spin_lock_irq(&dev->txq.lock);
  1530. while ((res = usb_get_from_anchor(&dev->deferred))) {
  1531. skb = (struct sk_buff *)res->context;
  1532. retval = usb_submit_urb(res, GFP_ATOMIC);
  1533. if (retval < 0) {
  1534. dev_kfree_skb_any(skb);
  1535. kfree(res->sg);
  1536. usb_free_urb(res);
  1537. usb_autopm_put_interface_async(dev->intf);
  1538. } else {
  1539. dev->net->trans_start = jiffies;
  1540. __skb_queue_tail(&dev->txq, skb);
  1541. }
  1542. }
  1543. smp_mb();
  1544. clear_bit(EVENT_DEV_ASLEEP, &dev->flags);
  1545. spin_unlock_irq(&dev->txq.lock);
  1546. if (test_bit(EVENT_DEV_OPEN, &dev->flags)) {
  1547. /* handle remote wakeup ASAP
  1548. * we cannot race against stop
  1549. */
  1550. if (netif_device_present(dev->net) &&
  1551. !timer_pending(&dev->delay) &&
  1552. !test_bit(EVENT_RX_HALT, &dev->flags))
  1553. rx_alloc_submit(dev, GFP_NOIO);
  1554. if (!(dev->txq.qlen >= TX_QLEN(dev)))
  1555. netif_tx_wake_all_queues(dev->net);
  1556. tasklet_schedule (&dev->bh);
  1557. }
  1558. }
  1559. if (test_and_clear_bit(EVENT_DEVICE_REPORT_IDLE, &dev->flags))
  1560. usb_autopm_get_interface_no_resume(intf);
  1561. return 0;
  1562. }
  1563. EXPORT_SYMBOL_GPL(usbnet_resume);
  1564. /*
  1565. * Either a subdriver implements manage_power, then it is assumed to always
  1566. * be ready to be suspended or it reports the readiness to be suspended
  1567. * explicitly
  1568. */
  1569. void usbnet_device_suggests_idle(struct usbnet *dev)
  1570. {
  1571. if (!test_and_set_bit(EVENT_DEVICE_REPORT_IDLE, &dev->flags)) {
  1572. dev->intf->needs_remote_wakeup = 1;
  1573. usb_autopm_put_interface_async(dev->intf);
  1574. }
  1575. }
  1576. EXPORT_SYMBOL(usbnet_device_suggests_idle);
  1577. /*
  1578. * For devices that can do without special commands
  1579. */
  1580. int usbnet_manage_power(struct usbnet *dev, int on)
  1581. {
  1582. dev->intf->needs_remote_wakeup = on;
  1583. return 0;
  1584. }
  1585. EXPORT_SYMBOL(usbnet_manage_power);
  1586. void usbnet_link_change(struct usbnet *dev, bool link, bool need_reset)
  1587. {
  1588. /* update link after link is reseted */
  1589. if (link && !need_reset)
  1590. netif_carrier_on(dev->net);
  1591. else
  1592. netif_carrier_off(dev->net);
  1593. if (need_reset && link)
  1594. usbnet_defer_kevent(dev, EVENT_LINK_RESET);
  1595. else
  1596. usbnet_defer_kevent(dev, EVENT_LINK_CHANGE);
  1597. }
  1598. EXPORT_SYMBOL(usbnet_link_change);
  1599. /*-------------------------------------------------------------------------*/
  1600. static int __usbnet_read_cmd(struct usbnet *dev, u8 cmd, u8 reqtype,
  1601. u16 value, u16 index, void *data, u16 size)
  1602. {
  1603. void *buf = NULL;
  1604. int err = -ENOMEM;
  1605. netdev_dbg(dev->net, "usbnet_read_cmd cmd=0x%02x reqtype=%02x"
  1606. " value=0x%04x index=0x%04x size=%d\n",
  1607. cmd, reqtype, value, index, size);
  1608. if (data) {
  1609. buf = kmalloc(size, GFP_KERNEL);
  1610. if (!buf)
  1611. goto out;
  1612. }
  1613. err = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0),
  1614. cmd, reqtype, value, index, buf, size,
  1615. USB_CTRL_GET_TIMEOUT);
  1616. if (err > 0 && err <= size)
  1617. memcpy(data, buf, err);
  1618. kfree(buf);
  1619. out:
  1620. return err;
  1621. }
  1622. static int __usbnet_write_cmd(struct usbnet *dev, u8 cmd, u8 reqtype,
  1623. u16 value, u16 index, const void *data,
  1624. u16 size)
  1625. {
  1626. void *buf = NULL;
  1627. int err = -ENOMEM;
  1628. netdev_dbg(dev->net, "usbnet_write_cmd cmd=0x%02x reqtype=%02x"
  1629. " value=0x%04x index=0x%04x size=%d\n",
  1630. cmd, reqtype, value, index, size);
  1631. if (data) {
  1632. buf = kmemdup(data, size, GFP_KERNEL);
  1633. if (!buf)
  1634. goto out;
  1635. }
  1636. err = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0),
  1637. cmd, reqtype, value, index, buf, size,
  1638. USB_CTRL_SET_TIMEOUT);
  1639. kfree(buf);
  1640. out:
  1641. return err;
  1642. }
  1643. /*
  1644. * The function can't be called inside suspend/resume callback,
  1645. * otherwise deadlock will be caused.
  1646. */
  1647. int usbnet_read_cmd(struct usbnet *dev, u8 cmd, u8 reqtype,
  1648. u16 value, u16 index, void *data, u16 size)
  1649. {
  1650. int ret;
  1651. if (usb_autopm_get_interface(dev->intf) < 0)
  1652. return -ENODEV;
  1653. ret = __usbnet_read_cmd(dev, cmd, reqtype, value, index,
  1654. data, size);
  1655. usb_autopm_put_interface(dev->intf);
  1656. return ret;
  1657. }
  1658. EXPORT_SYMBOL_GPL(usbnet_read_cmd);
  1659. /*
  1660. * The function can't be called inside suspend/resume callback,
  1661. * otherwise deadlock will be caused.
  1662. */
  1663. int usbnet_write_cmd(struct usbnet *dev, u8 cmd, u8 reqtype,
  1664. u16 value, u16 index, const void *data, u16 size)
  1665. {
  1666. int ret;
  1667. if (usb_autopm_get_interface(dev->intf) < 0)
  1668. return -ENODEV;
  1669. ret = __usbnet_write_cmd(dev, cmd, reqtype, value, index,
  1670. data, size);
  1671. usb_autopm_put_interface(dev->intf);
  1672. return ret;
  1673. }
  1674. EXPORT_SYMBOL_GPL(usbnet_write_cmd);
  1675. /*
  1676. * The function can be called inside suspend/resume callback safely
  1677. * and should only be called by suspend/resume callback generally.
  1678. */
  1679. int usbnet_read_cmd_nopm(struct usbnet *dev, u8 cmd, u8 reqtype,
  1680. u16 value, u16 index, void *data, u16 size)
  1681. {
  1682. return __usbnet_read_cmd(dev, cmd, reqtype, value, index,
  1683. data, size);
  1684. }
  1685. EXPORT_SYMBOL_GPL(usbnet_read_cmd_nopm);
  1686. /*
  1687. * The function can be called inside suspend/resume callback safely
  1688. * and should only be called by suspend/resume callback generally.
  1689. */
  1690. int usbnet_write_cmd_nopm(struct usbnet *dev, u8 cmd, u8 reqtype,
  1691. u16 value, u16 index, const void *data,
  1692. u16 size)
  1693. {
  1694. return __usbnet_write_cmd(dev, cmd, reqtype, value, index,
  1695. data, size);
  1696. }
  1697. EXPORT_SYMBOL_GPL(usbnet_write_cmd_nopm);
  1698. static void usbnet_async_cmd_cb(struct urb *urb)
  1699. {
  1700. struct usb_ctrlrequest *req = (struct usb_ctrlrequest *)urb->context;
  1701. int status = urb->status;
  1702. if (status < 0)
  1703. dev_dbg(&urb->dev->dev, "%s failed with %d",
  1704. __func__, status);
  1705. kfree(req);
  1706. usb_free_urb(urb);
  1707. }
  1708. /*
  1709. * The caller must make sure that device can't be put into suspend
  1710. * state until the control URB completes.
  1711. */
  1712. int usbnet_write_cmd_async(struct usbnet *dev, u8 cmd, u8 reqtype,
  1713. u16 value, u16 index, const void *data, u16 size)
  1714. {
  1715. struct usb_ctrlrequest *req = NULL;
  1716. struct urb *urb;
  1717. int err = -ENOMEM;
  1718. void *buf = NULL;
  1719. netdev_dbg(dev->net, "usbnet_write_cmd cmd=0x%02x reqtype=%02x"
  1720. " value=0x%04x index=0x%04x size=%d\n",
  1721. cmd, reqtype, value, index, size);
  1722. urb = usb_alloc_urb(0, GFP_ATOMIC);
  1723. if (!urb) {
  1724. netdev_err(dev->net, "Error allocating URB in"
  1725. " %s!\n", __func__);
  1726. goto fail;
  1727. }
  1728. if (data) {
  1729. buf = kmemdup(data, size, GFP_ATOMIC);
  1730. if (!buf) {
  1731. netdev_err(dev->net, "Error allocating buffer"
  1732. " in %s!\n", __func__);
  1733. goto fail_free;
  1734. }
  1735. }
  1736. req = kmalloc(sizeof(struct usb_ctrlrequest), GFP_ATOMIC);
  1737. if (!req)
  1738. goto fail_free_buf;
  1739. req->bRequestType = reqtype;
  1740. req->bRequest = cmd;
  1741. req->wValue = cpu_to_le16(value);
  1742. req->wIndex = cpu_to_le16(index);
  1743. req->wLength = cpu_to_le16(size);
  1744. usb_fill_control_urb(urb, dev->udev,
  1745. usb_sndctrlpipe(dev->udev, 0),
  1746. (void *)req, buf, size,
  1747. usbnet_async_cmd_cb, req);
  1748. urb->transfer_flags |= URB_FREE_BUFFER;
  1749. err = usb_submit_urb(urb, GFP_ATOMIC);
  1750. if (err < 0) {
  1751. netdev_err(dev->net, "Error submitting the control"
  1752. " message: status=%d\n", err);
  1753. goto fail_free;
  1754. }
  1755. return 0;
  1756. fail_free_buf:
  1757. kfree(buf);
  1758. fail_free:
  1759. kfree(req);
  1760. usb_free_urb(urb);
  1761. fail:
  1762. return err;
  1763. }
  1764. EXPORT_SYMBOL_GPL(usbnet_write_cmd_async);
  1765. /*-------------------------------------------------------------------------*/
  1766. static int __init usbnet_init(void)
  1767. {
  1768. /* Compiler should optimize this out. */
  1769. BUILD_BUG_ON(
  1770. FIELD_SIZEOF(struct sk_buff, cb) < sizeof(struct skb_data));
  1771. eth_random_addr(node_id);
  1772. return 0;
  1773. }
  1774. module_init(usbnet_init);
  1775. static void __exit usbnet_exit(void)
  1776. {
  1777. }
  1778. module_exit(usbnet_exit);
  1779. MODULE_AUTHOR("David Brownell");
  1780. MODULE_DESCRIPTION("USB network driver framework");
  1781. MODULE_LICENSE("GPL");