usb.c 24 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151
  1. /*
  2. * Atheros CARL9170 driver
  3. *
  4. * USB - frontend
  5. *
  6. * Copyright 2008, Johannes Berg <johannes@sipsolutions.net>
  7. * Copyright 2009, 2010, Christian Lamparter <chunkeey@googlemail.com>
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation; either version 2 of the License, or
  12. * (at your option) any later version.
  13. *
  14. * This program is distributed in the hope that it will be useful,
  15. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  17. * GNU General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License
  20. * along with this program; see the file COPYING. If not, see
  21. * http://www.gnu.org/licenses/.
  22. *
  23. * This file incorporates work covered by the following copyright and
  24. * permission notice:
  25. * Copyright (c) 2007-2008 Atheros Communications, Inc.
  26. *
  27. * Permission to use, copy, modify, and/or distribute this software for any
  28. * purpose with or without fee is hereby granted, provided that the above
  29. * copyright notice and this permission notice appear in all copies.
  30. *
  31. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  32. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  33. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  34. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  35. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  36. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  37. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  38. */
  39. #include <linux/module.h>
  40. #include <linux/slab.h>
  41. #include <linux/usb.h>
  42. #include <linux/firmware.h>
  43. #include <linux/etherdevice.h>
  44. #include <linux/device.h>
  45. #include <net/mac80211.h>
  46. #include "carl9170.h"
  47. #include "cmd.h"
  48. #include "hw.h"
  49. #include "fwcmd.h"
  50. MODULE_AUTHOR("Johannes Berg <johannes@sipsolutions.net>");
  51. MODULE_AUTHOR("Christian Lamparter <chunkeey@googlemail.com>");
  52. MODULE_LICENSE("GPL");
  53. MODULE_DESCRIPTION("Atheros AR9170 802.11n USB wireless");
  54. MODULE_FIRMWARE(CARL9170FW_NAME);
  55. MODULE_ALIAS("ar9170usb");
  56. MODULE_ALIAS("arusb_lnx");
  57. /*
  58. * Note:
  59. *
  60. * Always update our wiki's device list (located at:
  61. * http://wireless.kernel.org/en/users/Drivers/ar9170/devices ),
  62. * whenever you add a new device.
  63. */
  64. static struct usb_device_id carl9170_usb_ids[] = {
  65. /* Atheros 9170 */
  66. { USB_DEVICE(0x0cf3, 0x9170) },
  67. /* Atheros TG121N */
  68. { USB_DEVICE(0x0cf3, 0x1001) },
  69. /* TP-Link TL-WN821N v2 */
  70. { USB_DEVICE(0x0cf3, 0x1002), .driver_info = CARL9170_WPS_BUTTON |
  71. CARL9170_ONE_LED },
  72. /* 3Com Dual Band 802.11n USB Adapter */
  73. { USB_DEVICE(0x0cf3, 0x1010) },
  74. /* H3C Dual Band 802.11n USB Adapter */
  75. { USB_DEVICE(0x0cf3, 0x1011) },
  76. /* Cace Airpcap NX */
  77. { USB_DEVICE(0xcace, 0x0300) },
  78. /* D-Link DWA 160 A1 */
  79. { USB_DEVICE(0x07d1, 0x3c10) },
  80. /* D-Link DWA 160 A2 */
  81. { USB_DEVICE(0x07d1, 0x3a09) },
  82. /* D-Link DWA 130 D */
  83. { USB_DEVICE(0x07d1, 0x3a0f) },
  84. /* Netgear WNA1000 */
  85. { USB_DEVICE(0x0846, 0x9040) },
  86. /* Netgear WNDA3100 (v1) */
  87. { USB_DEVICE(0x0846, 0x9010) },
  88. /* Netgear WN111 v2 */
  89. { USB_DEVICE(0x0846, 0x9001), .driver_info = CARL9170_ONE_LED },
  90. /* Zydas ZD1221 */
  91. { USB_DEVICE(0x0ace, 0x1221) },
  92. /* Proxim ORiNOCO 802.11n USB */
  93. { USB_DEVICE(0x1435, 0x0804) },
  94. /* WNC Generic 11n USB Dongle */
  95. { USB_DEVICE(0x1435, 0x0326) },
  96. /* ZyXEL NWD271N */
  97. { USB_DEVICE(0x0586, 0x3417) },
  98. /* Z-Com UB81 BG */
  99. { USB_DEVICE(0x0cde, 0x0023) },
  100. /* Z-Com UB82 ABG */
  101. { USB_DEVICE(0x0cde, 0x0026) },
  102. /* Sphairon Homelink 1202 */
  103. { USB_DEVICE(0x0cde, 0x0027) },
  104. /* Arcadyan WN7512 */
  105. { USB_DEVICE(0x083a, 0xf522) },
  106. /* Planex GWUS300 */
  107. { USB_DEVICE(0x2019, 0x5304) },
  108. /* IO-Data WNGDNUS2 */
  109. { USB_DEVICE(0x04bb, 0x093f) },
  110. /* NEC WL300NU-G */
  111. { USB_DEVICE(0x0409, 0x0249) },
  112. /* AVM FRITZ!WLAN USB Stick N */
  113. { USB_DEVICE(0x057c, 0x8401) },
  114. /* AVM FRITZ!WLAN USB Stick N 2.4 */
  115. { USB_DEVICE(0x057c, 0x8402) },
  116. /* Qwest/Actiontec 802AIN Wireless N USB Network Adapter */
  117. { USB_DEVICE(0x1668, 0x1200) },
  118. /* terminate */
  119. {}
  120. };
  121. MODULE_DEVICE_TABLE(usb, carl9170_usb_ids);
  122. static void carl9170_usb_submit_data_urb(struct ar9170 *ar)
  123. {
  124. struct urb *urb;
  125. int err;
  126. if (atomic_inc_return(&ar->tx_anch_urbs) > AR9170_NUM_TX_URBS)
  127. goto err_acc;
  128. urb = usb_get_from_anchor(&ar->tx_wait);
  129. if (!urb)
  130. goto err_acc;
  131. usb_anchor_urb(urb, &ar->tx_anch);
  132. err = usb_submit_urb(urb, GFP_ATOMIC);
  133. if (unlikely(err)) {
  134. if (net_ratelimit()) {
  135. dev_err(&ar->udev->dev, "tx submit failed (%d)\n",
  136. urb->status);
  137. }
  138. usb_unanchor_urb(urb);
  139. usb_anchor_urb(urb, &ar->tx_err);
  140. }
  141. usb_free_urb(urb);
  142. if (likely(err == 0))
  143. return;
  144. err_acc:
  145. atomic_dec(&ar->tx_anch_urbs);
  146. }
  147. static void carl9170_usb_tx_data_complete(struct urb *urb)
  148. {
  149. struct ar9170 *ar = (struct ar9170 *)
  150. usb_get_intfdata(usb_ifnum_to_if(urb->dev, 0));
  151. if (WARN_ON_ONCE(!ar)) {
  152. dev_kfree_skb_irq(urb->context);
  153. return;
  154. }
  155. atomic_dec(&ar->tx_anch_urbs);
  156. switch (urb->status) {
  157. /* everything is fine */
  158. case 0:
  159. carl9170_tx_callback(ar, (void *)urb->context);
  160. break;
  161. /* disconnect */
  162. case -ENOENT:
  163. case -ECONNRESET:
  164. case -ENODEV:
  165. case -ESHUTDOWN:
  166. /*
  167. * Defer the frame clean-up to the tasklet worker.
  168. * This is necessary, because carl9170_tx_drop
  169. * does not work in an irqsave context.
  170. */
  171. usb_anchor_urb(urb, &ar->tx_err);
  172. return;
  173. /* a random transmission error has occurred? */
  174. default:
  175. if (net_ratelimit()) {
  176. dev_err(&ar->udev->dev, "tx failed (%d)\n",
  177. urb->status);
  178. }
  179. usb_anchor_urb(urb, &ar->tx_err);
  180. break;
  181. }
  182. if (likely(IS_STARTED(ar)))
  183. carl9170_usb_submit_data_urb(ar);
  184. }
  185. static int carl9170_usb_submit_cmd_urb(struct ar9170 *ar)
  186. {
  187. struct urb *urb;
  188. int err;
  189. if (atomic_inc_return(&ar->tx_cmd_urbs) != 1) {
  190. atomic_dec(&ar->tx_cmd_urbs);
  191. return 0;
  192. }
  193. urb = usb_get_from_anchor(&ar->tx_cmd);
  194. if (!urb) {
  195. atomic_dec(&ar->tx_cmd_urbs);
  196. return 0;
  197. }
  198. usb_anchor_urb(urb, &ar->tx_anch);
  199. err = usb_submit_urb(urb, GFP_ATOMIC);
  200. if (unlikely(err)) {
  201. usb_unanchor_urb(urb);
  202. atomic_dec(&ar->tx_cmd_urbs);
  203. }
  204. usb_free_urb(urb);
  205. return err;
  206. }
  207. static void carl9170_usb_cmd_complete(struct urb *urb)
  208. {
  209. struct ar9170 *ar = urb->context;
  210. int err = 0;
  211. if (WARN_ON_ONCE(!ar))
  212. return;
  213. atomic_dec(&ar->tx_cmd_urbs);
  214. switch (urb->status) {
  215. /* everything is fine */
  216. case 0:
  217. break;
  218. /* disconnect */
  219. case -ENOENT:
  220. case -ECONNRESET:
  221. case -ENODEV:
  222. case -ESHUTDOWN:
  223. return;
  224. default:
  225. err = urb->status;
  226. break;
  227. }
  228. if (!IS_INITIALIZED(ar))
  229. return;
  230. if (err)
  231. dev_err(&ar->udev->dev, "submit cmd cb failed (%d).\n", err);
  232. err = carl9170_usb_submit_cmd_urb(ar);
  233. if (err)
  234. dev_err(&ar->udev->dev, "submit cmd failed (%d).\n", err);
  235. }
  236. static void carl9170_usb_rx_irq_complete(struct urb *urb)
  237. {
  238. struct ar9170 *ar = urb->context;
  239. if (WARN_ON_ONCE(!ar))
  240. return;
  241. switch (urb->status) {
  242. /* everything is fine */
  243. case 0:
  244. break;
  245. /* disconnect */
  246. case -ENOENT:
  247. case -ECONNRESET:
  248. case -ENODEV:
  249. case -ESHUTDOWN:
  250. return;
  251. default:
  252. goto resubmit;
  253. }
  254. carl9170_handle_command_response(ar, urb->transfer_buffer,
  255. urb->actual_length);
  256. resubmit:
  257. usb_anchor_urb(urb, &ar->rx_anch);
  258. if (unlikely(usb_submit_urb(urb, GFP_ATOMIC)))
  259. usb_unanchor_urb(urb);
  260. }
  261. static int carl9170_usb_submit_rx_urb(struct ar9170 *ar, gfp_t gfp)
  262. {
  263. struct urb *urb;
  264. int err = 0, runs = 0;
  265. while ((atomic_read(&ar->rx_anch_urbs) < AR9170_NUM_RX_URBS) &&
  266. (runs++ < AR9170_NUM_RX_URBS)) {
  267. err = -ENOSPC;
  268. urb = usb_get_from_anchor(&ar->rx_pool);
  269. if (urb) {
  270. usb_anchor_urb(urb, &ar->rx_anch);
  271. err = usb_submit_urb(urb, gfp);
  272. if (unlikely(err)) {
  273. usb_unanchor_urb(urb);
  274. usb_anchor_urb(urb, &ar->rx_pool);
  275. } else {
  276. atomic_dec(&ar->rx_pool_urbs);
  277. atomic_inc(&ar->rx_anch_urbs);
  278. }
  279. usb_free_urb(urb);
  280. }
  281. }
  282. return err;
  283. }
  284. static void carl9170_usb_rx_work(struct ar9170 *ar)
  285. {
  286. struct urb *urb;
  287. int i;
  288. for (i = 0; i < AR9170_NUM_RX_URBS_POOL; i++) {
  289. urb = usb_get_from_anchor(&ar->rx_work);
  290. if (!urb)
  291. break;
  292. atomic_dec(&ar->rx_work_urbs);
  293. if (IS_INITIALIZED(ar)) {
  294. carl9170_rx(ar, urb->transfer_buffer,
  295. urb->actual_length);
  296. }
  297. usb_anchor_urb(urb, &ar->rx_pool);
  298. atomic_inc(&ar->rx_pool_urbs);
  299. usb_free_urb(urb);
  300. carl9170_usb_submit_rx_urb(ar, GFP_ATOMIC);
  301. }
  302. }
  303. void carl9170_usb_handle_tx_err(struct ar9170 *ar)
  304. {
  305. struct urb *urb;
  306. while ((urb = usb_get_from_anchor(&ar->tx_err))) {
  307. struct sk_buff *skb = (void *)urb->context;
  308. carl9170_tx_drop(ar, skb);
  309. carl9170_tx_callback(ar, skb);
  310. usb_free_urb(urb);
  311. }
  312. }
  313. static void carl9170_usb_tasklet(unsigned long data)
  314. {
  315. struct ar9170 *ar = (struct ar9170 *) data;
  316. if (!IS_INITIALIZED(ar))
  317. return;
  318. carl9170_usb_rx_work(ar);
  319. /*
  320. * Strictly speaking: The tx scheduler is not part of the USB system.
  321. * But the rx worker returns frames back to the mac80211-stack and
  322. * this is the _perfect_ place to generate the next transmissions.
  323. */
  324. if (IS_STARTED(ar))
  325. carl9170_tx_scheduler(ar);
  326. }
  327. static void carl9170_usb_rx_complete(struct urb *urb)
  328. {
  329. struct ar9170 *ar = (struct ar9170 *)urb->context;
  330. int err;
  331. if (WARN_ON_ONCE(!ar))
  332. return;
  333. atomic_dec(&ar->rx_anch_urbs);
  334. switch (urb->status) {
  335. case 0:
  336. /* rx path */
  337. usb_anchor_urb(urb, &ar->rx_work);
  338. atomic_inc(&ar->rx_work_urbs);
  339. break;
  340. case -ENOENT:
  341. case -ECONNRESET:
  342. case -ENODEV:
  343. case -ESHUTDOWN:
  344. /* handle disconnect events*/
  345. return;
  346. default:
  347. /* handle all other errors */
  348. usb_anchor_urb(urb, &ar->rx_pool);
  349. atomic_inc(&ar->rx_pool_urbs);
  350. break;
  351. }
  352. err = carl9170_usb_submit_rx_urb(ar, GFP_ATOMIC);
  353. if (unlikely(err)) {
  354. /*
  355. * usb_submit_rx_urb reported a problem.
  356. * In case this is due to a rx buffer shortage,
  357. * elevate the tasklet worker priority to
  358. * the highest available level.
  359. */
  360. tasklet_hi_schedule(&ar->usb_tasklet);
  361. if (atomic_read(&ar->rx_anch_urbs) == 0) {
  362. /*
  363. * The system is too slow to cope with
  364. * the enormous workload. We have simply
  365. * run out of active rx urbs and this
  366. * unfortunatly leads to an unpredictable
  367. * device.
  368. */
  369. carl9170_restart(ar, CARL9170_RR_SLOW_SYSTEM);
  370. }
  371. } else {
  372. /*
  373. * Using anything less than _high_ priority absolutely
  374. * kills the rx performance my UP-System...
  375. */
  376. tasklet_hi_schedule(&ar->usb_tasklet);
  377. }
  378. }
  379. static struct urb *carl9170_usb_alloc_rx_urb(struct ar9170 *ar, gfp_t gfp)
  380. {
  381. struct urb *urb;
  382. void *buf;
  383. buf = kmalloc(ar->fw.rx_size, gfp);
  384. if (!buf)
  385. return NULL;
  386. urb = usb_alloc_urb(0, gfp);
  387. if (!urb) {
  388. kfree(buf);
  389. return NULL;
  390. }
  391. usb_fill_bulk_urb(urb, ar->udev, usb_rcvbulkpipe(ar->udev,
  392. AR9170_USB_EP_RX), buf, ar->fw.rx_size,
  393. carl9170_usb_rx_complete, ar);
  394. urb->transfer_flags |= URB_FREE_BUFFER;
  395. return urb;
  396. }
  397. static int carl9170_usb_send_rx_irq_urb(struct ar9170 *ar)
  398. {
  399. struct urb *urb = NULL;
  400. void *ibuf;
  401. int err = -ENOMEM;
  402. urb = usb_alloc_urb(0, GFP_KERNEL);
  403. if (!urb)
  404. goto out;
  405. ibuf = kmalloc(AR9170_USB_EP_CTRL_MAX, GFP_KERNEL);
  406. if (!ibuf)
  407. goto out;
  408. usb_fill_int_urb(urb, ar->udev, usb_rcvintpipe(ar->udev,
  409. AR9170_USB_EP_IRQ), ibuf, AR9170_USB_EP_CTRL_MAX,
  410. carl9170_usb_rx_irq_complete, ar, 1);
  411. urb->transfer_flags |= URB_FREE_BUFFER;
  412. usb_anchor_urb(urb, &ar->rx_anch);
  413. err = usb_submit_urb(urb, GFP_KERNEL);
  414. if (err)
  415. usb_unanchor_urb(urb);
  416. out:
  417. usb_free_urb(urb);
  418. return err;
  419. }
  420. static int carl9170_usb_init_rx_bulk_urbs(struct ar9170 *ar)
  421. {
  422. struct urb *urb;
  423. int i, err = -EINVAL;
  424. /*
  425. * The driver actively maintains a second shadow
  426. * pool for inactive, but fully-prepared rx urbs.
  427. *
  428. * The pool should help the driver to master huge
  429. * workload spikes without running the risk of
  430. * undersupplying the hardware or wasting time by
  431. * processing rx data (streams) inside the urb
  432. * completion (hardirq context).
  433. */
  434. for (i = 0; i < AR9170_NUM_RX_URBS_POOL; i++) {
  435. urb = carl9170_usb_alloc_rx_urb(ar, GFP_KERNEL);
  436. if (!urb) {
  437. err = -ENOMEM;
  438. goto err_out;
  439. }
  440. usb_anchor_urb(urb, &ar->rx_pool);
  441. atomic_inc(&ar->rx_pool_urbs);
  442. usb_free_urb(urb);
  443. }
  444. err = carl9170_usb_submit_rx_urb(ar, GFP_KERNEL);
  445. if (err)
  446. goto err_out;
  447. /* the device now waiting for the firmware. */
  448. carl9170_set_state_when(ar, CARL9170_STOPPED, CARL9170_IDLE);
  449. return 0;
  450. err_out:
  451. usb_scuttle_anchored_urbs(&ar->rx_pool);
  452. usb_scuttle_anchored_urbs(&ar->rx_work);
  453. usb_kill_anchored_urbs(&ar->rx_anch);
  454. return err;
  455. }
  456. static int carl9170_usb_flush(struct ar9170 *ar)
  457. {
  458. struct urb *urb;
  459. int ret, err = 0;
  460. while ((urb = usb_get_from_anchor(&ar->tx_wait))) {
  461. struct sk_buff *skb = (void *)urb->context;
  462. carl9170_tx_drop(ar, skb);
  463. carl9170_tx_callback(ar, skb);
  464. usb_free_urb(urb);
  465. }
  466. ret = usb_wait_anchor_empty_timeout(&ar->tx_cmd, 1000);
  467. if (ret == 0)
  468. err = -ETIMEDOUT;
  469. /* lets wait a while until the tx - queues are dried out */
  470. ret = usb_wait_anchor_empty_timeout(&ar->tx_anch, 1000);
  471. if (ret == 0)
  472. err = -ETIMEDOUT;
  473. usb_kill_anchored_urbs(&ar->tx_anch);
  474. carl9170_usb_handle_tx_err(ar);
  475. return err;
  476. }
  477. static void carl9170_usb_cancel_urbs(struct ar9170 *ar)
  478. {
  479. int err;
  480. carl9170_set_state(ar, CARL9170_UNKNOWN_STATE);
  481. err = carl9170_usb_flush(ar);
  482. if (err)
  483. dev_err(&ar->udev->dev, "stuck tx urbs!\n");
  484. usb_poison_anchored_urbs(&ar->tx_anch);
  485. carl9170_usb_handle_tx_err(ar);
  486. usb_poison_anchored_urbs(&ar->rx_anch);
  487. tasklet_kill(&ar->usb_tasklet);
  488. usb_scuttle_anchored_urbs(&ar->rx_work);
  489. usb_scuttle_anchored_urbs(&ar->rx_pool);
  490. usb_scuttle_anchored_urbs(&ar->tx_cmd);
  491. }
  492. int __carl9170_exec_cmd(struct ar9170 *ar, struct carl9170_cmd *cmd,
  493. const bool free_buf)
  494. {
  495. struct urb *urb;
  496. int err = 0;
  497. if (!IS_INITIALIZED(ar)) {
  498. err = -EPERM;
  499. goto err_free;
  500. }
  501. if (WARN_ON(cmd->hdr.len > CARL9170_MAX_CMD_LEN - 4)) {
  502. err = -EINVAL;
  503. goto err_free;
  504. }
  505. urb = usb_alloc_urb(0, GFP_ATOMIC);
  506. if (!urb) {
  507. err = -ENOMEM;
  508. goto err_free;
  509. }
  510. usb_fill_int_urb(urb, ar->udev, usb_sndintpipe(ar->udev,
  511. AR9170_USB_EP_CMD), cmd, cmd->hdr.len + 4,
  512. carl9170_usb_cmd_complete, ar, 1);
  513. if (free_buf)
  514. urb->transfer_flags |= URB_FREE_BUFFER;
  515. usb_anchor_urb(urb, &ar->tx_cmd);
  516. usb_free_urb(urb);
  517. return carl9170_usb_submit_cmd_urb(ar);
  518. err_free:
  519. if (free_buf)
  520. kfree(cmd);
  521. return err;
  522. }
  523. int carl9170_exec_cmd(struct ar9170 *ar, const enum carl9170_cmd_oids cmd,
  524. unsigned int plen, void *payload, unsigned int outlen, void *out)
  525. {
  526. int err = -ENOMEM;
  527. if (!IS_ACCEPTING_CMD(ar))
  528. return -EIO;
  529. if (!(cmd & CARL9170_CMD_ASYNC_FLAG))
  530. might_sleep();
  531. ar->cmd.hdr.len = plen;
  532. ar->cmd.hdr.cmd = cmd;
  533. /* writing multiple regs fills this buffer already */
  534. if (plen && payload != (u8 *)(ar->cmd.data))
  535. memcpy(ar->cmd.data, payload, plen);
  536. spin_lock_bh(&ar->cmd_lock);
  537. ar->readbuf = (u8 *)out;
  538. ar->readlen = outlen;
  539. spin_unlock_bh(&ar->cmd_lock);
  540. err = __carl9170_exec_cmd(ar, &ar->cmd, false);
  541. if (!(cmd & CARL9170_CMD_ASYNC_FLAG)) {
  542. err = wait_for_completion_timeout(&ar->cmd_wait, HZ);
  543. if (err == 0) {
  544. err = -ETIMEDOUT;
  545. goto err_unbuf;
  546. }
  547. if (ar->readlen != outlen) {
  548. err = -EMSGSIZE;
  549. goto err_unbuf;
  550. }
  551. }
  552. return 0;
  553. err_unbuf:
  554. /* Maybe the device was removed in the moment we were waiting? */
  555. if (IS_STARTED(ar)) {
  556. dev_err(&ar->udev->dev, "no command feedback "
  557. "received (%d).\n", err);
  558. /* provide some maybe useful debug information */
  559. print_hex_dump_bytes("carl9170 cmd: ", DUMP_PREFIX_NONE,
  560. &ar->cmd, plen + 4);
  561. carl9170_restart(ar, CARL9170_RR_COMMAND_TIMEOUT);
  562. }
  563. /* invalidate to avoid completing the next command prematurely */
  564. spin_lock_bh(&ar->cmd_lock);
  565. ar->readbuf = NULL;
  566. ar->readlen = 0;
  567. spin_unlock_bh(&ar->cmd_lock);
  568. return err;
  569. }
  570. void carl9170_usb_tx(struct ar9170 *ar, struct sk_buff *skb)
  571. {
  572. struct urb *urb;
  573. struct ar9170_stream *tx_stream;
  574. void *data;
  575. unsigned int len;
  576. if (!IS_STARTED(ar))
  577. goto err_drop;
  578. urb = usb_alloc_urb(0, GFP_ATOMIC);
  579. if (!urb)
  580. goto err_drop;
  581. if (ar->fw.tx_stream) {
  582. tx_stream = (void *) (skb->data - sizeof(*tx_stream));
  583. len = skb->len + sizeof(*tx_stream);
  584. tx_stream->length = cpu_to_le16(len);
  585. tx_stream->tag = cpu_to_le16(AR9170_TX_STREAM_TAG);
  586. data = tx_stream;
  587. } else {
  588. data = skb->data;
  589. len = skb->len;
  590. }
  591. usb_fill_bulk_urb(urb, ar->udev, usb_sndbulkpipe(ar->udev,
  592. AR9170_USB_EP_TX), data, len,
  593. carl9170_usb_tx_data_complete, skb);
  594. urb->transfer_flags |= URB_ZERO_PACKET;
  595. usb_anchor_urb(urb, &ar->tx_wait);
  596. usb_free_urb(urb);
  597. carl9170_usb_submit_data_urb(ar);
  598. return;
  599. err_drop:
  600. carl9170_tx_drop(ar, skb);
  601. carl9170_tx_callback(ar, skb);
  602. }
  603. static void carl9170_release_firmware(struct ar9170 *ar)
  604. {
  605. if (ar->fw.fw) {
  606. release_firmware(ar->fw.fw);
  607. memset(&ar->fw, 0, sizeof(ar->fw));
  608. }
  609. }
  610. void carl9170_usb_stop(struct ar9170 *ar)
  611. {
  612. int ret;
  613. carl9170_set_state_when(ar, CARL9170_IDLE, CARL9170_STOPPED);
  614. ret = carl9170_usb_flush(ar);
  615. if (ret)
  616. dev_err(&ar->udev->dev, "kill pending tx urbs.\n");
  617. usb_poison_anchored_urbs(&ar->tx_anch);
  618. carl9170_usb_handle_tx_err(ar);
  619. /* kill any pending command */
  620. spin_lock_bh(&ar->cmd_lock);
  621. ar->readlen = 0;
  622. spin_unlock_bh(&ar->cmd_lock);
  623. complete_all(&ar->cmd_wait);
  624. /* This is required to prevent an early completion on _start */
  625. INIT_COMPLETION(ar->cmd_wait);
  626. /*
  627. * Note:
  628. * So far we freed all tx urbs, but we won't dare to touch any rx urbs.
  629. * Else we would end up with a unresponsive device...
  630. */
  631. }
  632. int carl9170_usb_open(struct ar9170 *ar)
  633. {
  634. usb_unpoison_anchored_urbs(&ar->tx_anch);
  635. carl9170_set_state_when(ar, CARL9170_STOPPED, CARL9170_IDLE);
  636. return 0;
  637. }
  638. static int carl9170_usb_load_firmware(struct ar9170 *ar)
  639. {
  640. const u8 *data;
  641. u8 *buf;
  642. unsigned int transfer;
  643. size_t len;
  644. u32 addr;
  645. int err = 0;
  646. buf = kmalloc(4096, GFP_KERNEL);
  647. if (!buf) {
  648. err = -ENOMEM;
  649. goto err_out;
  650. }
  651. data = ar->fw.fw->data;
  652. len = ar->fw.fw->size;
  653. addr = ar->fw.address;
  654. /* this removes the miniboot image */
  655. data += ar->fw.offset;
  656. len -= ar->fw.offset;
  657. while (len) {
  658. transfer = min_t(unsigned int, len, 4096u);
  659. memcpy(buf, data, transfer);
  660. err = usb_control_msg(ar->udev, usb_sndctrlpipe(ar->udev, 0),
  661. 0x30 /* FW DL */, 0x40 | USB_DIR_OUT,
  662. addr >> 8, 0, buf, transfer, 100);
  663. if (err < 0) {
  664. kfree(buf);
  665. goto err_out;
  666. }
  667. len -= transfer;
  668. data += transfer;
  669. addr += transfer;
  670. }
  671. kfree(buf);
  672. err = usb_control_msg(ar->udev, usb_sndctrlpipe(ar->udev, 0),
  673. 0x31 /* FW DL COMPLETE */,
  674. 0x40 | USB_DIR_OUT, 0, 0, NULL, 0, 200);
  675. if (wait_for_completion_timeout(&ar->fw_boot_wait, HZ) == 0) {
  676. err = -ETIMEDOUT;
  677. goto err_out;
  678. }
  679. err = carl9170_echo_test(ar, 0x4a110123);
  680. if (err)
  681. goto err_out;
  682. /* firmware restarts cmd counter */
  683. ar->cmd_seq = -1;
  684. return 0;
  685. err_out:
  686. dev_err(&ar->udev->dev, "firmware upload failed (%d).\n", err);
  687. return err;
  688. }
  689. int carl9170_usb_restart(struct ar9170 *ar)
  690. {
  691. int err = 0;
  692. if (ar->intf->condition != USB_INTERFACE_BOUND)
  693. return 0;
  694. /* Disable command response sequence counter. */
  695. ar->cmd_seq = -2;
  696. err = carl9170_reboot(ar);
  697. carl9170_usb_stop(ar);
  698. if (err)
  699. goto err_out;
  700. tasklet_schedule(&ar->usb_tasklet);
  701. /* The reboot procedure can take quite a while to complete. */
  702. msleep(1100);
  703. err = carl9170_usb_open(ar);
  704. if (err)
  705. goto err_out;
  706. err = carl9170_usb_load_firmware(ar);
  707. if (err)
  708. goto err_out;
  709. return 0;
  710. err_out:
  711. carl9170_usb_cancel_urbs(ar);
  712. return err;
  713. }
  714. void carl9170_usb_reset(struct ar9170 *ar)
  715. {
  716. /*
  717. * This is the last resort to get the device going again
  718. * without any *user replugging action*.
  719. *
  720. * But there is a catch: usb_reset really is like a physical
  721. * *reconnect*. The mac80211 state will be lost in the process.
  722. * Therefore a userspace application, which is monitoring
  723. * the link must step in.
  724. */
  725. carl9170_usb_cancel_urbs(ar);
  726. carl9170_usb_stop(ar);
  727. usb_queue_reset_device(ar->intf);
  728. }
  729. static int carl9170_usb_init_device(struct ar9170 *ar)
  730. {
  731. int err;
  732. err = carl9170_usb_send_rx_irq_urb(ar);
  733. if (err)
  734. goto err_out;
  735. err = carl9170_usb_init_rx_bulk_urbs(ar);
  736. if (err)
  737. goto err_unrx;
  738. mutex_lock(&ar->mutex);
  739. err = carl9170_usb_load_firmware(ar);
  740. mutex_unlock(&ar->mutex);
  741. if (err)
  742. goto err_unrx;
  743. return 0;
  744. err_unrx:
  745. carl9170_usb_cancel_urbs(ar);
  746. err_out:
  747. return err;
  748. }
  749. static void carl9170_usb_firmware_failed(struct ar9170 *ar)
  750. {
  751. struct device *parent = ar->udev->dev.parent;
  752. struct usb_device *udev;
  753. /*
  754. * Store a copy of the usb_device pointer locally.
  755. * This is because device_release_driver initiates
  756. * carl9170_usb_disconnect, which in turn frees our
  757. * driver context (ar).
  758. */
  759. udev = ar->udev;
  760. complete(&ar->fw_load_wait);
  761. /* unbind anything failed */
  762. if (parent)
  763. device_lock(parent);
  764. device_release_driver(&udev->dev);
  765. if (parent)
  766. device_unlock(parent);
  767. usb_put_dev(udev);
  768. }
  769. static void carl9170_usb_firmware_finish(struct ar9170 *ar)
  770. {
  771. int err;
  772. err = carl9170_parse_firmware(ar);
  773. if (err)
  774. goto err_freefw;
  775. err = carl9170_usb_init_device(ar);
  776. if (err)
  777. goto err_freefw;
  778. err = carl9170_usb_open(ar);
  779. if (err)
  780. goto err_unrx;
  781. err = carl9170_register(ar);
  782. carl9170_usb_stop(ar);
  783. if (err)
  784. goto err_unrx;
  785. complete(&ar->fw_load_wait);
  786. usb_put_dev(ar->udev);
  787. return;
  788. err_unrx:
  789. carl9170_usb_cancel_urbs(ar);
  790. err_freefw:
  791. carl9170_release_firmware(ar);
  792. carl9170_usb_firmware_failed(ar);
  793. }
  794. static void carl9170_usb_firmware_step2(const struct firmware *fw,
  795. void *context)
  796. {
  797. struct ar9170 *ar = context;
  798. if (fw) {
  799. ar->fw.fw = fw;
  800. carl9170_usb_firmware_finish(ar);
  801. return;
  802. }
  803. dev_err(&ar->udev->dev, "firmware not found.\n");
  804. carl9170_usb_firmware_failed(ar);
  805. }
  806. static int carl9170_usb_probe(struct usb_interface *intf,
  807. const struct usb_device_id *id)
  808. {
  809. struct ar9170 *ar;
  810. struct usb_device *udev;
  811. int err;
  812. err = usb_reset_device(interface_to_usbdev(intf));
  813. if (err)
  814. return err;
  815. ar = carl9170_alloc(sizeof(*ar));
  816. if (IS_ERR(ar))
  817. return PTR_ERR(ar);
  818. udev = interface_to_usbdev(intf);
  819. usb_get_dev(udev);
  820. ar->udev = udev;
  821. ar->intf = intf;
  822. ar->features = id->driver_info;
  823. usb_set_intfdata(intf, ar);
  824. SET_IEEE80211_DEV(ar->hw, &intf->dev);
  825. init_usb_anchor(&ar->rx_anch);
  826. init_usb_anchor(&ar->rx_pool);
  827. init_usb_anchor(&ar->rx_work);
  828. init_usb_anchor(&ar->tx_wait);
  829. init_usb_anchor(&ar->tx_anch);
  830. init_usb_anchor(&ar->tx_cmd);
  831. init_usb_anchor(&ar->tx_err);
  832. init_completion(&ar->cmd_wait);
  833. init_completion(&ar->fw_boot_wait);
  834. init_completion(&ar->fw_load_wait);
  835. tasklet_init(&ar->usb_tasklet, carl9170_usb_tasklet,
  836. (unsigned long)ar);
  837. atomic_set(&ar->tx_cmd_urbs, 0);
  838. atomic_set(&ar->tx_anch_urbs, 0);
  839. atomic_set(&ar->rx_work_urbs, 0);
  840. atomic_set(&ar->rx_anch_urbs, 0);
  841. atomic_set(&ar->rx_pool_urbs, 0);
  842. ar->cmd_seq = -2;
  843. usb_get_dev(ar->udev);
  844. carl9170_set_state(ar, CARL9170_STOPPED);
  845. return request_firmware_nowait(THIS_MODULE, 1, CARL9170FW_NAME,
  846. &ar->udev->dev, GFP_KERNEL, ar, carl9170_usb_firmware_step2);
  847. }
  848. static void carl9170_usb_disconnect(struct usb_interface *intf)
  849. {
  850. struct ar9170 *ar = usb_get_intfdata(intf);
  851. struct usb_device *udev;
  852. if (WARN_ON(!ar))
  853. return;
  854. udev = ar->udev;
  855. wait_for_completion(&ar->fw_load_wait);
  856. if (IS_INITIALIZED(ar)) {
  857. carl9170_reboot(ar);
  858. carl9170_usb_stop(ar);
  859. }
  860. carl9170_usb_cancel_urbs(ar);
  861. carl9170_unregister(ar);
  862. usb_set_intfdata(intf, NULL);
  863. carl9170_release_firmware(ar);
  864. carl9170_free(ar);
  865. usb_put_dev(udev);
  866. }
  867. #ifdef CONFIG_PM
  868. static int carl9170_usb_suspend(struct usb_interface *intf,
  869. pm_message_t message)
  870. {
  871. struct ar9170 *ar = usb_get_intfdata(intf);
  872. if (!ar)
  873. return -ENODEV;
  874. carl9170_usb_cancel_urbs(ar);
  875. /*
  876. * firmware automatically reboots for usb suspend.
  877. */
  878. return 0;
  879. }
  880. static int carl9170_usb_resume(struct usb_interface *intf)
  881. {
  882. struct ar9170 *ar = usb_get_intfdata(intf);
  883. int err;
  884. if (!ar)
  885. return -ENODEV;
  886. usb_unpoison_anchored_urbs(&ar->rx_anch);
  887. err = carl9170_usb_init_device(ar);
  888. if (err)
  889. goto err_unrx;
  890. err = carl9170_usb_open(ar);
  891. if (err)
  892. goto err_unrx;
  893. return 0;
  894. err_unrx:
  895. carl9170_usb_cancel_urbs(ar);
  896. return err;
  897. }
  898. #endif /* CONFIG_PM */
  899. static struct usb_driver carl9170_driver = {
  900. .name = KBUILD_MODNAME,
  901. .probe = carl9170_usb_probe,
  902. .disconnect = carl9170_usb_disconnect,
  903. .id_table = carl9170_usb_ids,
  904. .soft_unbind = 1,
  905. #ifdef CONFIG_PM
  906. .suspend = carl9170_usb_suspend,
  907. .resume = carl9170_usb_resume,
  908. #endif /* CONFIG_PM */
  909. };
  910. static int __init carl9170_usb_init(void)
  911. {
  912. return usb_register(&carl9170_driver);
  913. }
  914. static void __exit carl9170_usb_exit(void)
  915. {
  916. usb_deregister(&carl9170_driver);
  917. }
  918. module_init(carl9170_usb_init);
  919. module_exit(carl9170_usb_exit);