usb.c 28 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077
  1. /*
  2. * Marvell Wireless LAN device driver: USB specific handling
  3. *
  4. * Copyright (C) 2012-2014, Marvell International Ltd.
  5. *
  6. * This software file (the "File") is distributed by Marvell International
  7. * Ltd. under the terms of the GNU General Public License Version 2, June 1991
  8. * (the "License"). You may use, redistribute and/or modify this File in
  9. * accordance with the terms and conditions of the License, a copy of which
  10. * is available by writing to the Free Software Foundation, Inc.,
  11. * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
  12. * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
  13. *
  14. * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
  15. * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
  16. * ARE EXPRESSLY DISCLAIMED. The License provides additional details about
  17. * this warranty disclaimer.
  18. */
  19. #include "main.h"
  20. #include "usb.h"
  21. #define USB_VERSION "1.0"
  22. static u8 user_rmmod;
  23. static struct mwifiex_if_ops usb_ops;
  24. static struct semaphore add_remove_card_sem;
  25. static struct usb_device_id mwifiex_usb_table[] = {
  26. /* 8766 */
  27. {USB_DEVICE(USB8XXX_VID, USB8766_PID_1)},
  28. {USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8766_PID_2,
  29. USB_CLASS_VENDOR_SPEC,
  30. USB_SUBCLASS_VENDOR_SPEC, 0xff)},
  31. /* 8797 */
  32. {USB_DEVICE(USB8XXX_VID, USB8797_PID_1)},
  33. {USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8797_PID_2,
  34. USB_CLASS_VENDOR_SPEC,
  35. USB_SUBCLASS_VENDOR_SPEC, 0xff)},
  36. /* 8897 */
  37. {USB_DEVICE(USB8XXX_VID, USB8897_PID_1)},
  38. {USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8897_PID_2,
  39. USB_CLASS_VENDOR_SPEC,
  40. USB_SUBCLASS_VENDOR_SPEC, 0xff)},
  41. { } /* Terminating entry */
  42. };
  43. MODULE_DEVICE_TABLE(usb, mwifiex_usb_table);
  44. static int mwifiex_usb_submit_rx_urb(struct urb_context *ctx, int size);
  45. /* This function handles received packet. Necessary action is taken based on
  46. * cmd/event/data.
  47. */
  48. static int mwifiex_usb_recv(struct mwifiex_adapter *adapter,
  49. struct sk_buff *skb, u8 ep)
  50. {
  51. struct device *dev = adapter->dev;
  52. u32 recv_type;
  53. __le32 tmp;
  54. int ret;
  55. if (adapter->hs_activated)
  56. mwifiex_process_hs_config(adapter);
  57. if (skb->len < INTF_HEADER_LEN) {
  58. dev_err(dev, "%s: invalid skb->len\n", __func__);
  59. return -1;
  60. }
  61. switch (ep) {
  62. case MWIFIEX_USB_EP_CMD_EVENT:
  63. dev_dbg(dev, "%s: EP_CMD_EVENT\n", __func__);
  64. skb_copy_from_linear_data(skb, &tmp, INTF_HEADER_LEN);
  65. recv_type = le32_to_cpu(tmp);
  66. skb_pull(skb, INTF_HEADER_LEN);
  67. switch (recv_type) {
  68. case MWIFIEX_USB_TYPE_CMD:
  69. if (skb->len > MWIFIEX_SIZE_OF_CMD_BUFFER) {
  70. dev_err(dev, "CMD: skb->len too large\n");
  71. ret = -1;
  72. goto exit_restore_skb;
  73. } else if (!adapter->curr_cmd) {
  74. dev_dbg(dev, "CMD: no curr_cmd\n");
  75. if (adapter->ps_state == PS_STATE_SLEEP_CFM) {
  76. mwifiex_process_sleep_confirm_resp(
  77. adapter, skb->data,
  78. skb->len);
  79. ret = 0;
  80. goto exit_restore_skb;
  81. }
  82. ret = -1;
  83. goto exit_restore_skb;
  84. }
  85. adapter->curr_cmd->resp_skb = skb;
  86. adapter->cmd_resp_received = true;
  87. break;
  88. case MWIFIEX_USB_TYPE_EVENT:
  89. if (skb->len < sizeof(u32)) {
  90. dev_err(dev, "EVENT: skb->len too small\n");
  91. ret = -1;
  92. goto exit_restore_skb;
  93. }
  94. skb_copy_from_linear_data(skb, &tmp, sizeof(u32));
  95. adapter->event_cause = le32_to_cpu(tmp);
  96. dev_dbg(dev, "event_cause %#x\n", adapter->event_cause);
  97. if (skb->len > MAX_EVENT_SIZE) {
  98. dev_err(dev, "EVENT: event body too large\n");
  99. ret = -1;
  100. goto exit_restore_skb;
  101. }
  102. memcpy(adapter->event_body, skb->data +
  103. MWIFIEX_EVENT_HEADER_LEN, skb->len);
  104. adapter->event_received = true;
  105. adapter->event_skb = skb;
  106. break;
  107. default:
  108. dev_err(dev, "unknown recv_type %#x\n", recv_type);
  109. return -1;
  110. }
  111. break;
  112. case MWIFIEX_USB_EP_DATA:
  113. dev_dbg(dev, "%s: EP_DATA\n", __func__);
  114. if (skb->len > MWIFIEX_RX_DATA_BUF_SIZE) {
  115. dev_err(dev, "DATA: skb->len too large\n");
  116. return -1;
  117. }
  118. skb_queue_tail(&adapter->rx_data_q, skb);
  119. adapter->data_received = true;
  120. atomic_inc(&adapter->rx_pending);
  121. break;
  122. default:
  123. dev_err(dev, "%s: unknown endport %#x\n", __func__, ep);
  124. return -1;
  125. }
  126. return -EINPROGRESS;
  127. exit_restore_skb:
  128. /* The buffer will be reused for further cmds/events */
  129. skb_push(skb, INTF_HEADER_LEN);
  130. return ret;
  131. }
  132. static void mwifiex_usb_rx_complete(struct urb *urb)
  133. {
  134. struct urb_context *context = (struct urb_context *)urb->context;
  135. struct mwifiex_adapter *adapter = context->adapter;
  136. struct sk_buff *skb = context->skb;
  137. struct usb_card_rec *card;
  138. int recv_length = urb->actual_length;
  139. int size, status;
  140. if (!adapter || !adapter->card) {
  141. pr_err("mwifiex adapter or card structure is not valid\n");
  142. return;
  143. }
  144. card = (struct usb_card_rec *)adapter->card;
  145. if (card->rx_cmd_ep == context->ep)
  146. atomic_dec(&card->rx_cmd_urb_pending);
  147. else
  148. atomic_dec(&card->rx_data_urb_pending);
  149. if (recv_length) {
  150. if (urb->status || (adapter->surprise_removed)) {
  151. dev_err(adapter->dev,
  152. "URB status is failed: %d\n", urb->status);
  153. /* Do not free skb in case of command ep */
  154. if (card->rx_cmd_ep != context->ep)
  155. dev_kfree_skb_any(skb);
  156. goto setup_for_next;
  157. }
  158. if (skb->len > recv_length)
  159. skb_trim(skb, recv_length);
  160. else
  161. skb_put(skb, recv_length - skb->len);
  162. status = mwifiex_usb_recv(adapter, skb, context->ep);
  163. dev_dbg(adapter->dev, "info: recv_length=%d, status=%d\n",
  164. recv_length, status);
  165. if (status == -EINPROGRESS) {
  166. queue_work(adapter->workqueue, &adapter->main_work);
  167. /* urb for data_ep is re-submitted now;
  168. * urb for cmd_ep will be re-submitted in callback
  169. * mwifiex_usb_recv_complete
  170. */
  171. if (card->rx_cmd_ep == context->ep)
  172. return;
  173. } else {
  174. if (status == -1)
  175. dev_err(adapter->dev,
  176. "received data processing failed!\n");
  177. /* Do not free skb in case of command ep */
  178. if (card->rx_cmd_ep != context->ep)
  179. dev_kfree_skb_any(skb);
  180. }
  181. } else if (urb->status) {
  182. if (!adapter->is_suspended) {
  183. dev_warn(adapter->dev,
  184. "Card is removed: %d\n", urb->status);
  185. adapter->surprise_removed = true;
  186. }
  187. dev_kfree_skb_any(skb);
  188. return;
  189. } else {
  190. /* Do not free skb in case of command ep */
  191. if (card->rx_cmd_ep != context->ep)
  192. dev_kfree_skb_any(skb);
  193. /* fall through setup_for_next */
  194. }
  195. setup_for_next:
  196. if (card->rx_cmd_ep == context->ep)
  197. size = MWIFIEX_RX_CMD_BUF_SIZE;
  198. else
  199. size = MWIFIEX_RX_DATA_BUF_SIZE;
  200. if (card->rx_cmd_ep == context->ep) {
  201. mwifiex_usb_submit_rx_urb(context, size);
  202. } else {
  203. context->skb = NULL;
  204. if (atomic_read(&adapter->rx_pending) <= HIGH_RX_PENDING)
  205. mwifiex_usb_submit_rx_urb(context, size);
  206. }
  207. return;
  208. }
  209. static void mwifiex_usb_tx_complete(struct urb *urb)
  210. {
  211. struct urb_context *context = (struct urb_context *)(urb->context);
  212. struct mwifiex_adapter *adapter = context->adapter;
  213. struct usb_card_rec *card = adapter->card;
  214. dev_dbg(adapter->dev, "%s: status: %d\n", __func__, urb->status);
  215. if (context->ep == card->tx_cmd_ep) {
  216. dev_dbg(adapter->dev, "%s: CMD\n", __func__);
  217. atomic_dec(&card->tx_cmd_urb_pending);
  218. adapter->cmd_sent = false;
  219. } else {
  220. dev_dbg(adapter->dev, "%s: DATA\n", __func__);
  221. atomic_dec(&card->tx_data_urb_pending);
  222. mwifiex_write_data_complete(adapter, context->skb, 0,
  223. urb->status ? -1 : 0);
  224. }
  225. queue_work(adapter->workqueue, &adapter->main_work);
  226. return;
  227. }
  228. static int mwifiex_usb_submit_rx_urb(struct urb_context *ctx, int size)
  229. {
  230. struct mwifiex_adapter *adapter = ctx->adapter;
  231. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  232. if (card->rx_cmd_ep != ctx->ep) {
  233. ctx->skb = dev_alloc_skb(size);
  234. if (!ctx->skb) {
  235. dev_err(adapter->dev,
  236. "%s: dev_alloc_skb failed\n", __func__);
  237. return -ENOMEM;
  238. }
  239. }
  240. usb_fill_bulk_urb(ctx->urb, card->udev,
  241. usb_rcvbulkpipe(card->udev, ctx->ep), ctx->skb->data,
  242. size, mwifiex_usb_rx_complete, (void *)ctx);
  243. if (card->rx_cmd_ep == ctx->ep)
  244. atomic_inc(&card->rx_cmd_urb_pending);
  245. else
  246. atomic_inc(&card->rx_data_urb_pending);
  247. if (usb_submit_urb(ctx->urb, GFP_ATOMIC)) {
  248. dev_err(adapter->dev, "usb_submit_urb failed\n");
  249. dev_kfree_skb_any(ctx->skb);
  250. ctx->skb = NULL;
  251. if (card->rx_cmd_ep == ctx->ep)
  252. atomic_dec(&card->rx_cmd_urb_pending);
  253. else
  254. atomic_dec(&card->rx_data_urb_pending);
  255. return -1;
  256. }
  257. return 0;
  258. }
  259. static void mwifiex_usb_free(struct usb_card_rec *card)
  260. {
  261. int i;
  262. if (atomic_read(&card->rx_cmd_urb_pending) && card->rx_cmd.urb)
  263. usb_kill_urb(card->rx_cmd.urb);
  264. usb_free_urb(card->rx_cmd.urb);
  265. card->rx_cmd.urb = NULL;
  266. if (atomic_read(&card->rx_data_urb_pending))
  267. for (i = 0; i < MWIFIEX_RX_DATA_URB; i++)
  268. if (card->rx_data_list[i].urb)
  269. usb_kill_urb(card->rx_data_list[i].urb);
  270. for (i = 0; i < MWIFIEX_RX_DATA_URB; i++) {
  271. usb_free_urb(card->rx_data_list[i].urb);
  272. card->rx_data_list[i].urb = NULL;
  273. }
  274. for (i = 0; i < MWIFIEX_TX_DATA_URB; i++) {
  275. usb_free_urb(card->tx_data_list[i].urb);
  276. card->tx_data_list[i].urb = NULL;
  277. }
  278. usb_free_urb(card->tx_cmd.urb);
  279. card->tx_cmd.urb = NULL;
  280. return;
  281. }
  282. /* This function probes an mwifiex device and registers it. It allocates
  283. * the card structure, initiates the device registration and initialization
  284. * procedure by adding a logical interface.
  285. */
  286. static int mwifiex_usb_probe(struct usb_interface *intf,
  287. const struct usb_device_id *id)
  288. {
  289. struct usb_device *udev = interface_to_usbdev(intf);
  290. struct usb_host_interface *iface_desc = intf->cur_altsetting;
  291. struct usb_endpoint_descriptor *epd;
  292. int ret, i;
  293. struct usb_card_rec *card;
  294. u16 id_vendor, id_product, bcd_device, bcd_usb;
  295. card = kzalloc(sizeof(struct usb_card_rec), GFP_KERNEL);
  296. if (!card)
  297. return -ENOMEM;
  298. id_vendor = le16_to_cpu(udev->descriptor.idVendor);
  299. id_product = le16_to_cpu(udev->descriptor.idProduct);
  300. bcd_device = le16_to_cpu(udev->descriptor.bcdDevice);
  301. bcd_usb = le16_to_cpu(udev->descriptor.bcdUSB);
  302. pr_debug("info: VID/PID = %X/%X, Boot2 version = %X\n",
  303. id_vendor, id_product, bcd_device);
  304. /* PID_1 is used for firmware downloading only */
  305. switch (id_product) {
  306. case USB8766_PID_1:
  307. case USB8797_PID_1:
  308. case USB8897_PID_1:
  309. card->usb_boot_state = USB8XXX_FW_DNLD;
  310. break;
  311. case USB8766_PID_2:
  312. case USB8797_PID_2:
  313. case USB8897_PID_2:
  314. card->usb_boot_state = USB8XXX_FW_READY;
  315. break;
  316. default:
  317. pr_warn("unknown id_product %#x\n", id_product);
  318. card->usb_boot_state = USB8XXX_FW_DNLD;
  319. break;
  320. }
  321. card->udev = udev;
  322. card->intf = intf;
  323. pr_debug("info: bcdUSB=%#x Device Class=%#x SubClass=%#x Protocol=%#x\n",
  324. udev->descriptor.bcdUSB, udev->descriptor.bDeviceClass,
  325. udev->descriptor.bDeviceSubClass,
  326. udev->descriptor.bDeviceProtocol);
  327. for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
  328. epd = &iface_desc->endpoint[i].desc;
  329. if (usb_endpoint_dir_in(epd) &&
  330. usb_endpoint_num(epd) == MWIFIEX_USB_EP_CMD_EVENT &&
  331. usb_endpoint_xfer_bulk(epd)) {
  332. pr_debug("info: bulk IN: max pkt size: %d, addr: %d\n",
  333. le16_to_cpu(epd->wMaxPacketSize),
  334. epd->bEndpointAddress);
  335. card->rx_cmd_ep = usb_endpoint_num(epd);
  336. atomic_set(&card->rx_cmd_urb_pending, 0);
  337. }
  338. if (usb_endpoint_dir_in(epd) &&
  339. usb_endpoint_num(epd) == MWIFIEX_USB_EP_DATA &&
  340. usb_endpoint_xfer_bulk(epd)) {
  341. pr_debug("info: bulk IN: max pkt size: %d, addr: %d\n",
  342. le16_to_cpu(epd->wMaxPacketSize),
  343. epd->bEndpointAddress);
  344. card->rx_data_ep = usb_endpoint_num(epd);
  345. atomic_set(&card->rx_data_urb_pending, 0);
  346. }
  347. if (usb_endpoint_dir_out(epd) &&
  348. usb_endpoint_num(epd) == MWIFIEX_USB_EP_DATA &&
  349. usb_endpoint_xfer_bulk(epd)) {
  350. pr_debug("info: bulk OUT: max pkt size: %d, addr: %d\n",
  351. le16_to_cpu(epd->wMaxPacketSize),
  352. epd->bEndpointAddress);
  353. card->tx_data_ep = usb_endpoint_num(epd);
  354. atomic_set(&card->tx_data_urb_pending, 0);
  355. }
  356. if (usb_endpoint_dir_out(epd) &&
  357. usb_endpoint_num(epd) == MWIFIEX_USB_EP_CMD_EVENT &&
  358. usb_endpoint_xfer_bulk(epd)) {
  359. pr_debug("info: bulk OUT: max pkt size: %d, addr: %d\n",
  360. le16_to_cpu(epd->wMaxPacketSize),
  361. epd->bEndpointAddress);
  362. card->tx_cmd_ep = usb_endpoint_num(epd);
  363. atomic_set(&card->tx_cmd_urb_pending, 0);
  364. card->bulk_out_maxpktsize =
  365. le16_to_cpu(epd->wMaxPacketSize);
  366. }
  367. }
  368. usb_set_intfdata(intf, card);
  369. ret = mwifiex_add_card(card, &add_remove_card_sem, &usb_ops,
  370. MWIFIEX_USB);
  371. if (ret) {
  372. pr_err("%s: mwifiex_add_card failed: %d\n", __func__, ret);
  373. usb_reset_device(udev);
  374. kfree(card);
  375. return ret;
  376. }
  377. usb_get_dev(udev);
  378. return 0;
  379. }
  380. /* Kernel needs to suspend all functions separately. Therefore all
  381. * registered functions must have drivers with suspend and resume
  382. * methods. Failing that the kernel simply removes the whole card.
  383. *
  384. * If already not suspended, this function allocates and sends a
  385. * 'host sleep activate' request to the firmware and turns off the traffic.
  386. */
  387. static int mwifiex_usb_suspend(struct usb_interface *intf, pm_message_t message)
  388. {
  389. struct usb_card_rec *card = usb_get_intfdata(intf);
  390. struct mwifiex_adapter *adapter;
  391. int i;
  392. if (!card || !card->adapter) {
  393. pr_err("%s: card or card->adapter is NULL\n", __func__);
  394. return 0;
  395. }
  396. adapter = card->adapter;
  397. if (unlikely(adapter->is_suspended))
  398. dev_warn(adapter->dev, "Device already suspended\n");
  399. mwifiex_enable_hs(adapter);
  400. /* 'is_suspended' flag indicates device is suspended.
  401. * It must be set here before the usb_kill_urb() calls. Reason
  402. * is in the complete handlers, urb->status(= -ENOENT) and
  403. * this flag is used in combination to distinguish between a
  404. * 'suspended' state and a 'disconnect' one.
  405. */
  406. adapter->is_suspended = true;
  407. adapter->hs_enabling = false;
  408. if (atomic_read(&card->rx_cmd_urb_pending) && card->rx_cmd.urb)
  409. usb_kill_urb(card->rx_cmd.urb);
  410. if (atomic_read(&card->rx_data_urb_pending))
  411. for (i = 0; i < MWIFIEX_RX_DATA_URB; i++)
  412. if (card->rx_data_list[i].urb)
  413. usb_kill_urb(card->rx_data_list[i].urb);
  414. for (i = 0; i < MWIFIEX_TX_DATA_URB; i++)
  415. if (card->tx_data_list[i].urb)
  416. usb_kill_urb(card->tx_data_list[i].urb);
  417. if (card->tx_cmd.urb)
  418. usb_kill_urb(card->tx_cmd.urb);
  419. return 0;
  420. }
  421. /* Kernel needs to suspend all functions separately. Therefore all
  422. * registered functions must have drivers with suspend and resume
  423. * methods. Failing that the kernel simply removes the whole card.
  424. *
  425. * If already not resumed, this function turns on the traffic and
  426. * sends a 'host sleep cancel' request to the firmware.
  427. */
  428. static int mwifiex_usb_resume(struct usb_interface *intf)
  429. {
  430. struct usb_card_rec *card = usb_get_intfdata(intf);
  431. struct mwifiex_adapter *adapter;
  432. int i;
  433. if (!card || !card->adapter) {
  434. pr_err("%s: card or card->adapter is NULL\n", __func__);
  435. return 0;
  436. }
  437. adapter = card->adapter;
  438. if (unlikely(!adapter->is_suspended)) {
  439. dev_warn(adapter->dev, "Device already resumed\n");
  440. return 0;
  441. }
  442. /* Indicate device resumed. The netdev queue will be resumed only
  443. * after the urbs have been re-submitted
  444. */
  445. adapter->is_suspended = false;
  446. if (!atomic_read(&card->rx_data_urb_pending))
  447. for (i = 0; i < MWIFIEX_RX_DATA_URB; i++)
  448. mwifiex_usb_submit_rx_urb(&card->rx_data_list[i],
  449. MWIFIEX_RX_DATA_BUF_SIZE);
  450. if (!atomic_read(&card->rx_cmd_urb_pending)) {
  451. card->rx_cmd.skb = dev_alloc_skb(MWIFIEX_RX_CMD_BUF_SIZE);
  452. if (card->rx_cmd.skb)
  453. mwifiex_usb_submit_rx_urb(&card->rx_cmd,
  454. MWIFIEX_RX_CMD_BUF_SIZE);
  455. }
  456. /* Disable Host Sleep */
  457. if (adapter->hs_activated)
  458. mwifiex_cancel_hs(mwifiex_get_priv(adapter,
  459. MWIFIEX_BSS_ROLE_ANY),
  460. MWIFIEX_ASYNC_CMD);
  461. return 0;
  462. }
  463. static void mwifiex_usb_disconnect(struct usb_interface *intf)
  464. {
  465. struct usb_card_rec *card = usb_get_intfdata(intf);
  466. struct mwifiex_adapter *adapter;
  467. if (!card || !card->adapter) {
  468. pr_err("%s: card or card->adapter is NULL\n", __func__);
  469. return;
  470. }
  471. adapter = card->adapter;
  472. if (!adapter->priv_num)
  473. return;
  474. if (user_rmmod) {
  475. #ifdef CONFIG_PM
  476. if (adapter->is_suspended)
  477. mwifiex_usb_resume(intf);
  478. #endif
  479. mwifiex_deauthenticate_all(adapter);
  480. mwifiex_init_shutdown_fw(mwifiex_get_priv(adapter,
  481. MWIFIEX_BSS_ROLE_ANY),
  482. MWIFIEX_FUNC_SHUTDOWN);
  483. }
  484. mwifiex_usb_free(card);
  485. dev_dbg(adapter->dev, "%s: removing card\n", __func__);
  486. mwifiex_remove_card(adapter, &add_remove_card_sem);
  487. usb_set_intfdata(intf, NULL);
  488. usb_put_dev(interface_to_usbdev(intf));
  489. kfree(card);
  490. return;
  491. }
  492. static struct usb_driver mwifiex_usb_driver = {
  493. .name = "mwifiex_usb",
  494. .probe = mwifiex_usb_probe,
  495. .disconnect = mwifiex_usb_disconnect,
  496. .id_table = mwifiex_usb_table,
  497. .suspend = mwifiex_usb_suspend,
  498. .resume = mwifiex_usb_resume,
  499. .soft_unbind = 1,
  500. };
  501. static int mwifiex_usb_tx_init(struct mwifiex_adapter *adapter)
  502. {
  503. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  504. int i;
  505. card->tx_cmd.adapter = adapter;
  506. card->tx_cmd.ep = card->tx_cmd_ep;
  507. card->tx_cmd.urb = usb_alloc_urb(0, GFP_KERNEL);
  508. if (!card->tx_cmd.urb) {
  509. dev_err(adapter->dev, "tx_cmd.urb allocation failed\n");
  510. return -ENOMEM;
  511. }
  512. card->tx_data_ix = 0;
  513. for (i = 0; i < MWIFIEX_TX_DATA_URB; i++) {
  514. card->tx_data_list[i].adapter = adapter;
  515. card->tx_data_list[i].ep = card->tx_data_ep;
  516. card->tx_data_list[i].urb = usb_alloc_urb(0, GFP_KERNEL);
  517. if (!card->tx_data_list[i].urb) {
  518. dev_err(adapter->dev,
  519. "tx_data_list[] urb allocation failed\n");
  520. return -ENOMEM;
  521. }
  522. }
  523. return 0;
  524. }
  525. static int mwifiex_usb_rx_init(struct mwifiex_adapter *adapter)
  526. {
  527. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  528. int i;
  529. card->rx_cmd.adapter = adapter;
  530. card->rx_cmd.ep = card->rx_cmd_ep;
  531. card->rx_cmd.urb = usb_alloc_urb(0, GFP_KERNEL);
  532. if (!card->rx_cmd.urb) {
  533. dev_err(adapter->dev, "rx_cmd.urb allocation failed\n");
  534. return -ENOMEM;
  535. }
  536. card->rx_cmd.skb = dev_alloc_skb(MWIFIEX_RX_CMD_BUF_SIZE);
  537. if (!card->rx_cmd.skb) {
  538. dev_err(adapter->dev, "rx_cmd.skb allocation failed\n");
  539. return -ENOMEM;
  540. }
  541. if (mwifiex_usb_submit_rx_urb(&card->rx_cmd, MWIFIEX_RX_CMD_BUF_SIZE))
  542. return -1;
  543. for (i = 0; i < MWIFIEX_RX_DATA_URB; i++) {
  544. card->rx_data_list[i].adapter = adapter;
  545. card->rx_data_list[i].ep = card->rx_data_ep;
  546. card->rx_data_list[i].urb = usb_alloc_urb(0, GFP_KERNEL);
  547. if (!card->rx_data_list[i].urb) {
  548. dev_err(adapter->dev,
  549. "rx_data_list[] urb allocation failed\n");
  550. return -1;
  551. }
  552. if (mwifiex_usb_submit_rx_urb(&card->rx_data_list[i],
  553. MWIFIEX_RX_DATA_BUF_SIZE))
  554. return -1;
  555. }
  556. return 0;
  557. }
  558. static int mwifiex_write_data_sync(struct mwifiex_adapter *adapter, u8 *pbuf,
  559. u32 *len, u8 ep, u32 timeout)
  560. {
  561. struct usb_card_rec *card = adapter->card;
  562. int actual_length, ret;
  563. if (!(*len % card->bulk_out_maxpktsize))
  564. (*len)++;
  565. /* Send the data block */
  566. ret = usb_bulk_msg(card->udev, usb_sndbulkpipe(card->udev, ep), pbuf,
  567. *len, &actual_length, timeout);
  568. if (ret) {
  569. dev_err(adapter->dev, "usb_bulk_msg for tx failed: %d\n", ret);
  570. return ret;
  571. }
  572. *len = actual_length;
  573. return ret;
  574. }
  575. static int mwifiex_read_data_sync(struct mwifiex_adapter *adapter, u8 *pbuf,
  576. u32 *len, u8 ep, u32 timeout)
  577. {
  578. struct usb_card_rec *card = adapter->card;
  579. int actual_length, ret;
  580. /* Receive the data response */
  581. ret = usb_bulk_msg(card->udev, usb_rcvbulkpipe(card->udev, ep), pbuf,
  582. *len, &actual_length, timeout);
  583. if (ret) {
  584. dev_err(adapter->dev, "usb_bulk_msg for rx failed: %d\n", ret);
  585. return ret;
  586. }
  587. *len = actual_length;
  588. return ret;
  589. }
  590. /* This function write a command/data packet to card. */
  591. static int mwifiex_usb_host_to_card(struct mwifiex_adapter *adapter, u8 ep,
  592. struct sk_buff *skb,
  593. struct mwifiex_tx_param *tx_param)
  594. {
  595. struct usb_card_rec *card = adapter->card;
  596. struct urb_context *context;
  597. u8 *data = (u8 *)skb->data;
  598. struct urb *tx_urb;
  599. if (adapter->is_suspended) {
  600. dev_err(adapter->dev,
  601. "%s: not allowed while suspended\n", __func__);
  602. return -1;
  603. }
  604. if (adapter->surprise_removed) {
  605. dev_err(adapter->dev, "%s: device removed\n", __func__);
  606. return -1;
  607. }
  608. if (ep == card->tx_data_ep &&
  609. atomic_read(&card->tx_data_urb_pending) >= MWIFIEX_TX_DATA_URB) {
  610. return -EBUSY;
  611. }
  612. dev_dbg(adapter->dev, "%s: ep=%d\n", __func__, ep);
  613. if (ep == card->tx_cmd_ep) {
  614. context = &card->tx_cmd;
  615. } else {
  616. if (card->tx_data_ix >= MWIFIEX_TX_DATA_URB)
  617. card->tx_data_ix = 0;
  618. context = &card->tx_data_list[card->tx_data_ix++];
  619. }
  620. context->adapter = adapter;
  621. context->ep = ep;
  622. context->skb = skb;
  623. tx_urb = context->urb;
  624. usb_fill_bulk_urb(tx_urb, card->udev, usb_sndbulkpipe(card->udev, ep),
  625. data, skb->len, mwifiex_usb_tx_complete,
  626. (void *)context);
  627. tx_urb->transfer_flags |= URB_ZERO_PACKET;
  628. if (ep == card->tx_cmd_ep)
  629. atomic_inc(&card->tx_cmd_urb_pending);
  630. else
  631. atomic_inc(&card->tx_data_urb_pending);
  632. if (usb_submit_urb(tx_urb, GFP_ATOMIC)) {
  633. dev_err(adapter->dev, "%s: usb_submit_urb failed\n", __func__);
  634. if (ep == card->tx_cmd_ep) {
  635. atomic_dec(&card->tx_cmd_urb_pending);
  636. } else {
  637. atomic_dec(&card->tx_data_urb_pending);
  638. if (card->tx_data_ix)
  639. card->tx_data_ix--;
  640. else
  641. card->tx_data_ix = MWIFIEX_TX_DATA_URB;
  642. }
  643. return -1;
  644. } else {
  645. if (ep == card->tx_data_ep &&
  646. atomic_read(&card->tx_data_urb_pending) ==
  647. MWIFIEX_TX_DATA_URB)
  648. return -ENOSR;
  649. }
  650. return -EINPROGRESS;
  651. }
  652. /* This function register usb device and initialize parameter. */
  653. static int mwifiex_register_dev(struct mwifiex_adapter *adapter)
  654. {
  655. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  656. card->adapter = adapter;
  657. adapter->dev = &card->udev->dev;
  658. switch (le16_to_cpu(card->udev->descriptor.idProduct)) {
  659. case USB8897_PID_1:
  660. case USB8897_PID_2:
  661. adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_4K;
  662. strcpy(adapter->fw_name, USB8897_DEFAULT_FW_NAME);
  663. break;
  664. case USB8766_PID_1:
  665. case USB8766_PID_2:
  666. adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_2K;
  667. strcpy(adapter->fw_name, USB8766_DEFAULT_FW_NAME);
  668. break;
  669. case USB8797_PID_1:
  670. case USB8797_PID_2:
  671. default:
  672. adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_2K;
  673. strcpy(adapter->fw_name, USB8797_DEFAULT_FW_NAME);
  674. break;
  675. }
  676. return 0;
  677. }
  678. static void mwifiex_unregister_dev(struct mwifiex_adapter *adapter)
  679. {
  680. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  681. card->adapter = NULL;
  682. }
  683. static int mwifiex_prog_fw_w_helper(struct mwifiex_adapter *adapter,
  684. struct mwifiex_fw_image *fw)
  685. {
  686. int ret = 0;
  687. u8 *firmware = fw->fw_buf, *recv_buff;
  688. u32 retries = USB8XXX_FW_MAX_RETRY, dlen;
  689. u32 fw_seqnum = 0, tlen = 0, dnld_cmd = 0;
  690. struct fw_data *fwdata;
  691. struct fw_sync_header sync_fw;
  692. u8 check_winner = 1;
  693. if (!firmware) {
  694. dev_err(adapter->dev,
  695. "No firmware image found! Terminating download\n");
  696. ret = -1;
  697. goto fw_exit;
  698. }
  699. /* Allocate memory for transmit */
  700. fwdata = kzalloc(FW_DNLD_TX_BUF_SIZE, GFP_KERNEL);
  701. if (!fwdata)
  702. goto fw_exit;
  703. /* Allocate memory for receive */
  704. recv_buff = kzalloc(FW_DNLD_RX_BUF_SIZE, GFP_KERNEL);
  705. if (!recv_buff)
  706. goto cleanup;
  707. do {
  708. /* Send pseudo data to check winner status first */
  709. if (check_winner) {
  710. memset(&fwdata->fw_hdr, 0, sizeof(struct fw_header));
  711. dlen = 0;
  712. } else {
  713. /* copy the header of the fw_data to get the length */
  714. memcpy(&fwdata->fw_hdr, &firmware[tlen],
  715. sizeof(struct fw_header));
  716. dlen = le32_to_cpu(fwdata->fw_hdr.data_len);
  717. dnld_cmd = le32_to_cpu(fwdata->fw_hdr.dnld_cmd);
  718. tlen += sizeof(struct fw_header);
  719. memcpy(fwdata->data, &firmware[tlen], dlen);
  720. fwdata->seq_num = cpu_to_le32(fw_seqnum);
  721. tlen += dlen;
  722. }
  723. /* If the send/receive fails or CRC occurs then retry */
  724. while (retries--) {
  725. u8 *buf = (u8 *)fwdata;
  726. u32 len = FW_DATA_XMIT_SIZE;
  727. /* send the firmware block */
  728. ret = mwifiex_write_data_sync(adapter, buf, &len,
  729. MWIFIEX_USB_EP_CMD_EVENT,
  730. MWIFIEX_USB_TIMEOUT);
  731. if (ret) {
  732. dev_err(adapter->dev,
  733. "write_data_sync: failed: %d\n", ret);
  734. continue;
  735. }
  736. buf = recv_buff;
  737. len = FW_DNLD_RX_BUF_SIZE;
  738. /* Receive the firmware block response */
  739. ret = mwifiex_read_data_sync(adapter, buf, &len,
  740. MWIFIEX_USB_EP_CMD_EVENT,
  741. MWIFIEX_USB_TIMEOUT);
  742. if (ret) {
  743. dev_err(adapter->dev,
  744. "read_data_sync: failed: %d\n", ret);
  745. continue;
  746. }
  747. memcpy(&sync_fw, recv_buff,
  748. sizeof(struct fw_sync_header));
  749. /* check 1st firmware block resp for highest bit set */
  750. if (check_winner) {
  751. if (le32_to_cpu(sync_fw.cmd) & 0x80000000) {
  752. dev_warn(adapter->dev,
  753. "USB is not the winner %#x\n",
  754. sync_fw.cmd);
  755. /* returning success */
  756. ret = 0;
  757. goto cleanup;
  758. }
  759. dev_dbg(adapter->dev,
  760. "USB is the winner, start to download FW\n");
  761. check_winner = 0;
  762. break;
  763. }
  764. /* check the firmware block response for CRC errors */
  765. if (sync_fw.cmd) {
  766. dev_err(adapter->dev,
  767. "FW received block with CRC %#x\n",
  768. sync_fw.cmd);
  769. ret = -1;
  770. continue;
  771. }
  772. retries = USB8XXX_FW_MAX_RETRY;
  773. break;
  774. }
  775. fw_seqnum++;
  776. } while ((dnld_cmd != FW_HAS_LAST_BLOCK) && retries);
  777. cleanup:
  778. dev_dbg(adapter->dev, "%s: %d bytes downloaded\n", __func__, tlen);
  779. kfree(recv_buff);
  780. kfree(fwdata);
  781. if (retries)
  782. ret = 0;
  783. fw_exit:
  784. return ret;
  785. }
  786. static int mwifiex_usb_dnld_fw(struct mwifiex_adapter *adapter,
  787. struct mwifiex_fw_image *fw)
  788. {
  789. int ret;
  790. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  791. if (card->usb_boot_state == USB8XXX_FW_DNLD) {
  792. ret = mwifiex_prog_fw_w_helper(adapter, fw);
  793. if (ret)
  794. return -1;
  795. /* Boot state changes after successful firmware download */
  796. if (card->usb_boot_state == USB8XXX_FW_DNLD)
  797. return -1;
  798. }
  799. ret = mwifiex_usb_rx_init(adapter);
  800. if (!ret)
  801. ret = mwifiex_usb_tx_init(adapter);
  802. return ret;
  803. }
  804. static void mwifiex_submit_rx_urb(struct mwifiex_adapter *adapter, u8 ep)
  805. {
  806. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  807. skb_push(card->rx_cmd.skb, INTF_HEADER_LEN);
  808. if ((ep == card->rx_cmd_ep) &&
  809. (!atomic_read(&card->rx_cmd_urb_pending)))
  810. mwifiex_usb_submit_rx_urb(&card->rx_cmd,
  811. MWIFIEX_RX_CMD_BUF_SIZE);
  812. return;
  813. }
  814. static int mwifiex_usb_cmd_event_complete(struct mwifiex_adapter *adapter,
  815. struct sk_buff *skb)
  816. {
  817. mwifiex_submit_rx_urb(adapter, MWIFIEX_USB_EP_CMD_EVENT);
  818. return 0;
  819. }
  820. /* This function wakes up the card. */
  821. static int mwifiex_pm_wakeup_card(struct mwifiex_adapter *adapter)
  822. {
  823. /* Simulation of HS_AWAKE event */
  824. adapter->pm_wakeup_fw_try = false;
  825. adapter->pm_wakeup_card_req = false;
  826. adapter->ps_state = PS_STATE_AWAKE;
  827. return 0;
  828. }
  829. static void mwifiex_usb_submit_rem_rx_urbs(struct mwifiex_adapter *adapter)
  830. {
  831. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  832. int i;
  833. struct urb_context *ctx;
  834. for (i = 0; i < MWIFIEX_RX_DATA_URB; i++) {
  835. if (card->rx_data_list[i].skb)
  836. continue;
  837. ctx = &card->rx_data_list[i];
  838. mwifiex_usb_submit_rx_urb(ctx, MWIFIEX_RX_DATA_BUF_SIZE);
  839. }
  840. }
  841. static struct mwifiex_if_ops usb_ops = {
  842. .register_dev = mwifiex_register_dev,
  843. .unregister_dev = mwifiex_unregister_dev,
  844. .wakeup = mwifiex_pm_wakeup_card,
  845. .wakeup_complete = mwifiex_pm_wakeup_card_complete,
  846. /* USB specific */
  847. .dnld_fw = mwifiex_usb_dnld_fw,
  848. .cmdrsp_complete = mwifiex_usb_cmd_event_complete,
  849. .event_complete = mwifiex_usb_cmd_event_complete,
  850. .host_to_card = mwifiex_usb_host_to_card,
  851. .submit_rem_rx_urbs = mwifiex_usb_submit_rem_rx_urbs,
  852. };
  853. /* This function initializes the USB driver module.
  854. *
  855. * This initiates the semaphore and registers the device with
  856. * USB bus.
  857. */
  858. static int mwifiex_usb_init_module(void)
  859. {
  860. int ret;
  861. pr_debug("Marvell USB8797 Driver\n");
  862. sema_init(&add_remove_card_sem, 1);
  863. ret = usb_register(&mwifiex_usb_driver);
  864. if (ret)
  865. pr_err("Driver register failed!\n");
  866. else
  867. pr_debug("info: Driver registered successfully!\n");
  868. return ret;
  869. }
  870. /* This function cleans up the USB driver.
  871. *
  872. * The following major steps are followed in .disconnect for cleanup:
  873. * - Resume the device if its suspended
  874. * - Disconnect the device if connected
  875. * - Shutdown the firmware
  876. * - Unregister the device from USB bus.
  877. */
  878. static void mwifiex_usb_cleanup_module(void)
  879. {
  880. if (!down_interruptible(&add_remove_card_sem))
  881. up(&add_remove_card_sem);
  882. /* set the flag as user is removing this module */
  883. user_rmmod = 1;
  884. usb_deregister(&mwifiex_usb_driver);
  885. }
  886. module_init(mwifiex_usb_init_module);
  887. module_exit(mwifiex_usb_cleanup_module);
  888. MODULE_AUTHOR("Marvell International Ltd.");
  889. MODULE_DESCRIPTION("Marvell WiFi-Ex USB Driver version" USB_VERSION);
  890. MODULE_VERSION(USB_VERSION);
  891. MODULE_LICENSE("GPL v2");
  892. MODULE_FIRMWARE(USB8766_DEFAULT_FW_NAME);
  893. MODULE_FIRMWARE(USB8797_DEFAULT_FW_NAME);
  894. MODULE_FIRMWARE(USB8897_DEFAULT_FW_NAME);