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, i;
  141. unsigned char buf [13];
  142. tmp = usb_string(dev->udev, iMACAddress, buf, sizeof buf);
  143. if (tmp != 12) {
  144. dev_dbg(&dev->udev->dev,
  145. "bad MAC string %d fetch, %d\n", iMACAddress, tmp);
  146. if (tmp >= 0)
  147. tmp = -EINVAL;
  148. return tmp;
  149. }
  150. for (i = tmp = 0; i < 6; i++, tmp += 2)
  151. dev->net->dev_addr [i] =
  152. (hex_to_bin(buf[tmp]) << 4) + hex_to_bin(buf[tmp + 1]);
  153. return 0;
  154. }
  155. EXPORT_SYMBOL_GPL(usbnet_get_ethernet_addr);
  156. static void intr_complete (struct urb *urb)
  157. {
  158. struct usbnet *dev = urb->context;
  159. int status = urb->status;
  160. switch (status) {
  161. /* success */
  162. case 0:
  163. dev->driver_info->status(dev, urb);
  164. break;
  165. /* software-driven interface shutdown */
  166. case -ENOENT: /* urb killed */
  167. case -ESHUTDOWN: /* hardware gone */
  168. netif_dbg(dev, ifdown, dev->net,
  169. "intr shutdown, code %d\n", status);
  170. return;
  171. /* NOTE: not throttling like RX/TX, since this endpoint
  172. * already polls infrequently
  173. */
  174. default:
  175. netdev_dbg(dev->net, "intr status %d\n", status);
  176. break;
  177. }
  178. status = usb_submit_urb (urb, GFP_ATOMIC);
  179. if (status != 0)
  180. netif_err(dev, timer, dev->net,
  181. "intr resubmit --> %d\n", status);
  182. }
  183. static int init_status (struct usbnet *dev, struct usb_interface *intf)
  184. {
  185. char *buf = NULL;
  186. unsigned pipe = 0;
  187. unsigned maxp;
  188. unsigned period;
  189. if (!dev->driver_info->status)
  190. return 0;
  191. pipe = usb_rcvintpipe (dev->udev,
  192. dev->status->desc.bEndpointAddress
  193. & USB_ENDPOINT_NUMBER_MASK);
  194. maxp = usb_maxpacket (dev->udev, pipe, 0);
  195. /* avoid 1 msec chatter: min 8 msec poll rate */
  196. period = max ((int) dev->status->desc.bInterval,
  197. (dev->udev->speed == USB_SPEED_HIGH) ? 7 : 3);
  198. buf = kmalloc (maxp, GFP_KERNEL);
  199. if (buf) {
  200. dev->interrupt = usb_alloc_urb (0, GFP_KERNEL);
  201. if (!dev->interrupt) {
  202. kfree (buf);
  203. return -ENOMEM;
  204. } else {
  205. usb_fill_int_urb(dev->interrupt, dev->udev, pipe,
  206. buf, maxp, intr_complete, dev, period);
  207. dev->interrupt->transfer_flags |= URB_FREE_BUFFER;
  208. dev_dbg(&intf->dev,
  209. "status ep%din, %d bytes period %d\n",
  210. usb_pipeendpoint(pipe), maxp, period);
  211. }
  212. }
  213. return 0;
  214. }
  215. /* Submit the interrupt URB if not previously submitted, increasing refcount */
  216. int usbnet_status_start(struct usbnet *dev, gfp_t mem_flags)
  217. {
  218. int ret = 0;
  219. WARN_ON_ONCE(dev->interrupt == NULL);
  220. if (dev->interrupt) {
  221. mutex_lock(&dev->interrupt_mutex);
  222. if (++dev->interrupt_count == 1)
  223. ret = usb_submit_urb(dev->interrupt, mem_flags);
  224. dev_dbg(&dev->udev->dev, "incremented interrupt URB count to %d\n",
  225. dev->interrupt_count);
  226. mutex_unlock(&dev->interrupt_mutex);
  227. }
  228. return ret;
  229. }
  230. EXPORT_SYMBOL_GPL(usbnet_status_start);
  231. /* For resume; submit interrupt URB if previously submitted */
  232. static int __usbnet_status_start_force(struct usbnet *dev, gfp_t mem_flags)
  233. {
  234. int ret = 0;
  235. mutex_lock(&dev->interrupt_mutex);
  236. if (dev->interrupt_count) {
  237. ret = usb_submit_urb(dev->interrupt, mem_flags);
  238. dev_dbg(&dev->udev->dev,
  239. "submitted interrupt URB for resume\n");
  240. }
  241. mutex_unlock(&dev->interrupt_mutex);
  242. return ret;
  243. }
  244. /* Kill the interrupt URB if all submitters want it killed */
  245. void usbnet_status_stop(struct usbnet *dev)
  246. {
  247. if (dev->interrupt) {
  248. mutex_lock(&dev->interrupt_mutex);
  249. WARN_ON(dev->interrupt_count == 0);
  250. if (dev->interrupt_count && --dev->interrupt_count == 0)
  251. usb_kill_urb(dev->interrupt);
  252. dev_dbg(&dev->udev->dev,
  253. "decremented interrupt URB count to %d\n",
  254. dev->interrupt_count);
  255. mutex_unlock(&dev->interrupt_mutex);
  256. }
  257. }
  258. EXPORT_SYMBOL_GPL(usbnet_status_stop);
  259. /* For suspend; always kill interrupt URB */
  260. static void __usbnet_status_stop_force(struct usbnet *dev)
  261. {
  262. if (dev->interrupt) {
  263. mutex_lock(&dev->interrupt_mutex);
  264. usb_kill_urb(dev->interrupt);
  265. dev_dbg(&dev->udev->dev, "killed interrupt URB for suspend\n");
  266. mutex_unlock(&dev->interrupt_mutex);
  267. }
  268. }
  269. /* Passes this packet up the stack, updating its accounting.
  270. * Some link protocols batch packets, so their rx_fixup paths
  271. * can return clones as well as just modify the original skb.
  272. */
  273. void usbnet_skb_return (struct usbnet *dev, struct sk_buff *skb)
  274. {
  275. int status;
  276. if (test_bit(EVENT_RX_PAUSED, &dev->flags)) {
  277. skb_queue_tail(&dev->rxq_pause, skb);
  278. return;
  279. }
  280. skb->protocol = eth_type_trans (skb, dev->net);
  281. dev->net->stats.rx_packets++;
  282. dev->net->stats.rx_bytes += skb->len;
  283. netif_dbg(dev, rx_status, dev->net, "< rx, len %zu, type 0x%x\n",
  284. skb->len + sizeof (struct ethhdr), skb->protocol);
  285. memset (skb->cb, 0, sizeof (struct skb_data));
  286. if (skb_defer_rx_timestamp(skb))
  287. return;
  288. status = netif_rx (skb);
  289. if (status != NET_RX_SUCCESS)
  290. netif_dbg(dev, rx_err, dev->net,
  291. "netif_rx status %d\n", status);
  292. }
  293. EXPORT_SYMBOL_GPL(usbnet_skb_return);
  294. /* must be called if hard_mtu or rx_urb_size changed */
  295. void usbnet_update_max_qlen(struct usbnet *dev)
  296. {
  297. enum usb_device_speed speed = dev->udev->speed;
  298. switch (speed) {
  299. case USB_SPEED_HIGH:
  300. dev->rx_qlen = MAX_QUEUE_MEMORY / dev->rx_urb_size;
  301. dev->tx_qlen = MAX_QUEUE_MEMORY / dev->hard_mtu;
  302. break;
  303. case USB_SPEED_SUPER:
  304. /*
  305. * Not take default 5ms qlen for super speed HC to
  306. * save memory, and iperf tests show 2.5ms qlen can
  307. * work well
  308. */
  309. dev->rx_qlen = 5 * MAX_QUEUE_MEMORY / dev->rx_urb_size;
  310. dev->tx_qlen = 5 * MAX_QUEUE_MEMORY / dev->hard_mtu;
  311. break;
  312. default:
  313. dev->rx_qlen = dev->tx_qlen = 4;
  314. }
  315. }
  316. EXPORT_SYMBOL_GPL(usbnet_update_max_qlen);
  317. /*-------------------------------------------------------------------------
  318. *
  319. * Network Device Driver (peer link to "Host Device", from USB host)
  320. *
  321. *-------------------------------------------------------------------------*/
  322. int usbnet_change_mtu (struct net_device *net, int new_mtu)
  323. {
  324. struct usbnet *dev = netdev_priv(net);
  325. int ll_mtu = new_mtu + net->hard_header_len;
  326. int old_hard_mtu = dev->hard_mtu;
  327. int old_rx_urb_size = dev->rx_urb_size;
  328. if (new_mtu <= 0)
  329. return -EINVAL;
  330. // no second zero-length packet read wanted after mtu-sized packets
  331. if ((ll_mtu % dev->maxpacket) == 0)
  332. return -EDOM;
  333. net->mtu = new_mtu;
  334. dev->hard_mtu = net->mtu + net->hard_header_len;
  335. if (dev->rx_urb_size == old_hard_mtu) {
  336. dev->rx_urb_size = dev->hard_mtu;
  337. if (dev->rx_urb_size > old_rx_urb_size)
  338. usbnet_unlink_rx_urbs(dev);
  339. }
  340. /* max qlen depend on hard_mtu and rx_urb_size */
  341. usbnet_update_max_qlen(dev);
  342. return 0;
  343. }
  344. EXPORT_SYMBOL_GPL(usbnet_change_mtu);
  345. /* The caller must hold list->lock */
  346. static void __usbnet_queue_skb(struct sk_buff_head *list,
  347. struct sk_buff *newsk, enum skb_state state)
  348. {
  349. struct skb_data *entry = (struct skb_data *) newsk->cb;
  350. __skb_queue_tail(list, newsk);
  351. entry->state = state;
  352. }
  353. /*-------------------------------------------------------------------------*/
  354. /* some LK 2.4 HCDs oopsed if we freed or resubmitted urbs from
  355. * completion callbacks. 2.5 should have fixed those bugs...
  356. */
  357. static enum skb_state defer_bh(struct usbnet *dev, struct sk_buff *skb,
  358. struct sk_buff_head *list, enum skb_state state)
  359. {
  360. unsigned long flags;
  361. enum skb_state old_state;
  362. struct skb_data *entry = (struct skb_data *) skb->cb;
  363. spin_lock_irqsave(&list->lock, flags);
  364. old_state = entry->state;
  365. entry->state = state;
  366. __skb_unlink(skb, list);
  367. spin_unlock(&list->lock);
  368. spin_lock(&dev->done.lock);
  369. __skb_queue_tail(&dev->done, skb);
  370. if (dev->done.qlen == 1)
  371. tasklet_schedule(&dev->bh);
  372. spin_unlock_irqrestore(&dev->done.lock, flags);
  373. return old_state;
  374. }
  375. /* some work can't be done in tasklets, so we use keventd
  376. *
  377. * NOTE: annoying asymmetry: if it's active, schedule_work() fails,
  378. * but tasklet_schedule() doesn't. hope the failure is rare.
  379. */
  380. void usbnet_defer_kevent (struct usbnet *dev, int work)
  381. {
  382. set_bit (work, &dev->flags);
  383. if (!schedule_work (&dev->kevent)) {
  384. if (net_ratelimit())
  385. netdev_err(dev->net, "kevent %d may have been dropped\n", work);
  386. } else {
  387. netdev_dbg(dev->net, "kevent %d scheduled\n", work);
  388. }
  389. }
  390. EXPORT_SYMBOL_GPL(usbnet_defer_kevent);
  391. /*-------------------------------------------------------------------------*/
  392. static void rx_complete (struct urb *urb);
  393. static int rx_submit (struct usbnet *dev, struct urb *urb, gfp_t flags)
  394. {
  395. struct sk_buff *skb;
  396. struct skb_data *entry;
  397. int retval = 0;
  398. unsigned long lockflags;
  399. size_t size = dev->rx_urb_size;
  400. /* prevent rx skb allocation when error ratio is high */
  401. if (test_bit(EVENT_RX_KILL, &dev->flags)) {
  402. usb_free_urb(urb);
  403. return -ENOLINK;
  404. }
  405. skb = __netdev_alloc_skb_ip_align(dev->net, size, flags);
  406. if (!skb) {
  407. netif_dbg(dev, rx_err, dev->net, "no rx skb\n");
  408. usbnet_defer_kevent (dev, EVENT_RX_MEMORY);
  409. usb_free_urb (urb);
  410. return -ENOMEM;
  411. }
  412. entry = (struct skb_data *) skb->cb;
  413. entry->urb = urb;
  414. entry->dev = dev;
  415. entry->length = 0;
  416. usb_fill_bulk_urb (urb, dev->udev, dev->in,
  417. skb->data, size, rx_complete, skb);
  418. spin_lock_irqsave (&dev->rxq.lock, lockflags);
  419. if (netif_running (dev->net) &&
  420. netif_device_present (dev->net) &&
  421. !test_bit (EVENT_RX_HALT, &dev->flags) &&
  422. !test_bit (EVENT_DEV_ASLEEP, &dev->flags)) {
  423. switch (retval = usb_submit_urb (urb, GFP_ATOMIC)) {
  424. case -EPIPE:
  425. usbnet_defer_kevent (dev, EVENT_RX_HALT);
  426. break;
  427. case -ENOMEM:
  428. usbnet_defer_kevent (dev, EVENT_RX_MEMORY);
  429. break;
  430. case -ENODEV:
  431. netif_dbg(dev, ifdown, dev->net, "device gone\n");
  432. netif_device_detach (dev->net);
  433. break;
  434. case -EHOSTUNREACH:
  435. retval = -ENOLINK;
  436. break;
  437. default:
  438. netif_dbg(dev, rx_err, dev->net,
  439. "rx submit, %d\n", retval);
  440. tasklet_schedule (&dev->bh);
  441. break;
  442. case 0:
  443. __usbnet_queue_skb(&dev->rxq, skb, rx_start);
  444. }
  445. } else {
  446. netif_dbg(dev, ifdown, dev->net, "rx: stopped\n");
  447. retval = -ENOLINK;
  448. }
  449. spin_unlock_irqrestore (&dev->rxq.lock, lockflags);
  450. if (retval) {
  451. dev_kfree_skb_any (skb);
  452. usb_free_urb (urb);
  453. }
  454. return retval;
  455. }
  456. /*-------------------------------------------------------------------------*/
  457. static inline void rx_process (struct usbnet *dev, struct sk_buff *skb)
  458. {
  459. if (dev->driver_info->rx_fixup &&
  460. !dev->driver_info->rx_fixup (dev, skb)) {
  461. /* With RX_ASSEMBLE, rx_fixup() must update counters */
  462. if (!(dev->driver_info->flags & FLAG_RX_ASSEMBLE))
  463. dev->net->stats.rx_errors++;
  464. goto done;
  465. }
  466. // else network stack removes extra byte if we forced a short packet
  467. /* all data was already cloned from skb inside the driver */
  468. if (dev->driver_info->flags & FLAG_MULTI_PACKET)
  469. goto done;
  470. if (skb->len < ETH_HLEN) {
  471. dev->net->stats.rx_errors++;
  472. dev->net->stats.rx_length_errors++;
  473. netif_dbg(dev, rx_err, dev->net, "rx length %d\n", skb->len);
  474. } else {
  475. usbnet_skb_return(dev, skb);
  476. return;
  477. }
  478. done:
  479. skb_queue_tail(&dev->done, skb);
  480. }
  481. /*-------------------------------------------------------------------------*/
  482. static void rx_complete (struct urb *urb)
  483. {
  484. struct sk_buff *skb = (struct sk_buff *) urb->context;
  485. struct skb_data *entry = (struct skb_data *) skb->cb;
  486. struct usbnet *dev = entry->dev;
  487. int urb_status = urb->status;
  488. enum skb_state state;
  489. skb_put (skb, urb->actual_length);
  490. state = rx_done;
  491. entry->urb = NULL;
  492. switch (urb_status) {
  493. /* success */
  494. case 0:
  495. break;
  496. /* stalls need manual reset. this is rare ... except that
  497. * when going through USB 2.0 TTs, unplug appears this way.
  498. * we avoid the highspeed version of the ETIMEDOUT/EILSEQ
  499. * storm, recovering as needed.
  500. */
  501. case -EPIPE:
  502. dev->net->stats.rx_errors++;
  503. usbnet_defer_kevent (dev, EVENT_RX_HALT);
  504. // FALLTHROUGH
  505. /* software-driven interface shutdown */
  506. case -ECONNRESET: /* async unlink */
  507. case -ESHUTDOWN: /* hardware gone */
  508. netif_dbg(dev, ifdown, dev->net,
  509. "rx shutdown, code %d\n", urb_status);
  510. goto block;
  511. /* we get controller i/o faults during hub_wq disconnect() delays.
  512. * throttle down resubmits, to avoid log floods; just temporarily,
  513. * so we still recover when the fault isn't a hub_wq delay.
  514. */
  515. case -EPROTO:
  516. case -ETIME:
  517. case -EILSEQ:
  518. dev->net->stats.rx_errors++;
  519. if (!timer_pending (&dev->delay)) {
  520. mod_timer (&dev->delay, jiffies + THROTTLE_JIFFIES);
  521. netif_dbg(dev, link, dev->net,
  522. "rx throttle %d\n", urb_status);
  523. }
  524. block:
  525. state = rx_cleanup;
  526. entry->urb = urb;
  527. urb = NULL;
  528. break;
  529. /* data overrun ... flush fifo? */
  530. case -EOVERFLOW:
  531. dev->net->stats.rx_over_errors++;
  532. // FALLTHROUGH
  533. default:
  534. state = rx_cleanup;
  535. dev->net->stats.rx_errors++;
  536. netif_dbg(dev, rx_err, dev->net, "rx status %d\n", urb_status);
  537. break;
  538. }
  539. /* stop rx if packet error rate is high */
  540. if (++dev->pkt_cnt > 30) {
  541. dev->pkt_cnt = 0;
  542. dev->pkt_err = 0;
  543. } else {
  544. if (state == rx_cleanup)
  545. dev->pkt_err++;
  546. if (dev->pkt_err > 20)
  547. set_bit(EVENT_RX_KILL, &dev->flags);
  548. }
  549. state = defer_bh(dev, skb, &dev->rxq, state);
  550. if (urb) {
  551. if (netif_running (dev->net) &&
  552. !test_bit (EVENT_RX_HALT, &dev->flags) &&
  553. state != unlink_start) {
  554. rx_submit (dev, urb, GFP_ATOMIC);
  555. usb_mark_last_busy(dev->udev);
  556. return;
  557. }
  558. usb_free_urb (urb);
  559. }
  560. netif_dbg(dev, rx_err, dev->net, "no read resubmitted\n");
  561. }
  562. /*-------------------------------------------------------------------------*/
  563. void usbnet_pause_rx(struct usbnet *dev)
  564. {
  565. set_bit(EVENT_RX_PAUSED, &dev->flags);
  566. netif_dbg(dev, rx_status, dev->net, "paused rx queue enabled\n");
  567. }
  568. EXPORT_SYMBOL_GPL(usbnet_pause_rx);
  569. void usbnet_resume_rx(struct usbnet *dev)
  570. {
  571. struct sk_buff *skb;
  572. int num = 0;
  573. clear_bit(EVENT_RX_PAUSED, &dev->flags);
  574. while ((skb = skb_dequeue(&dev->rxq_pause)) != NULL) {
  575. usbnet_skb_return(dev, skb);
  576. num++;
  577. }
  578. tasklet_schedule(&dev->bh);
  579. netif_dbg(dev, rx_status, dev->net,
  580. "paused rx queue disabled, %d skbs requeued\n", num);
  581. }
  582. EXPORT_SYMBOL_GPL(usbnet_resume_rx);
  583. void usbnet_purge_paused_rxq(struct usbnet *dev)
  584. {
  585. skb_queue_purge(&dev->rxq_pause);
  586. }
  587. EXPORT_SYMBOL_GPL(usbnet_purge_paused_rxq);
  588. /*-------------------------------------------------------------------------*/
  589. // unlink pending rx/tx; completion handlers do all other cleanup
  590. static int unlink_urbs (struct usbnet *dev, struct sk_buff_head *q)
  591. {
  592. unsigned long flags;
  593. struct sk_buff *skb;
  594. int count = 0;
  595. spin_lock_irqsave (&q->lock, flags);
  596. while (!skb_queue_empty(q)) {
  597. struct skb_data *entry;
  598. struct urb *urb;
  599. int retval;
  600. skb_queue_walk(q, skb) {
  601. entry = (struct skb_data *) skb->cb;
  602. if (entry->state != unlink_start)
  603. goto found;
  604. }
  605. break;
  606. found:
  607. entry->state = unlink_start;
  608. urb = entry->urb;
  609. /*
  610. * Get reference count of the URB to avoid it to be
  611. * freed during usb_unlink_urb, which may trigger
  612. * use-after-free problem inside usb_unlink_urb since
  613. * usb_unlink_urb is always racing with .complete
  614. * handler(include defer_bh).
  615. */
  616. usb_get_urb(urb);
  617. spin_unlock_irqrestore(&q->lock, flags);
  618. // during some PM-driven resume scenarios,
  619. // these (async) unlinks complete immediately
  620. retval = usb_unlink_urb (urb);
  621. if (retval != -EINPROGRESS && retval != 0)
  622. netdev_dbg(dev->net, "unlink urb err, %d\n", retval);
  623. else
  624. count++;
  625. usb_put_urb(urb);
  626. spin_lock_irqsave(&q->lock, flags);
  627. }
  628. spin_unlock_irqrestore (&q->lock, flags);
  629. return count;
  630. }
  631. // Flush all pending rx urbs
  632. // minidrivers may need to do this when the MTU changes
  633. void usbnet_unlink_rx_urbs(struct usbnet *dev)
  634. {
  635. if (netif_running(dev->net)) {
  636. (void) unlink_urbs (dev, &dev->rxq);
  637. tasklet_schedule(&dev->bh);
  638. }
  639. }
  640. EXPORT_SYMBOL_GPL(usbnet_unlink_rx_urbs);
  641. /*-------------------------------------------------------------------------*/
  642. // precondition: never called in_interrupt
  643. static void usbnet_terminate_urbs(struct usbnet *dev)
  644. {
  645. DECLARE_WAITQUEUE(wait, current);
  646. int temp;
  647. /* ensure there are no more active urbs */
  648. add_wait_queue(&dev->wait, &wait);
  649. set_current_state(TASK_UNINTERRUPTIBLE);
  650. temp = unlink_urbs(dev, &dev->txq) +
  651. unlink_urbs(dev, &dev->rxq);
  652. /* maybe wait for deletions to finish. */
  653. while (!skb_queue_empty(&dev->rxq)
  654. && !skb_queue_empty(&dev->txq)
  655. && !skb_queue_empty(&dev->done)) {
  656. schedule_timeout(msecs_to_jiffies(UNLINK_TIMEOUT_MS));
  657. set_current_state(TASK_UNINTERRUPTIBLE);
  658. netif_dbg(dev, ifdown, dev->net,
  659. "waited for %d urb completions\n", temp);
  660. }
  661. set_current_state(TASK_RUNNING);
  662. remove_wait_queue(&dev->wait, &wait);
  663. }
  664. int usbnet_stop (struct net_device *net)
  665. {
  666. struct usbnet *dev = netdev_priv(net);
  667. struct driver_info *info = dev->driver_info;
  668. int retval, pm;
  669. clear_bit(EVENT_DEV_OPEN, &dev->flags);
  670. netif_stop_queue (net);
  671. netif_info(dev, ifdown, dev->net,
  672. "stop stats: rx/tx %lu/%lu, errs %lu/%lu\n",
  673. net->stats.rx_packets, net->stats.tx_packets,
  674. net->stats.rx_errors, net->stats.tx_errors);
  675. /* to not race resume */
  676. pm = usb_autopm_get_interface(dev->intf);
  677. /* allow minidriver to stop correctly (wireless devices to turn off
  678. * radio etc) */
  679. if (info->stop) {
  680. retval = info->stop(dev);
  681. if (retval < 0)
  682. netif_info(dev, ifdown, dev->net,
  683. "stop fail (%d) usbnet usb-%s-%s, %s\n",
  684. retval,
  685. dev->udev->bus->bus_name, dev->udev->devpath,
  686. info->description);
  687. }
  688. if (!(info->flags & FLAG_AVOID_UNLINK_URBS))
  689. usbnet_terminate_urbs(dev);
  690. usbnet_status_stop(dev);
  691. usbnet_purge_paused_rxq(dev);
  692. /* deferred work (task, timer, softirq) must also stop.
  693. * can't flush_scheduled_work() until we drop rtnl (later),
  694. * else workers could deadlock; so make workers a NOP.
  695. */
  696. dev->flags = 0;
  697. del_timer_sync (&dev->delay);
  698. tasklet_kill (&dev->bh);
  699. if (!pm)
  700. usb_autopm_put_interface(dev->intf);
  701. if (info->manage_power &&
  702. !test_and_clear_bit(EVENT_NO_RUNTIME_PM, &dev->flags))
  703. info->manage_power(dev, 0);
  704. else
  705. usb_autopm_put_interface(dev->intf);
  706. return 0;
  707. }
  708. EXPORT_SYMBOL_GPL(usbnet_stop);
  709. /*-------------------------------------------------------------------------*/
  710. // posts reads, and enables write queuing
  711. // precondition: never called in_interrupt
  712. int usbnet_open (struct net_device *net)
  713. {
  714. struct usbnet *dev = netdev_priv(net);
  715. int retval;
  716. struct driver_info *info = dev->driver_info;
  717. if ((retval = usb_autopm_get_interface(dev->intf)) < 0) {
  718. netif_info(dev, ifup, dev->net,
  719. "resumption fail (%d) usbnet usb-%s-%s, %s\n",
  720. retval,
  721. dev->udev->bus->bus_name,
  722. dev->udev->devpath,
  723. info->description);
  724. goto done_nopm;
  725. }
  726. // put into "known safe" state
  727. if (info->reset && (retval = info->reset (dev)) < 0) {
  728. netif_info(dev, ifup, dev->net,
  729. "open reset fail (%d) usbnet usb-%s-%s, %s\n",
  730. retval,
  731. dev->udev->bus->bus_name,
  732. dev->udev->devpath,
  733. info->description);
  734. goto done;
  735. }
  736. /* hard_mtu or rx_urb_size may change in reset() */
  737. usbnet_update_max_qlen(dev);
  738. // insist peer be connected
  739. if (info->check_connect && (retval = info->check_connect (dev)) < 0) {
  740. netif_dbg(dev, ifup, dev->net, "can't open; %d\n", retval);
  741. goto done;
  742. }
  743. /* start any status interrupt transfer */
  744. if (dev->interrupt) {
  745. retval = usbnet_status_start(dev, GFP_KERNEL);
  746. if (retval < 0) {
  747. netif_err(dev, ifup, dev->net,
  748. "intr submit %d\n", retval);
  749. goto done;
  750. }
  751. }
  752. set_bit(EVENT_DEV_OPEN, &dev->flags);
  753. netif_start_queue (net);
  754. netif_info(dev, ifup, dev->net,
  755. "open: enable queueing (rx %d, tx %d) mtu %d %s framing\n",
  756. (int)RX_QLEN(dev), (int)TX_QLEN(dev),
  757. dev->net->mtu,
  758. (dev->driver_info->flags & FLAG_FRAMING_NC) ? "NetChip" :
  759. (dev->driver_info->flags & FLAG_FRAMING_GL) ? "GeneSys" :
  760. (dev->driver_info->flags & FLAG_FRAMING_Z) ? "Zaurus" :
  761. (dev->driver_info->flags & FLAG_FRAMING_RN) ? "RNDIS" :
  762. (dev->driver_info->flags & FLAG_FRAMING_AX) ? "ASIX" :
  763. "simple");
  764. /* reset rx error state */
  765. dev->pkt_cnt = 0;
  766. dev->pkt_err = 0;
  767. clear_bit(EVENT_RX_KILL, &dev->flags);
  768. // delay posting reads until we're fully open
  769. tasklet_schedule (&dev->bh);
  770. if (info->manage_power) {
  771. retval = info->manage_power(dev, 1);
  772. if (retval < 0) {
  773. retval = 0;
  774. set_bit(EVENT_NO_RUNTIME_PM, &dev->flags);
  775. } else {
  776. usb_autopm_put_interface(dev->intf);
  777. }
  778. }
  779. return retval;
  780. done:
  781. usb_autopm_put_interface(dev->intf);
  782. done_nopm:
  783. return retval;
  784. }
  785. EXPORT_SYMBOL_GPL(usbnet_open);
  786. /*-------------------------------------------------------------------------*/
  787. /* ethtool methods; minidrivers may need to add some more, but
  788. * they'll probably want to use this base set.
  789. */
  790. int usbnet_get_settings (struct net_device *net, struct ethtool_cmd *cmd)
  791. {
  792. struct usbnet *dev = netdev_priv(net);
  793. if (!dev->mii.mdio_read)
  794. return -EOPNOTSUPP;
  795. return mii_ethtool_gset(&dev->mii, cmd);
  796. }
  797. EXPORT_SYMBOL_GPL(usbnet_get_settings);
  798. int usbnet_set_settings (struct net_device *net, struct ethtool_cmd *cmd)
  799. {
  800. struct usbnet *dev = netdev_priv(net);
  801. int retval;
  802. if (!dev->mii.mdio_write)
  803. return -EOPNOTSUPP;
  804. retval = mii_ethtool_sset(&dev->mii, cmd);
  805. /* link speed/duplex might have changed */
  806. if (dev->driver_info->link_reset)
  807. dev->driver_info->link_reset(dev);
  808. /* hard_mtu or rx_urb_size may change in link_reset() */
  809. usbnet_update_max_qlen(dev);
  810. return retval;
  811. }
  812. EXPORT_SYMBOL_GPL(usbnet_set_settings);
  813. u32 usbnet_get_link (struct net_device *net)
  814. {
  815. struct usbnet *dev = netdev_priv(net);
  816. /* If a check_connect is defined, return its result */
  817. if (dev->driver_info->check_connect)
  818. return dev->driver_info->check_connect (dev) == 0;
  819. /* if the device has mii operations, use those */
  820. if (dev->mii.mdio_read)
  821. return mii_link_ok(&dev->mii);
  822. /* Otherwise, dtrt for drivers calling netif_carrier_{on,off} */
  823. return ethtool_op_get_link(net);
  824. }
  825. EXPORT_SYMBOL_GPL(usbnet_get_link);
  826. int usbnet_nway_reset(struct net_device *net)
  827. {
  828. struct usbnet *dev = netdev_priv(net);
  829. if (!dev->mii.mdio_write)
  830. return -EOPNOTSUPP;
  831. return mii_nway_restart(&dev->mii);
  832. }
  833. EXPORT_SYMBOL_GPL(usbnet_nway_reset);
  834. void usbnet_get_drvinfo (struct net_device *net, struct ethtool_drvinfo *info)
  835. {
  836. struct usbnet *dev = netdev_priv(net);
  837. strlcpy (info->driver, dev->driver_name, sizeof info->driver);
  838. strlcpy (info->version, DRIVER_VERSION, sizeof info->version);
  839. strlcpy (info->fw_version, dev->driver_info->description,
  840. sizeof info->fw_version);
  841. usb_make_path (dev->udev, info->bus_info, sizeof info->bus_info);
  842. }
  843. EXPORT_SYMBOL_GPL(usbnet_get_drvinfo);
  844. u32 usbnet_get_msglevel (struct net_device *net)
  845. {
  846. struct usbnet *dev = netdev_priv(net);
  847. return dev->msg_enable;
  848. }
  849. EXPORT_SYMBOL_GPL(usbnet_get_msglevel);
  850. void usbnet_set_msglevel (struct net_device *net, u32 level)
  851. {
  852. struct usbnet *dev = netdev_priv(net);
  853. dev->msg_enable = level;
  854. }
  855. EXPORT_SYMBOL_GPL(usbnet_set_msglevel);
  856. /* drivers may override default ethtool_ops in their bind() routine */
  857. static const struct ethtool_ops usbnet_ethtool_ops = {
  858. .get_settings = usbnet_get_settings,
  859. .set_settings = usbnet_set_settings,
  860. .get_link = usbnet_get_link,
  861. .nway_reset = usbnet_nway_reset,
  862. .get_drvinfo = usbnet_get_drvinfo,
  863. .get_msglevel = usbnet_get_msglevel,
  864. .set_msglevel = usbnet_set_msglevel,
  865. .get_ts_info = ethtool_op_get_ts_info,
  866. };
  867. /*-------------------------------------------------------------------------*/
  868. static void __handle_link_change(struct usbnet *dev)
  869. {
  870. if (!test_bit(EVENT_DEV_OPEN, &dev->flags))
  871. return;
  872. if (!netif_carrier_ok(dev->net)) {
  873. /* kill URBs for reading packets to save bus bandwidth */
  874. unlink_urbs(dev, &dev->rxq);
  875. /*
  876. * tx_timeout will unlink URBs for sending packets and
  877. * tx queue is stopped by netcore after link becomes off
  878. */
  879. } else {
  880. /* submitting URBs for reading packets */
  881. tasklet_schedule(&dev->bh);
  882. }
  883. /* hard_mtu or rx_urb_size may change during link change */
  884. usbnet_update_max_qlen(dev);
  885. clear_bit(EVENT_LINK_CHANGE, &dev->flags);
  886. }
  887. static void usbnet_set_rx_mode(struct net_device *net)
  888. {
  889. struct usbnet *dev = netdev_priv(net);
  890. usbnet_defer_kevent(dev, EVENT_SET_RX_MODE);
  891. }
  892. static void __handle_set_rx_mode(struct usbnet *dev)
  893. {
  894. if (dev->driver_info->set_rx_mode)
  895. (dev->driver_info->set_rx_mode)(dev);
  896. clear_bit(EVENT_SET_RX_MODE, &dev->flags);
  897. }
  898. /* work that cannot be done in interrupt context uses keventd.
  899. *
  900. * NOTE: with 2.5 we could do more of this using completion callbacks,
  901. * especially now that control transfers can be queued.
  902. */
  903. static void
  904. kevent (struct work_struct *work)
  905. {
  906. struct usbnet *dev =
  907. container_of(work, struct usbnet, kevent);
  908. int status;
  909. /* usb_clear_halt() needs a thread context */
  910. if (test_bit (EVENT_TX_HALT, &dev->flags)) {
  911. unlink_urbs (dev, &dev->txq);
  912. status = usb_autopm_get_interface(dev->intf);
  913. if (status < 0)
  914. goto fail_pipe;
  915. status = usb_clear_halt (dev->udev, dev->out);
  916. usb_autopm_put_interface(dev->intf);
  917. if (status < 0 &&
  918. status != -EPIPE &&
  919. status != -ESHUTDOWN) {
  920. if (netif_msg_tx_err (dev))
  921. fail_pipe:
  922. netdev_err(dev->net, "can't clear tx halt, status %d\n",
  923. status);
  924. } else {
  925. clear_bit (EVENT_TX_HALT, &dev->flags);
  926. if (status != -ESHUTDOWN)
  927. netif_wake_queue (dev->net);
  928. }
  929. }
  930. if (test_bit (EVENT_RX_HALT, &dev->flags)) {
  931. unlink_urbs (dev, &dev->rxq);
  932. status = usb_autopm_get_interface(dev->intf);
  933. if (status < 0)
  934. goto fail_halt;
  935. status = usb_clear_halt (dev->udev, dev->in);
  936. usb_autopm_put_interface(dev->intf);
  937. if (status < 0 &&
  938. status != -EPIPE &&
  939. status != -ESHUTDOWN) {
  940. if (netif_msg_rx_err (dev))
  941. fail_halt:
  942. netdev_err(dev->net, "can't clear rx halt, status %d\n",
  943. status);
  944. } else {
  945. clear_bit (EVENT_RX_HALT, &dev->flags);
  946. tasklet_schedule (&dev->bh);
  947. }
  948. }
  949. /* tasklet could resubmit itself forever if memory is tight */
  950. if (test_bit (EVENT_RX_MEMORY, &dev->flags)) {
  951. struct urb *urb = NULL;
  952. int resched = 1;
  953. if (netif_running (dev->net))
  954. urb = usb_alloc_urb (0, GFP_KERNEL);
  955. else
  956. clear_bit (EVENT_RX_MEMORY, &dev->flags);
  957. if (urb != NULL) {
  958. clear_bit (EVENT_RX_MEMORY, &dev->flags);
  959. status = usb_autopm_get_interface(dev->intf);
  960. if (status < 0) {
  961. usb_free_urb(urb);
  962. goto fail_lowmem;
  963. }
  964. if (rx_submit (dev, urb, GFP_KERNEL) == -ENOLINK)
  965. resched = 0;
  966. usb_autopm_put_interface(dev->intf);
  967. fail_lowmem:
  968. if (resched)
  969. tasklet_schedule (&dev->bh);
  970. }
  971. }
  972. if (test_bit (EVENT_LINK_RESET, &dev->flags)) {
  973. struct driver_info *info = dev->driver_info;
  974. int retval = 0;
  975. clear_bit (EVENT_LINK_RESET, &dev->flags);
  976. status = usb_autopm_get_interface(dev->intf);
  977. if (status < 0)
  978. goto skip_reset;
  979. if(info->link_reset && (retval = info->link_reset(dev)) < 0) {
  980. usb_autopm_put_interface(dev->intf);
  981. skip_reset:
  982. netdev_info(dev->net, "link reset failed (%d) usbnet usb-%s-%s, %s\n",
  983. retval,
  984. dev->udev->bus->bus_name,
  985. dev->udev->devpath,
  986. info->description);
  987. } else {
  988. usb_autopm_put_interface(dev->intf);
  989. }
  990. /* handle link change from link resetting */
  991. __handle_link_change(dev);
  992. }
  993. if (test_bit (EVENT_LINK_CHANGE, &dev->flags))
  994. __handle_link_change(dev);
  995. if (test_bit (EVENT_SET_RX_MODE, &dev->flags))
  996. __handle_set_rx_mode(dev);
  997. if (dev->flags)
  998. netdev_dbg(dev->net, "kevent done, flags = 0x%lx\n", dev->flags);
  999. }
  1000. /*-------------------------------------------------------------------------*/
  1001. static void tx_complete (struct urb *urb)
  1002. {
  1003. struct sk_buff *skb = (struct sk_buff *) urb->context;
  1004. struct skb_data *entry = (struct skb_data *) skb->cb;
  1005. struct usbnet *dev = entry->dev;
  1006. if (urb->status == 0) {
  1007. if (!(dev->driver_info->flags & FLAG_MULTI_PACKET))
  1008. dev->net->stats.tx_packets++;
  1009. dev->net->stats.tx_bytes += entry->length;
  1010. } else {
  1011. dev->net->stats.tx_errors++;
  1012. switch (urb->status) {
  1013. case -EPIPE:
  1014. usbnet_defer_kevent (dev, EVENT_TX_HALT);
  1015. break;
  1016. /* software-driven interface shutdown */
  1017. case -ECONNRESET: // async unlink
  1018. case -ESHUTDOWN: // hardware gone
  1019. break;
  1020. /* like rx, tx gets controller i/o faults during hub_wq
  1021. * delays and so it uses the same throttling mechanism.
  1022. */
  1023. case -EPROTO:
  1024. case -ETIME:
  1025. case -EILSEQ:
  1026. usb_mark_last_busy(dev->udev);
  1027. if (!timer_pending (&dev->delay)) {
  1028. mod_timer (&dev->delay,
  1029. jiffies + THROTTLE_JIFFIES);
  1030. netif_dbg(dev, link, dev->net,
  1031. "tx throttle %d\n", urb->status);
  1032. }
  1033. netif_stop_queue (dev->net);
  1034. break;
  1035. default:
  1036. netif_dbg(dev, tx_err, dev->net,
  1037. "tx err %d\n", entry->urb->status);
  1038. break;
  1039. }
  1040. }
  1041. usb_autopm_put_interface_async(dev->intf);
  1042. (void) defer_bh(dev, skb, &dev->txq, tx_done);
  1043. }
  1044. /*-------------------------------------------------------------------------*/
  1045. void usbnet_tx_timeout (struct net_device *net)
  1046. {
  1047. struct usbnet *dev = netdev_priv(net);
  1048. unlink_urbs (dev, &dev->txq);
  1049. tasklet_schedule (&dev->bh);
  1050. /* this needs to be handled individually because the generic layer
  1051. * doesn't know what is sufficient and could not restore private
  1052. * information if a remedy of an unconditional reset were used.
  1053. */
  1054. if (dev->driver_info->recover)
  1055. (dev->driver_info->recover)(dev);
  1056. }
  1057. EXPORT_SYMBOL_GPL(usbnet_tx_timeout);
  1058. /*-------------------------------------------------------------------------*/
  1059. static int build_dma_sg(const struct sk_buff *skb, struct urb *urb)
  1060. {
  1061. unsigned num_sgs, total_len = 0;
  1062. int i, s = 0;
  1063. num_sgs = skb_shinfo(skb)->nr_frags + 1;
  1064. if (num_sgs == 1)
  1065. return 0;
  1066. /* reserve one for zero packet */
  1067. urb->sg = kmalloc((num_sgs + 1) * sizeof(struct scatterlist),
  1068. GFP_ATOMIC);
  1069. if (!urb->sg)
  1070. return -ENOMEM;
  1071. urb->num_sgs = num_sgs;
  1072. sg_init_table(urb->sg, urb->num_sgs + 1);
  1073. sg_set_buf(&urb->sg[s++], skb->data, skb_headlen(skb));
  1074. total_len += skb_headlen(skb);
  1075. for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
  1076. struct skb_frag_struct *f = &skb_shinfo(skb)->frags[i];
  1077. total_len += skb_frag_size(f);
  1078. sg_set_page(&urb->sg[i + s], f->page.p, f->size,
  1079. f->page_offset);
  1080. }
  1081. urb->transfer_buffer_length = total_len;
  1082. return 1;
  1083. }
  1084. netdev_tx_t usbnet_start_xmit (struct sk_buff *skb,
  1085. struct net_device *net)
  1086. {
  1087. struct usbnet *dev = netdev_priv(net);
  1088. int length;
  1089. struct urb *urb = NULL;
  1090. struct skb_data *entry;
  1091. struct driver_info *info = dev->driver_info;
  1092. unsigned long flags;
  1093. int retval;
  1094. if (skb)
  1095. skb_tx_timestamp(skb);
  1096. // some devices want funky USB-level framing, for
  1097. // win32 driver (usually) and/or hardware quirks
  1098. if (info->tx_fixup) {
  1099. skb = info->tx_fixup (dev, skb, GFP_ATOMIC);
  1100. if (!skb) {
  1101. /* packet collected; minidriver waiting for more */
  1102. if (info->flags & FLAG_MULTI_PACKET)
  1103. goto not_drop;
  1104. netif_dbg(dev, tx_err, dev->net, "can't tx_fixup skb\n");
  1105. goto drop;
  1106. }
  1107. }
  1108. if (!(urb = usb_alloc_urb (0, GFP_ATOMIC))) {
  1109. netif_dbg(dev, tx_err, dev->net, "no urb\n");
  1110. goto drop;
  1111. }
  1112. entry = (struct skb_data *) skb->cb;
  1113. entry->urb = urb;
  1114. entry->dev = dev;
  1115. usb_fill_bulk_urb (urb, dev->udev, dev->out,
  1116. skb->data, skb->len, tx_complete, skb);
  1117. if (dev->can_dma_sg) {
  1118. if (build_dma_sg(skb, urb) < 0)
  1119. goto drop;
  1120. }
  1121. length = urb->transfer_buffer_length;
  1122. /* don't assume the hardware handles USB_ZERO_PACKET
  1123. * NOTE: strictly conforming cdc-ether devices should expect
  1124. * the ZLP here, but ignore the one-byte packet.
  1125. * NOTE2: CDC NCM specification is different from CDC ECM when
  1126. * handling ZLP/short packets, so cdc_ncm driver will make short
  1127. * packet itself if needed.
  1128. */
  1129. if (length % dev->maxpacket == 0) {
  1130. if (!(info->flags & FLAG_SEND_ZLP)) {
  1131. if (!(info->flags & FLAG_MULTI_PACKET)) {
  1132. length++;
  1133. if (skb_tailroom(skb) && !urb->num_sgs) {
  1134. skb->data[skb->len] = 0;
  1135. __skb_put(skb, 1);
  1136. } else if (urb->num_sgs)
  1137. sg_set_buf(&urb->sg[urb->num_sgs++],
  1138. dev->padding_pkt, 1);
  1139. }
  1140. } else
  1141. urb->transfer_flags |= URB_ZERO_PACKET;
  1142. }
  1143. entry->length = urb->transfer_buffer_length = length;
  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");