usb.c 44 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * NXP Wireless LAN device driver: USB specific handling
  4. *
  5. * Copyright 2011-2020 NXP
  6. */
  7. #include "main.h"
  8. #include "usb.h"
  9. #define USB_VERSION "1.0"
  10. static struct mwifiex_if_ops usb_ops;
  11. static const struct usb_device_id mwifiex_usb_table[] = {
  12. /* 8766 */
  13. {USB_DEVICE(USB8XXX_VID, USB8766_PID_1)},
  14. {USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8766_PID_2,
  15. USB_CLASS_VENDOR_SPEC,
  16. USB_SUBCLASS_VENDOR_SPEC, 0xff)},
  17. /* 8797 */
  18. {USB_DEVICE(USB8XXX_VID, USB8797_PID_1)},
  19. {USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8797_PID_2,
  20. USB_CLASS_VENDOR_SPEC,
  21. USB_SUBCLASS_VENDOR_SPEC, 0xff)},
  22. /* 8801 */
  23. {USB_DEVICE(USB8XXX_VID, USB8801_PID_1)},
  24. {USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8801_PID_2,
  25. USB_CLASS_VENDOR_SPEC,
  26. USB_SUBCLASS_VENDOR_SPEC, 0xff)},
  27. /* 8997 */
  28. {USB_DEVICE(USB8XXX_VID, USB8997_PID_1)},
  29. {USB_DEVICE_AND_INTERFACE_INFO(USB8XXX_VID, USB8997_PID_2,
  30. USB_CLASS_VENDOR_SPEC,
  31. USB_SUBCLASS_VENDOR_SPEC, 0xff)},
  32. { } /* Terminating entry */
  33. };
  34. MODULE_DEVICE_TABLE(usb, mwifiex_usb_table);
  35. static int mwifiex_usb_submit_rx_urb(struct urb_context *ctx, int size);
  36. /* This function handles received packet. Necessary action is taken based on
  37. * cmd/event/data.
  38. */
  39. static int mwifiex_usb_recv(struct mwifiex_adapter *adapter,
  40. struct sk_buff *skb, u8 ep)
  41. {
  42. u32 recv_type;
  43. __le32 tmp;
  44. int ret;
  45. if (adapter->hs_activated)
  46. mwifiex_process_hs_config(adapter);
  47. if (skb->len < INTF_HEADER_LEN) {
  48. mwifiex_dbg(adapter, ERROR,
  49. "%s: invalid skb->len\n", __func__);
  50. return -1;
  51. }
  52. switch (ep) {
  53. case MWIFIEX_USB_EP_CMD_EVENT:
  54. mwifiex_dbg(adapter, EVENT,
  55. "%s: EP_CMD_EVENT\n", __func__);
  56. skb_copy_from_linear_data(skb, &tmp, INTF_HEADER_LEN);
  57. recv_type = le32_to_cpu(tmp);
  58. skb_pull(skb, INTF_HEADER_LEN);
  59. switch (recv_type) {
  60. case MWIFIEX_USB_TYPE_CMD:
  61. if (skb->len > MWIFIEX_SIZE_OF_CMD_BUFFER) {
  62. mwifiex_dbg(adapter, ERROR,
  63. "CMD: skb->len too large\n");
  64. ret = -1;
  65. goto exit_restore_skb;
  66. } else if (!adapter->curr_cmd) {
  67. mwifiex_dbg(adapter, WARN, "CMD: no curr_cmd\n");
  68. if (adapter->ps_state == PS_STATE_SLEEP_CFM) {
  69. mwifiex_process_sleep_confirm_resp(
  70. adapter, skb->data,
  71. skb->len);
  72. ret = 0;
  73. goto exit_restore_skb;
  74. }
  75. ret = -1;
  76. goto exit_restore_skb;
  77. }
  78. adapter->curr_cmd->resp_skb = skb;
  79. adapter->cmd_resp_received = true;
  80. break;
  81. case MWIFIEX_USB_TYPE_EVENT:
  82. if (skb->len < sizeof(u32)) {
  83. mwifiex_dbg(adapter, ERROR,
  84. "EVENT: skb->len too small\n");
  85. ret = -1;
  86. goto exit_restore_skb;
  87. }
  88. skb_copy_from_linear_data(skb, &tmp, sizeof(u32));
  89. adapter->event_cause = le32_to_cpu(tmp);
  90. mwifiex_dbg(adapter, EVENT,
  91. "event_cause %#x\n", adapter->event_cause);
  92. if (skb->len > MAX_EVENT_SIZE) {
  93. mwifiex_dbg(adapter, ERROR,
  94. "EVENT: event body too large\n");
  95. ret = -1;
  96. goto exit_restore_skb;
  97. }
  98. memcpy(adapter->event_body, skb->data +
  99. MWIFIEX_EVENT_HEADER_LEN, skb->len);
  100. adapter->event_received = true;
  101. adapter->event_skb = skb;
  102. break;
  103. default:
  104. mwifiex_dbg(adapter, ERROR,
  105. "unknown recv_type %#x\n", recv_type);
  106. ret = -1;
  107. goto exit_restore_skb;
  108. }
  109. break;
  110. case MWIFIEX_USB_EP_DATA:
  111. mwifiex_dbg(adapter, DATA, "%s: EP_DATA\n", __func__);
  112. if (skb->len > MWIFIEX_RX_DATA_BUF_SIZE) {
  113. mwifiex_dbg(adapter, ERROR,
  114. "DATA: skb->len too large\n");
  115. return -1;
  116. }
  117. skb_queue_tail(&adapter->rx_data_q, skb);
  118. adapter->data_received = true;
  119. atomic_inc(&adapter->rx_pending);
  120. break;
  121. default:
  122. mwifiex_dbg(adapter, ERROR,
  123. "%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 ||
  151. test_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags)) {
  152. mwifiex_dbg(adapter, ERROR,
  153. "URB status is failed: %d\n", urb->status);
  154. /* Do not free skb in case of command ep */
  155. if (card->rx_cmd_ep != context->ep)
  156. dev_kfree_skb_any(skb);
  157. goto setup_for_next;
  158. }
  159. if (skb->len > recv_length)
  160. skb_trim(skb, recv_length);
  161. else
  162. skb_put(skb, recv_length - skb->len);
  163. status = mwifiex_usb_recv(adapter, skb, context->ep);
  164. mwifiex_dbg(adapter, INFO,
  165. "info: recv_length=%d, status=%d\n",
  166. recv_length, status);
  167. if (status == -EINPROGRESS) {
  168. mwifiex_queue_main_work(adapter);
  169. /* urb for data_ep is re-submitted now;
  170. * urb for cmd_ep will be re-submitted in callback
  171. * mwifiex_usb_recv_complete
  172. */
  173. if (card->rx_cmd_ep == context->ep)
  174. return;
  175. } else {
  176. if (status == -1)
  177. mwifiex_dbg(adapter, ERROR,
  178. "received data processing failed!\n");
  179. /* Do not free skb in case of command ep */
  180. if (card->rx_cmd_ep != context->ep)
  181. dev_kfree_skb_any(skb);
  182. }
  183. } else if (urb->status) {
  184. if (!test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags)) {
  185. mwifiex_dbg(adapter, FATAL,
  186. "Card is removed: %d\n", urb->status);
  187. set_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags);
  188. }
  189. dev_kfree_skb_any(skb);
  190. return;
  191. } else {
  192. /* Do not free skb in case of command ep */
  193. if (card->rx_cmd_ep != context->ep)
  194. dev_kfree_skb_any(skb);
  195. /* fall through setup_for_next */
  196. }
  197. setup_for_next:
  198. if (card->rx_cmd_ep == context->ep)
  199. size = MWIFIEX_RX_CMD_BUF_SIZE;
  200. else
  201. size = MWIFIEX_RX_DATA_BUF_SIZE;
  202. if (card->rx_cmd_ep == context->ep) {
  203. mwifiex_usb_submit_rx_urb(context, size);
  204. } else {
  205. if (atomic_read(&adapter->rx_pending) <= HIGH_RX_PENDING) {
  206. mwifiex_usb_submit_rx_urb(context, size);
  207. } else {
  208. context->skb = NULL;
  209. }
  210. }
  211. return;
  212. }
  213. static void mwifiex_usb_tx_complete(struct urb *urb)
  214. {
  215. struct urb_context *context = (struct urb_context *)(urb->context);
  216. struct mwifiex_adapter *adapter = context->adapter;
  217. struct usb_card_rec *card = adapter->card;
  218. struct usb_tx_data_port *port;
  219. int i;
  220. mwifiex_dbg(adapter, INFO,
  221. "%s: status: %d\n", __func__, urb->status);
  222. if (context->ep == card->tx_cmd_ep) {
  223. mwifiex_dbg(adapter, CMD,
  224. "%s: CMD\n", __func__);
  225. atomic_dec(&card->tx_cmd_urb_pending);
  226. adapter->cmd_sent = false;
  227. } else {
  228. mwifiex_dbg(adapter, DATA,
  229. "%s: DATA\n", __func__);
  230. mwifiex_write_data_complete(adapter, context->skb, 0,
  231. urb->status ? -1 : 0);
  232. for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
  233. port = &card->port[i];
  234. if (context->ep == port->tx_data_ep) {
  235. atomic_dec(&port->tx_data_urb_pending);
  236. port->block_status = false;
  237. break;
  238. }
  239. }
  240. adapter->data_sent = false;
  241. }
  242. if (card->mc_resync_flag)
  243. mwifiex_multi_chan_resync(adapter);
  244. mwifiex_queue_main_work(adapter);
  245. return;
  246. }
  247. static int mwifiex_usb_submit_rx_urb(struct urb_context *ctx, int size)
  248. {
  249. struct mwifiex_adapter *adapter = ctx->adapter;
  250. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  251. if (test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags)) {
  252. if (card->rx_cmd_ep == ctx->ep) {
  253. mwifiex_dbg(adapter, INFO, "%s: free rx_cmd skb\n",
  254. __func__);
  255. dev_kfree_skb_any(ctx->skb);
  256. ctx->skb = NULL;
  257. }
  258. mwifiex_dbg(adapter, ERROR,
  259. "%s: card removed/suspended, EP %d rx_cmd URB submit skipped\n",
  260. __func__, ctx->ep);
  261. return -1;
  262. }
  263. if (card->rx_cmd_ep != ctx->ep) {
  264. ctx->skb = dev_alloc_skb(size);
  265. if (!ctx->skb) {
  266. mwifiex_dbg(adapter, ERROR,
  267. "%s: dev_alloc_skb failed\n", __func__);
  268. return -ENOMEM;
  269. }
  270. }
  271. if (card->rx_cmd_ep == ctx->ep &&
  272. card->rx_cmd_ep_type == USB_ENDPOINT_XFER_INT)
  273. usb_fill_int_urb(ctx->urb, card->udev,
  274. usb_rcvintpipe(card->udev, ctx->ep),
  275. ctx->skb->data, size, mwifiex_usb_rx_complete,
  276. (void *)ctx, card->rx_cmd_interval);
  277. else
  278. usb_fill_bulk_urb(ctx->urb, card->udev,
  279. usb_rcvbulkpipe(card->udev, ctx->ep),
  280. ctx->skb->data, size, mwifiex_usb_rx_complete,
  281. (void *)ctx);
  282. if (card->rx_cmd_ep == ctx->ep)
  283. atomic_inc(&card->rx_cmd_urb_pending);
  284. else
  285. atomic_inc(&card->rx_data_urb_pending);
  286. if (usb_submit_urb(ctx->urb, GFP_ATOMIC)) {
  287. mwifiex_dbg(adapter, ERROR, "usb_submit_urb failed\n");
  288. dev_kfree_skb_any(ctx->skb);
  289. ctx->skb = NULL;
  290. if (card->rx_cmd_ep == ctx->ep)
  291. atomic_dec(&card->rx_cmd_urb_pending);
  292. else
  293. atomic_dec(&card->rx_data_urb_pending);
  294. return -1;
  295. }
  296. return 0;
  297. }
  298. static void mwifiex_usb_free(struct usb_card_rec *card)
  299. {
  300. struct usb_tx_data_port *port;
  301. int i, j;
  302. if (atomic_read(&card->rx_cmd_urb_pending) && card->rx_cmd.urb)
  303. usb_kill_urb(card->rx_cmd.urb);
  304. usb_free_urb(card->rx_cmd.urb);
  305. card->rx_cmd.urb = NULL;
  306. if (atomic_read(&card->rx_data_urb_pending))
  307. for (i = 0; i < MWIFIEX_RX_DATA_URB; i++)
  308. if (card->rx_data_list[i].urb)
  309. usb_kill_urb(card->rx_data_list[i].urb);
  310. for (i = 0; i < MWIFIEX_RX_DATA_URB; i++) {
  311. usb_free_urb(card->rx_data_list[i].urb);
  312. card->rx_data_list[i].urb = NULL;
  313. }
  314. for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
  315. port = &card->port[i];
  316. for (j = 0; j < MWIFIEX_TX_DATA_URB; j++) {
  317. usb_kill_urb(port->tx_data_list[j].urb);
  318. usb_free_urb(port->tx_data_list[j].urb);
  319. port->tx_data_list[j].urb = NULL;
  320. }
  321. }
  322. usb_free_urb(card->tx_cmd.urb);
  323. card->tx_cmd.urb = NULL;
  324. return;
  325. }
  326. /* This function probes an mwifiex device and registers it. It allocates
  327. * the card structure, initiates the device registration and initialization
  328. * procedure by adding a logical interface.
  329. */
  330. static int mwifiex_usb_probe(struct usb_interface *intf,
  331. const struct usb_device_id *id)
  332. {
  333. struct usb_device *udev = interface_to_usbdev(intf);
  334. struct usb_host_interface *iface_desc = intf->cur_altsetting;
  335. struct usb_endpoint_descriptor *epd;
  336. int ret, i;
  337. struct usb_card_rec *card;
  338. u16 id_vendor, id_product, bcd_device;
  339. card = devm_kzalloc(&intf->dev, sizeof(*card), GFP_KERNEL);
  340. if (!card)
  341. return -ENOMEM;
  342. init_completion(&card->fw_done);
  343. id_vendor = le16_to_cpu(udev->descriptor.idVendor);
  344. id_product = le16_to_cpu(udev->descriptor.idProduct);
  345. bcd_device = le16_to_cpu(udev->descriptor.bcdDevice);
  346. pr_debug("info: VID/PID = %X/%X, Boot2 version = %X\n",
  347. id_vendor, id_product, bcd_device);
  348. /* PID_1 is used for firmware downloading only */
  349. switch (id_product) {
  350. case USB8766_PID_1:
  351. case USB8797_PID_1:
  352. case USB8801_PID_1:
  353. case USB8997_PID_1:
  354. card->usb_boot_state = USB8XXX_FW_DNLD;
  355. break;
  356. case USB8766_PID_2:
  357. case USB8797_PID_2:
  358. case USB8801_PID_2:
  359. case USB8997_PID_2:
  360. card->usb_boot_state = USB8XXX_FW_READY;
  361. break;
  362. default:
  363. pr_warn("unknown id_product %#x\n", id_product);
  364. card->usb_boot_state = USB8XXX_FW_DNLD;
  365. break;
  366. }
  367. card->udev = udev;
  368. card->intf = intf;
  369. pr_debug("info: bcdUSB=%#x Device Class=%#x SubClass=%#x Protocol=%#x\n",
  370. le16_to_cpu(udev->descriptor.bcdUSB),
  371. udev->descriptor.bDeviceClass,
  372. udev->descriptor.bDeviceSubClass,
  373. udev->descriptor.bDeviceProtocol);
  374. for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
  375. epd = &iface_desc->endpoint[i].desc;
  376. if (usb_endpoint_dir_in(epd) &&
  377. usb_endpoint_num(epd) == MWIFIEX_USB_EP_CMD_EVENT &&
  378. (usb_endpoint_xfer_bulk(epd) ||
  379. usb_endpoint_xfer_int(epd))) {
  380. card->rx_cmd_ep_type = usb_endpoint_type(epd);
  381. card->rx_cmd_interval = epd->bInterval;
  382. pr_debug("info: Rx CMD/EVT:: max pkt size: %d, addr: %d, ep_type: %d\n",
  383. le16_to_cpu(epd->wMaxPacketSize),
  384. epd->bEndpointAddress, card->rx_cmd_ep_type);
  385. card->rx_cmd_ep = usb_endpoint_num(epd);
  386. atomic_set(&card->rx_cmd_urb_pending, 0);
  387. }
  388. if (usb_endpoint_dir_in(epd) &&
  389. usb_endpoint_num(epd) == MWIFIEX_USB_EP_DATA &&
  390. usb_endpoint_xfer_bulk(epd)) {
  391. pr_debug("info: bulk IN: max pkt size: %d, addr: %d\n",
  392. le16_to_cpu(epd->wMaxPacketSize),
  393. epd->bEndpointAddress);
  394. card->rx_data_ep = usb_endpoint_num(epd);
  395. atomic_set(&card->rx_data_urb_pending, 0);
  396. }
  397. if (usb_endpoint_dir_out(epd) &&
  398. usb_endpoint_num(epd) == MWIFIEX_USB_EP_DATA &&
  399. usb_endpoint_xfer_bulk(epd)) {
  400. pr_debug("info: bulk OUT: max pkt size: %d, addr: %d\n",
  401. le16_to_cpu(epd->wMaxPacketSize),
  402. epd->bEndpointAddress);
  403. card->port[0].tx_data_ep = usb_endpoint_num(epd);
  404. atomic_set(&card->port[0].tx_data_urb_pending, 0);
  405. }
  406. if (usb_endpoint_dir_out(epd) &&
  407. usb_endpoint_num(epd) == MWIFIEX_USB_EP_DATA_CH2 &&
  408. usb_endpoint_xfer_bulk(epd)) {
  409. pr_debug("info: bulk OUT chan2:\t"
  410. "max pkt size: %d, addr: %d\n",
  411. le16_to_cpu(epd->wMaxPacketSize),
  412. epd->bEndpointAddress);
  413. card->port[1].tx_data_ep = usb_endpoint_num(epd);
  414. atomic_set(&card->port[1].tx_data_urb_pending, 0);
  415. }
  416. if (usb_endpoint_dir_out(epd) &&
  417. usb_endpoint_num(epd) == MWIFIEX_USB_EP_CMD_EVENT &&
  418. (usb_endpoint_xfer_bulk(epd) ||
  419. usb_endpoint_xfer_int(epd))) {
  420. card->tx_cmd_ep_type = usb_endpoint_type(epd);
  421. card->tx_cmd_interval = epd->bInterval;
  422. pr_debug("info: bulk OUT: max pkt size: %d, addr: %d\n",
  423. le16_to_cpu(epd->wMaxPacketSize),
  424. epd->bEndpointAddress);
  425. pr_debug("info: Tx CMD:: max pkt size: %d, addr: %d, ep_type: %d\n",
  426. le16_to_cpu(epd->wMaxPacketSize),
  427. epd->bEndpointAddress, card->tx_cmd_ep_type);
  428. card->tx_cmd_ep = usb_endpoint_num(epd);
  429. atomic_set(&card->tx_cmd_urb_pending, 0);
  430. card->bulk_out_maxpktsize =
  431. le16_to_cpu(epd->wMaxPacketSize);
  432. }
  433. }
  434. switch (card->usb_boot_state) {
  435. case USB8XXX_FW_DNLD:
  436. /* Reject broken descriptors. */
  437. if (!card->rx_cmd_ep || !card->tx_cmd_ep)
  438. return -ENODEV;
  439. if (card->bulk_out_maxpktsize == 0)
  440. return -ENODEV;
  441. break;
  442. case USB8XXX_FW_READY:
  443. /* Assume the driver can handle missing endpoints for now. */
  444. break;
  445. default:
  446. WARN_ON(1);
  447. return -ENODEV;
  448. }
  449. usb_set_intfdata(intf, card);
  450. ret = mwifiex_add_card(card, &card->fw_done, &usb_ops,
  451. MWIFIEX_USB, &card->udev->dev);
  452. if (ret) {
  453. pr_err("%s: mwifiex_add_card failed: %d\n", __func__, ret);
  454. usb_reset_device(udev);
  455. return ret;
  456. }
  457. usb_get_dev(udev);
  458. return 0;
  459. }
  460. /* Kernel needs to suspend all functions separately. Therefore all
  461. * registered functions must have drivers with suspend and resume
  462. * methods. Failing that the kernel simply removes the whole card.
  463. *
  464. * If already not suspended, this function allocates and sends a
  465. * 'host sleep activate' request to the firmware and turns off the traffic.
  466. */
  467. static int mwifiex_usb_suspend(struct usb_interface *intf, pm_message_t message)
  468. {
  469. struct usb_card_rec *card = usb_get_intfdata(intf);
  470. struct mwifiex_adapter *adapter;
  471. struct usb_tx_data_port *port;
  472. int i, j;
  473. /* Might still be loading firmware */
  474. wait_for_completion(&card->fw_done);
  475. adapter = card->adapter;
  476. if (!adapter) {
  477. dev_err(&intf->dev, "card is not valid\n");
  478. return 0;
  479. }
  480. if (unlikely(test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags)))
  481. mwifiex_dbg(adapter, WARN,
  482. "Device already suspended\n");
  483. /* Enable the Host Sleep */
  484. if (!mwifiex_enable_hs(adapter)) {
  485. mwifiex_dbg(adapter, ERROR,
  486. "cmd: failed to suspend\n");
  487. clear_bit(MWIFIEX_IS_HS_ENABLING, &adapter->work_flags);
  488. return -EFAULT;
  489. }
  490. /* 'MWIFIEX_IS_SUSPENDED' bit indicates device is suspended.
  491. * It must be set here before the usb_kill_urb() calls. Reason
  492. * is in the complete handlers, urb->status(= -ENOENT) and
  493. * this flag is used in combination to distinguish between a
  494. * 'suspended' state and a 'disconnect' one.
  495. */
  496. set_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags);
  497. clear_bit(MWIFIEX_IS_HS_ENABLING, &adapter->work_flags);
  498. if (atomic_read(&card->rx_cmd_urb_pending) && card->rx_cmd.urb)
  499. usb_kill_urb(card->rx_cmd.urb);
  500. if (atomic_read(&card->rx_data_urb_pending))
  501. for (i = 0; i < MWIFIEX_RX_DATA_URB; i++)
  502. if (card->rx_data_list[i].urb)
  503. usb_kill_urb(card->rx_data_list[i].urb);
  504. for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
  505. port = &card->port[i];
  506. for (j = 0; j < MWIFIEX_TX_DATA_URB; j++) {
  507. if (port->tx_data_list[j].urb)
  508. usb_kill_urb(port->tx_data_list[j].urb);
  509. }
  510. }
  511. if (card->tx_cmd.urb)
  512. usb_kill_urb(card->tx_cmd.urb);
  513. return 0;
  514. }
  515. /* Kernel needs to suspend all functions separately. Therefore all
  516. * registered functions must have drivers with suspend and resume
  517. * methods. Failing that the kernel simply removes the whole card.
  518. *
  519. * If already not resumed, this function turns on the traffic and
  520. * sends a 'host sleep cancel' request to the firmware.
  521. */
  522. static int mwifiex_usb_resume(struct usb_interface *intf)
  523. {
  524. struct usb_card_rec *card = usb_get_intfdata(intf);
  525. struct mwifiex_adapter *adapter;
  526. int i;
  527. if (!card->adapter) {
  528. dev_err(&intf->dev, "%s: card->adapter is NULL\n",
  529. __func__);
  530. return 0;
  531. }
  532. adapter = card->adapter;
  533. if (unlikely(!test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags))) {
  534. mwifiex_dbg(adapter, WARN,
  535. "Device already resumed\n");
  536. return 0;
  537. }
  538. /* Indicate device resumed. The netdev queue will be resumed only
  539. * after the urbs have been re-submitted
  540. */
  541. clear_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags);
  542. if (!atomic_read(&card->rx_data_urb_pending))
  543. for (i = 0; i < MWIFIEX_RX_DATA_URB; i++)
  544. mwifiex_usb_submit_rx_urb(&card->rx_data_list[i],
  545. MWIFIEX_RX_DATA_BUF_SIZE);
  546. if (!atomic_read(&card->rx_cmd_urb_pending)) {
  547. card->rx_cmd.skb = dev_alloc_skb(MWIFIEX_RX_CMD_BUF_SIZE);
  548. if (card->rx_cmd.skb)
  549. mwifiex_usb_submit_rx_urb(&card->rx_cmd,
  550. MWIFIEX_RX_CMD_BUF_SIZE);
  551. }
  552. /* Disable Host Sleep */
  553. if (adapter->hs_activated)
  554. mwifiex_cancel_hs(mwifiex_get_priv(adapter,
  555. MWIFIEX_BSS_ROLE_ANY),
  556. MWIFIEX_ASYNC_CMD);
  557. return 0;
  558. }
  559. static void mwifiex_usb_disconnect(struct usb_interface *intf)
  560. {
  561. struct usb_card_rec *card = usb_get_intfdata(intf);
  562. struct mwifiex_adapter *adapter;
  563. wait_for_completion(&card->fw_done);
  564. adapter = card->adapter;
  565. if (!adapter || !adapter->priv_num)
  566. return;
  567. if (card->udev->state != USB_STATE_NOTATTACHED && !adapter->mfg_mode) {
  568. mwifiex_deauthenticate_all(adapter);
  569. mwifiex_init_shutdown_fw(mwifiex_get_priv(adapter,
  570. MWIFIEX_BSS_ROLE_ANY),
  571. MWIFIEX_FUNC_SHUTDOWN);
  572. }
  573. mwifiex_dbg(adapter, FATAL,
  574. "%s: removing card\n", __func__);
  575. mwifiex_remove_card(adapter);
  576. usb_put_dev(interface_to_usbdev(intf));
  577. }
  578. static void mwifiex_usb_coredump(struct device *dev)
  579. {
  580. struct usb_interface *intf = to_usb_interface(dev);
  581. struct usb_card_rec *card = usb_get_intfdata(intf);
  582. mwifiex_fw_dump_event(mwifiex_get_priv(card->adapter,
  583. MWIFIEX_BSS_ROLE_ANY));
  584. }
  585. static struct usb_driver mwifiex_usb_driver = {
  586. .name = "mwifiex_usb",
  587. .probe = mwifiex_usb_probe,
  588. .disconnect = mwifiex_usb_disconnect,
  589. .id_table = mwifiex_usb_table,
  590. .suspend = mwifiex_usb_suspend,
  591. .resume = mwifiex_usb_resume,
  592. .soft_unbind = 1,
  593. .drvwrap.driver = {
  594. .coredump = mwifiex_usb_coredump,
  595. },
  596. };
  597. static int mwifiex_write_data_sync(struct mwifiex_adapter *adapter, u8 *pbuf,
  598. u32 *len, u8 ep, u32 timeout)
  599. {
  600. struct usb_card_rec *card = adapter->card;
  601. int actual_length, ret;
  602. if (!(*len % card->bulk_out_maxpktsize))
  603. (*len)++;
  604. /* Send the data block */
  605. ret = usb_bulk_msg(card->udev, usb_sndbulkpipe(card->udev, ep), pbuf,
  606. *len, &actual_length, timeout);
  607. if (ret) {
  608. mwifiex_dbg(adapter, ERROR,
  609. "usb_bulk_msg for tx failed: %d\n", ret);
  610. return ret;
  611. }
  612. *len = actual_length;
  613. return ret;
  614. }
  615. static int mwifiex_read_data_sync(struct mwifiex_adapter *adapter, u8 *pbuf,
  616. u32 *len, u8 ep, u32 timeout)
  617. {
  618. struct usb_card_rec *card = adapter->card;
  619. int actual_length, ret;
  620. /* Receive the data response */
  621. ret = usb_bulk_msg(card->udev, usb_rcvbulkpipe(card->udev, ep), pbuf,
  622. *len, &actual_length, timeout);
  623. if (ret) {
  624. mwifiex_dbg(adapter, ERROR,
  625. "usb_bulk_msg for rx failed: %d\n", ret);
  626. return ret;
  627. }
  628. *len = actual_length;
  629. return ret;
  630. }
  631. static void mwifiex_usb_port_resync(struct mwifiex_adapter *adapter)
  632. {
  633. struct usb_card_rec *card = adapter->card;
  634. u8 active_port = MWIFIEX_USB_EP_DATA;
  635. struct mwifiex_private *priv = NULL;
  636. int i;
  637. if (adapter->usb_mc_status) {
  638. for (i = 0; i < adapter->priv_num; i++) {
  639. priv = adapter->priv[i];
  640. if (!priv)
  641. continue;
  642. if ((priv->bss_role == MWIFIEX_BSS_ROLE_UAP &&
  643. !priv->bss_started) ||
  644. (priv->bss_role == MWIFIEX_BSS_ROLE_STA &&
  645. !priv->media_connected))
  646. priv->usb_port = MWIFIEX_USB_EP_DATA;
  647. }
  648. for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++)
  649. card->port[i].block_status = false;
  650. } else {
  651. for (i = 0; i < adapter->priv_num; i++) {
  652. priv = adapter->priv[i];
  653. if (!priv)
  654. continue;
  655. if ((priv->bss_role == MWIFIEX_BSS_ROLE_UAP &&
  656. priv->bss_started) ||
  657. (priv->bss_role == MWIFIEX_BSS_ROLE_STA &&
  658. priv->media_connected)) {
  659. active_port = priv->usb_port;
  660. break;
  661. }
  662. }
  663. for (i = 0; i < adapter->priv_num; i++) {
  664. priv = adapter->priv[i];
  665. if (priv)
  666. priv->usb_port = active_port;
  667. }
  668. for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
  669. if (active_port == card->port[i].tx_data_ep)
  670. card->port[i].block_status = false;
  671. else
  672. card->port[i].block_status = true;
  673. }
  674. }
  675. }
  676. static bool mwifiex_usb_is_port_ready(struct mwifiex_private *priv)
  677. {
  678. struct usb_card_rec *card = priv->adapter->card;
  679. int idx;
  680. for (idx = 0; idx < MWIFIEX_TX_DATA_PORT; idx++) {
  681. if (priv->usb_port == card->port[idx].tx_data_ep)
  682. return !card->port[idx].block_status;
  683. }
  684. return false;
  685. }
  686. static inline u8 mwifiex_usb_data_sent(struct mwifiex_adapter *adapter)
  687. {
  688. struct usb_card_rec *card = adapter->card;
  689. int i;
  690. for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++)
  691. if (!card->port[i].block_status)
  692. return false;
  693. return true;
  694. }
  695. static int mwifiex_usb_construct_send_urb(struct mwifiex_adapter *adapter,
  696. struct usb_tx_data_port *port, u8 ep,
  697. struct urb_context *context,
  698. struct sk_buff *skb_send)
  699. {
  700. struct usb_card_rec *card = adapter->card;
  701. int ret = -EINPROGRESS;
  702. struct urb *tx_urb;
  703. context->adapter = adapter;
  704. context->ep = ep;
  705. context->skb = skb_send;
  706. tx_urb = context->urb;
  707. if (ep == card->tx_cmd_ep &&
  708. card->tx_cmd_ep_type == USB_ENDPOINT_XFER_INT)
  709. usb_fill_int_urb(tx_urb, card->udev,
  710. usb_sndintpipe(card->udev, ep), skb_send->data,
  711. skb_send->len, mwifiex_usb_tx_complete,
  712. (void *)context, card->tx_cmd_interval);
  713. else
  714. usb_fill_bulk_urb(tx_urb, card->udev,
  715. usb_sndbulkpipe(card->udev, ep),
  716. skb_send->data, skb_send->len,
  717. mwifiex_usb_tx_complete, (void *)context);
  718. tx_urb->transfer_flags |= URB_ZERO_PACKET;
  719. if (ep == card->tx_cmd_ep)
  720. atomic_inc(&card->tx_cmd_urb_pending);
  721. else
  722. atomic_inc(&port->tx_data_urb_pending);
  723. if (ep != card->tx_cmd_ep &&
  724. atomic_read(&port->tx_data_urb_pending) ==
  725. MWIFIEX_TX_DATA_URB) {
  726. port->block_status = true;
  727. adapter->data_sent = mwifiex_usb_data_sent(adapter);
  728. ret = -ENOSR;
  729. }
  730. if (usb_submit_urb(tx_urb, GFP_ATOMIC)) {
  731. mwifiex_dbg(adapter, ERROR,
  732. "%s: usb_submit_urb failed\n", __func__);
  733. if (ep == card->tx_cmd_ep) {
  734. atomic_dec(&card->tx_cmd_urb_pending);
  735. } else {
  736. atomic_dec(&port->tx_data_urb_pending);
  737. port->block_status = false;
  738. adapter->data_sent = false;
  739. if (port->tx_data_ix)
  740. port->tx_data_ix--;
  741. else
  742. port->tx_data_ix = MWIFIEX_TX_DATA_URB;
  743. }
  744. ret = -1;
  745. }
  746. return ret;
  747. }
  748. static int mwifiex_usb_prepare_tx_aggr_skb(struct mwifiex_adapter *adapter,
  749. struct usb_tx_data_port *port,
  750. struct sk_buff **skb_send)
  751. {
  752. struct sk_buff *skb_aggr, *skb_tmp;
  753. u8 *payload, pad;
  754. u16 align = adapter->bus_aggr.tx_aggr_align;
  755. struct mwifiex_txinfo *tx_info = NULL;
  756. bool is_txinfo_set = false;
  757. /* Packets in aggr_list will be send in either skb_aggr or
  758. * write complete, delete the tx_aggr timer
  759. */
  760. if (port->tx_aggr.timer_cnxt.is_hold_timer_set) {
  761. del_timer(&port->tx_aggr.timer_cnxt.hold_timer);
  762. port->tx_aggr.timer_cnxt.is_hold_timer_set = false;
  763. port->tx_aggr.timer_cnxt.hold_tmo_msecs = 0;
  764. }
  765. skb_aggr = mwifiex_alloc_dma_align_buf(port->tx_aggr.aggr_len,
  766. GFP_ATOMIC);
  767. if (!skb_aggr) {
  768. mwifiex_dbg(adapter, ERROR,
  769. "%s: alloc skb_aggr failed\n", __func__);
  770. while ((skb_tmp = skb_dequeue(&port->tx_aggr.aggr_list)))
  771. mwifiex_write_data_complete(adapter, skb_tmp, 0, -1);
  772. port->tx_aggr.aggr_num = 0;
  773. port->tx_aggr.aggr_len = 0;
  774. return -EBUSY;
  775. }
  776. tx_info = MWIFIEX_SKB_TXCB(skb_aggr);
  777. memset(tx_info, 0, sizeof(*tx_info));
  778. while ((skb_tmp = skb_dequeue(&port->tx_aggr.aggr_list))) {
  779. /* padding for aligning next packet header*/
  780. pad = (align - (skb_tmp->len & (align - 1))) % align;
  781. payload = skb_put(skb_aggr, skb_tmp->len + pad);
  782. memcpy(payload, skb_tmp->data, skb_tmp->len);
  783. if (skb_queue_empty(&port->tx_aggr.aggr_list)) {
  784. /* do not padding for last packet*/
  785. *(__le16 *)payload = cpu_to_le16(skb_tmp->len);
  786. *(__le16 *)&payload[2] =
  787. cpu_to_le16(MWIFIEX_TYPE_AGGR_DATA_V2 | 0x80);
  788. skb_trim(skb_aggr, skb_aggr->len - pad);
  789. } else {
  790. /* add aggregation interface header */
  791. *(__le16 *)payload = cpu_to_le16(skb_tmp->len + pad);
  792. *(__le16 *)&payload[2] =
  793. cpu_to_le16(MWIFIEX_TYPE_AGGR_DATA_V2);
  794. }
  795. if (!is_txinfo_set) {
  796. tx_info->bss_num = MWIFIEX_SKB_TXCB(skb_tmp)->bss_num;
  797. tx_info->bss_type = MWIFIEX_SKB_TXCB(skb_tmp)->bss_type;
  798. is_txinfo_set = true;
  799. }
  800. port->tx_aggr.aggr_num--;
  801. port->tx_aggr.aggr_len -= (skb_tmp->len + pad);
  802. mwifiex_write_data_complete(adapter, skb_tmp, 0, 0);
  803. }
  804. tx_info->pkt_len = skb_aggr->len -
  805. (sizeof(struct txpd) + adapter->intf_hdr_len);
  806. tx_info->flags |= MWIFIEX_BUF_FLAG_AGGR_PKT;
  807. port->tx_aggr.aggr_num = 0;
  808. port->tx_aggr.aggr_len = 0;
  809. *skb_send = skb_aggr;
  810. return 0;
  811. }
  812. /* This function prepare data packet to be send under usb tx aggregation
  813. * protocol, check current usb aggregation status, link packet to aggrgation
  814. * list if possible, work flow as below:
  815. * (1) if only 1 packet available, add usb tx aggregation header and send.
  816. * (2) if packet is able to aggregated, link it to current aggregation list.
  817. * (3) if packet is not able to aggregated, aggregate and send exist packets
  818. * in aggrgation list. Then, link packet in the list if there is more
  819. * packet in transmit queue, otherwise try to transmit single packet.
  820. */
  821. static int mwifiex_usb_aggr_tx_data(struct mwifiex_adapter *adapter, u8 ep,
  822. struct sk_buff *skb,
  823. struct mwifiex_tx_param *tx_param,
  824. struct usb_tx_data_port *port)
  825. {
  826. u8 *payload, pad;
  827. u16 align = adapter->bus_aggr.tx_aggr_align;
  828. struct sk_buff *skb_send = NULL;
  829. struct urb_context *context = NULL;
  830. struct txpd *local_tx_pd =
  831. (struct txpd *)((u8 *)skb->data + adapter->intf_hdr_len);
  832. u8 f_send_aggr_buf = 0;
  833. u8 f_send_cur_buf = 0;
  834. u8 f_precopy_cur_buf = 0;
  835. u8 f_postcopy_cur_buf = 0;
  836. u32 timeout;
  837. int ret;
  838. /* padding to ensure each packet alginment */
  839. pad = (align - (skb->len & (align - 1))) % align;
  840. if (tx_param && tx_param->next_pkt_len) {
  841. /* next packet available in tx queue*/
  842. if (port->tx_aggr.aggr_len + skb->len + pad >
  843. adapter->bus_aggr.tx_aggr_max_size) {
  844. f_send_aggr_buf = 1;
  845. f_postcopy_cur_buf = 1;
  846. } else {
  847. /* current packet could be aggregated*/
  848. f_precopy_cur_buf = 1;
  849. if (port->tx_aggr.aggr_len + skb->len + pad +
  850. tx_param->next_pkt_len >
  851. adapter->bus_aggr.tx_aggr_max_size ||
  852. port->tx_aggr.aggr_num + 2 >
  853. adapter->bus_aggr.tx_aggr_max_num) {
  854. /* next packet could not be aggregated
  855. * send current aggregation buffer
  856. */
  857. f_send_aggr_buf = 1;
  858. }
  859. }
  860. } else {
  861. /* last packet in tx queue */
  862. if (port->tx_aggr.aggr_num > 0) {
  863. /* pending packets in aggregation buffer*/
  864. if (port->tx_aggr.aggr_len + skb->len + pad >
  865. adapter->bus_aggr.tx_aggr_max_size) {
  866. /* current packet not be able to aggregated,
  867. * send aggr buffer first, then send packet.
  868. */
  869. f_send_cur_buf = 1;
  870. } else {
  871. /* last packet, Aggregation and send */
  872. f_precopy_cur_buf = 1;
  873. }
  874. f_send_aggr_buf = 1;
  875. } else {
  876. /* no pending packets in aggregation buffer,
  877. * send current packet immediately
  878. */
  879. f_send_cur_buf = 1;
  880. }
  881. }
  882. if (local_tx_pd->flags & MWIFIEX_TxPD_POWER_MGMT_NULL_PACKET) {
  883. /* Send NULL packet immediately*/
  884. if (f_precopy_cur_buf) {
  885. if (skb_queue_empty(&port->tx_aggr.aggr_list)) {
  886. f_precopy_cur_buf = 0;
  887. f_send_aggr_buf = 0;
  888. f_send_cur_buf = 1;
  889. } else {
  890. f_send_aggr_buf = 1;
  891. }
  892. } else if (f_postcopy_cur_buf) {
  893. f_send_cur_buf = 1;
  894. f_postcopy_cur_buf = 0;
  895. }
  896. }
  897. if (f_precopy_cur_buf) {
  898. skb_queue_tail(&port->tx_aggr.aggr_list, skb);
  899. port->tx_aggr.aggr_len += (skb->len + pad);
  900. port->tx_aggr.aggr_num++;
  901. if (f_send_aggr_buf)
  902. goto send_aggr_buf;
  903. /* packet will not been send immediately,
  904. * set a timer to make sure it will be sent under
  905. * strict time limit. Dynamically fit the timeout
  906. * value, according to packets number in aggr_list
  907. */
  908. if (!port->tx_aggr.timer_cnxt.is_hold_timer_set) {
  909. port->tx_aggr.timer_cnxt.hold_tmo_msecs =
  910. MWIFIEX_USB_TX_AGGR_TMO_MIN;
  911. timeout =
  912. port->tx_aggr.timer_cnxt.hold_tmo_msecs;
  913. mod_timer(&port->tx_aggr.timer_cnxt.hold_timer,
  914. jiffies + msecs_to_jiffies(timeout));
  915. port->tx_aggr.timer_cnxt.is_hold_timer_set = true;
  916. } else {
  917. if (port->tx_aggr.timer_cnxt.hold_tmo_msecs <
  918. MWIFIEX_USB_TX_AGGR_TMO_MAX) {
  919. /* Dyanmic fit timeout */
  920. timeout =
  921. ++port->tx_aggr.timer_cnxt.hold_tmo_msecs;
  922. mod_timer(&port->tx_aggr.timer_cnxt.hold_timer,
  923. jiffies + msecs_to_jiffies(timeout));
  924. }
  925. }
  926. }
  927. send_aggr_buf:
  928. if (f_send_aggr_buf) {
  929. ret = mwifiex_usb_prepare_tx_aggr_skb(adapter, port, &skb_send);
  930. if (!ret) {
  931. context = &port->tx_data_list[port->tx_data_ix++];
  932. ret = mwifiex_usb_construct_send_urb(adapter, port, ep,
  933. context, skb_send);
  934. if (ret == -1)
  935. mwifiex_write_data_complete(adapter, skb_send,
  936. 0, -1);
  937. }
  938. }
  939. if (f_send_cur_buf) {
  940. if (f_send_aggr_buf) {
  941. if (atomic_read(&port->tx_data_urb_pending) >=
  942. MWIFIEX_TX_DATA_URB) {
  943. port->block_status = true;
  944. adapter->data_sent =
  945. mwifiex_usb_data_sent(adapter);
  946. /* no available urb, postcopy packet*/
  947. f_postcopy_cur_buf = 1;
  948. goto postcopy_cur_buf;
  949. }
  950. if (port->tx_data_ix >= MWIFIEX_TX_DATA_URB)
  951. port->tx_data_ix = 0;
  952. }
  953. payload = skb->data;
  954. *(__le16 *)&payload[2] =
  955. cpu_to_le16(MWIFIEX_TYPE_AGGR_DATA_V2 | 0x80);
  956. *(__le16 *)payload = cpu_to_le16(skb->len);
  957. skb_send = skb;
  958. context = &port->tx_data_list[port->tx_data_ix++];
  959. return mwifiex_usb_construct_send_urb(adapter, port, ep,
  960. context, skb_send);
  961. }
  962. postcopy_cur_buf:
  963. if (f_postcopy_cur_buf) {
  964. skb_queue_tail(&port->tx_aggr.aggr_list, skb);
  965. port->tx_aggr.aggr_len += (skb->len + pad);
  966. port->tx_aggr.aggr_num++;
  967. /* New aggregation begin, start timer */
  968. if (!port->tx_aggr.timer_cnxt.is_hold_timer_set) {
  969. port->tx_aggr.timer_cnxt.hold_tmo_msecs =
  970. MWIFIEX_USB_TX_AGGR_TMO_MIN;
  971. timeout = port->tx_aggr.timer_cnxt.hold_tmo_msecs;
  972. mod_timer(&port->tx_aggr.timer_cnxt.hold_timer,
  973. jiffies + msecs_to_jiffies(timeout));
  974. port->tx_aggr.timer_cnxt.is_hold_timer_set = true;
  975. }
  976. }
  977. return -EINPROGRESS;
  978. }
  979. static void mwifiex_usb_tx_aggr_tmo(struct timer_list *t)
  980. {
  981. struct urb_context *urb_cnxt = NULL;
  982. struct sk_buff *skb_send = NULL;
  983. struct tx_aggr_tmr_cnxt *timer_context =
  984. from_timer(timer_context, t, hold_timer);
  985. struct mwifiex_adapter *adapter = timer_context->adapter;
  986. struct usb_tx_data_port *port = timer_context->port;
  987. int err = 0;
  988. spin_lock_bh(&port->tx_aggr_lock);
  989. err = mwifiex_usb_prepare_tx_aggr_skb(adapter, port, &skb_send);
  990. if (err) {
  991. mwifiex_dbg(adapter, ERROR,
  992. "prepare tx aggr skb failed, err=%d\n", err);
  993. goto unlock;
  994. }
  995. if (atomic_read(&port->tx_data_urb_pending) >=
  996. MWIFIEX_TX_DATA_URB) {
  997. port->block_status = true;
  998. adapter->data_sent =
  999. mwifiex_usb_data_sent(adapter);
  1000. err = -1;
  1001. goto done;
  1002. }
  1003. if (port->tx_data_ix >= MWIFIEX_TX_DATA_URB)
  1004. port->tx_data_ix = 0;
  1005. urb_cnxt = &port->tx_data_list[port->tx_data_ix++];
  1006. err = mwifiex_usb_construct_send_urb(adapter, port, port->tx_data_ep,
  1007. urb_cnxt, skb_send);
  1008. done:
  1009. if (err == -1)
  1010. mwifiex_write_data_complete(adapter, skb_send, 0, -1);
  1011. unlock:
  1012. spin_unlock_bh(&port->tx_aggr_lock);
  1013. }
  1014. /* This function write a command/data packet to card. */
  1015. static int mwifiex_usb_host_to_card(struct mwifiex_adapter *adapter, u8 ep,
  1016. struct sk_buff *skb,
  1017. struct mwifiex_tx_param *tx_param)
  1018. {
  1019. struct usb_card_rec *card = adapter->card;
  1020. struct urb_context *context = NULL;
  1021. struct usb_tx_data_port *port = NULL;
  1022. int idx, ret;
  1023. if (test_bit(MWIFIEX_IS_SUSPENDED, &adapter->work_flags)) {
  1024. mwifiex_dbg(adapter, ERROR,
  1025. "%s: not allowed while suspended\n", __func__);
  1026. return -1;
  1027. }
  1028. if (test_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags)) {
  1029. mwifiex_dbg(adapter, ERROR, "%s: device removed\n", __func__);
  1030. return -1;
  1031. }
  1032. mwifiex_dbg(adapter, INFO, "%s: ep=%d\n", __func__, ep);
  1033. if (ep == card->tx_cmd_ep) {
  1034. context = &card->tx_cmd;
  1035. } else {
  1036. /* get the data port structure for endpoint */
  1037. for (idx = 0; idx < MWIFIEX_TX_DATA_PORT; idx++) {
  1038. if (ep == card->port[idx].tx_data_ep) {
  1039. port = &card->port[idx];
  1040. if (atomic_read(&port->tx_data_urb_pending)
  1041. >= MWIFIEX_TX_DATA_URB) {
  1042. port->block_status = true;
  1043. adapter->data_sent =
  1044. mwifiex_usb_data_sent(adapter);
  1045. return -EBUSY;
  1046. }
  1047. if (port->tx_data_ix >= MWIFIEX_TX_DATA_URB)
  1048. port->tx_data_ix = 0;
  1049. break;
  1050. }
  1051. }
  1052. if (!port) {
  1053. mwifiex_dbg(adapter, ERROR, "Wrong usb tx data port\n");
  1054. return -1;
  1055. }
  1056. if (adapter->bus_aggr.enable) {
  1057. spin_lock_bh(&port->tx_aggr_lock);
  1058. ret = mwifiex_usb_aggr_tx_data(adapter, ep, skb,
  1059. tx_param, port);
  1060. spin_unlock_bh(&port->tx_aggr_lock);
  1061. return ret;
  1062. }
  1063. context = &port->tx_data_list[port->tx_data_ix++];
  1064. }
  1065. return mwifiex_usb_construct_send_urb(adapter, port, ep, context, skb);
  1066. }
  1067. static int mwifiex_usb_tx_init(struct mwifiex_adapter *adapter)
  1068. {
  1069. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  1070. struct usb_tx_data_port *port;
  1071. int i, j;
  1072. card->tx_cmd.adapter = adapter;
  1073. card->tx_cmd.ep = card->tx_cmd_ep;
  1074. card->tx_cmd.urb = usb_alloc_urb(0, GFP_KERNEL);
  1075. if (!card->tx_cmd.urb)
  1076. return -ENOMEM;
  1077. for (i = 0; i < MWIFIEX_TX_DATA_PORT; i++) {
  1078. port = &card->port[i];
  1079. if (!port->tx_data_ep)
  1080. continue;
  1081. port->tx_data_ix = 0;
  1082. skb_queue_head_init(&port->tx_aggr.aggr_list);
  1083. if (port->tx_data_ep == MWIFIEX_USB_EP_DATA)
  1084. port->block_status = false;
  1085. else
  1086. port->block_status = true;
  1087. for (j = 0; j < MWIFIEX_TX_DATA_URB; j++) {
  1088. port->tx_data_list[j].adapter = adapter;
  1089. port->tx_data_list[j].ep = port->tx_data_ep;
  1090. port->tx_data_list[j].urb =
  1091. usb_alloc_urb(0, GFP_KERNEL);
  1092. if (!port->tx_data_list[j].urb)
  1093. return -ENOMEM;
  1094. }
  1095. port->tx_aggr.timer_cnxt.adapter = adapter;
  1096. port->tx_aggr.timer_cnxt.port = port;
  1097. port->tx_aggr.timer_cnxt.is_hold_timer_set = false;
  1098. port->tx_aggr.timer_cnxt.hold_tmo_msecs = 0;
  1099. timer_setup(&port->tx_aggr.timer_cnxt.hold_timer,
  1100. mwifiex_usb_tx_aggr_tmo, 0);
  1101. }
  1102. return 0;
  1103. }
  1104. static int mwifiex_usb_rx_init(struct mwifiex_adapter *adapter)
  1105. {
  1106. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  1107. int i;
  1108. card->rx_cmd.adapter = adapter;
  1109. card->rx_cmd.ep = card->rx_cmd_ep;
  1110. card->rx_cmd.urb = usb_alloc_urb(0, GFP_KERNEL);
  1111. if (!card->rx_cmd.urb)
  1112. return -ENOMEM;
  1113. card->rx_cmd.skb = dev_alloc_skb(MWIFIEX_RX_CMD_BUF_SIZE);
  1114. if (!card->rx_cmd.skb)
  1115. return -ENOMEM;
  1116. if (mwifiex_usb_submit_rx_urb(&card->rx_cmd, MWIFIEX_RX_CMD_BUF_SIZE))
  1117. return -1;
  1118. for (i = 0; i < MWIFIEX_RX_DATA_URB; i++) {
  1119. card->rx_data_list[i].adapter = adapter;
  1120. card->rx_data_list[i].ep = card->rx_data_ep;
  1121. card->rx_data_list[i].urb = usb_alloc_urb(0, GFP_KERNEL);
  1122. if (!card->rx_data_list[i].urb)
  1123. return -1;
  1124. if (mwifiex_usb_submit_rx_urb(&card->rx_data_list[i],
  1125. MWIFIEX_RX_DATA_BUF_SIZE))
  1126. return -1;
  1127. }
  1128. return 0;
  1129. }
  1130. /* This function register usb device and initialize parameter. */
  1131. static int mwifiex_register_dev(struct mwifiex_adapter *adapter)
  1132. {
  1133. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  1134. card->adapter = adapter;
  1135. switch (le16_to_cpu(card->udev->descriptor.idProduct)) {
  1136. case USB8997_PID_1:
  1137. case USB8997_PID_2:
  1138. adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_4K;
  1139. strcpy(adapter->fw_name, USB8997_DEFAULT_FW_NAME);
  1140. adapter->ext_scan = true;
  1141. break;
  1142. case USB8766_PID_1:
  1143. case USB8766_PID_2:
  1144. adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_2K;
  1145. strcpy(adapter->fw_name, USB8766_DEFAULT_FW_NAME);
  1146. adapter->ext_scan = true;
  1147. break;
  1148. case USB8801_PID_1:
  1149. case USB8801_PID_2:
  1150. adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_2K;
  1151. strcpy(adapter->fw_name, USB8801_DEFAULT_FW_NAME);
  1152. adapter->ext_scan = false;
  1153. break;
  1154. case USB8797_PID_1:
  1155. case USB8797_PID_2:
  1156. default:
  1157. adapter->tx_buf_size = MWIFIEX_TX_DATA_BUF_SIZE_2K;
  1158. strcpy(adapter->fw_name, USB8797_DEFAULT_FW_NAME);
  1159. break;
  1160. }
  1161. adapter->usb_mc_status = false;
  1162. adapter->usb_mc_setup = false;
  1163. return 0;
  1164. }
  1165. static void mwifiex_usb_cleanup_tx_aggr(struct mwifiex_adapter *adapter)
  1166. {
  1167. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  1168. struct usb_tx_data_port *port;
  1169. struct sk_buff *skb_tmp;
  1170. int idx;
  1171. for (idx = 0; idx < MWIFIEX_TX_DATA_PORT; idx++) {
  1172. port = &card->port[idx];
  1173. if (adapter->bus_aggr.enable)
  1174. while ((skb_tmp =
  1175. skb_dequeue(&port->tx_aggr.aggr_list)))
  1176. mwifiex_write_data_complete(adapter, skb_tmp,
  1177. 0, -1);
  1178. if (port->tx_aggr.timer_cnxt.hold_timer.function)
  1179. del_timer_sync(&port->tx_aggr.timer_cnxt.hold_timer);
  1180. port->tx_aggr.timer_cnxt.is_hold_timer_set = false;
  1181. port->tx_aggr.timer_cnxt.hold_tmo_msecs = 0;
  1182. }
  1183. }
  1184. static void mwifiex_unregister_dev(struct mwifiex_adapter *adapter)
  1185. {
  1186. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  1187. mwifiex_usb_free(card);
  1188. mwifiex_usb_cleanup_tx_aggr(adapter);
  1189. card->adapter = NULL;
  1190. }
  1191. static int mwifiex_prog_fw_w_helper(struct mwifiex_adapter *adapter,
  1192. struct mwifiex_fw_image *fw)
  1193. {
  1194. int ret = 0;
  1195. u8 *firmware = fw->fw_buf, *recv_buff;
  1196. u32 retries = USB8XXX_FW_MAX_RETRY + 1;
  1197. u32 dlen;
  1198. u32 fw_seqnum = 0, tlen = 0, dnld_cmd = 0;
  1199. struct fw_data *fwdata;
  1200. struct fw_sync_header sync_fw;
  1201. u8 check_winner = 1;
  1202. if (!firmware) {
  1203. mwifiex_dbg(adapter, ERROR,
  1204. "No firmware image found! Terminating download\n");
  1205. ret = -1;
  1206. goto fw_exit;
  1207. }
  1208. /* Allocate memory for transmit */
  1209. fwdata = kzalloc(FW_DNLD_TX_BUF_SIZE, GFP_KERNEL);
  1210. if (!fwdata) {
  1211. ret = -ENOMEM;
  1212. goto fw_exit;
  1213. }
  1214. /* Allocate memory for receive */
  1215. recv_buff = kzalloc(FW_DNLD_RX_BUF_SIZE, GFP_KERNEL);
  1216. if (!recv_buff) {
  1217. ret = -ENOMEM;
  1218. goto cleanup;
  1219. }
  1220. do {
  1221. /* Send pseudo data to check winner status first */
  1222. if (check_winner) {
  1223. memset(&fwdata->fw_hdr, 0, sizeof(struct fw_header));
  1224. dlen = 0;
  1225. } else {
  1226. /* copy the header of the fw_data to get the length */
  1227. memcpy(&fwdata->fw_hdr, &firmware[tlen],
  1228. sizeof(struct fw_header));
  1229. dlen = le32_to_cpu(fwdata->fw_hdr.data_len);
  1230. dnld_cmd = le32_to_cpu(fwdata->fw_hdr.dnld_cmd);
  1231. tlen += sizeof(struct fw_header);
  1232. /* Command 7 doesn't have data length field */
  1233. if (dnld_cmd == FW_CMD_7)
  1234. dlen = 0;
  1235. memcpy(fwdata->data, &firmware[tlen], dlen);
  1236. fwdata->seq_num = cpu_to_le32(fw_seqnum);
  1237. tlen += dlen;
  1238. }
  1239. /* If the send/receive fails or CRC occurs then retry */
  1240. while (--retries) {
  1241. u8 *buf = (u8 *)fwdata;
  1242. u32 len = FW_DATA_XMIT_SIZE;
  1243. /* send the firmware block */
  1244. ret = mwifiex_write_data_sync(adapter, buf, &len,
  1245. MWIFIEX_USB_EP_CMD_EVENT,
  1246. MWIFIEX_USB_TIMEOUT);
  1247. if (ret) {
  1248. mwifiex_dbg(adapter, ERROR,
  1249. "write_data_sync: failed: %d\n",
  1250. ret);
  1251. continue;
  1252. }
  1253. buf = recv_buff;
  1254. len = FW_DNLD_RX_BUF_SIZE;
  1255. /* Receive the firmware block response */
  1256. ret = mwifiex_read_data_sync(adapter, buf, &len,
  1257. MWIFIEX_USB_EP_CMD_EVENT,
  1258. MWIFIEX_USB_TIMEOUT);
  1259. if (ret) {
  1260. mwifiex_dbg(adapter, ERROR,
  1261. "read_data_sync: failed: %d\n",
  1262. ret);
  1263. continue;
  1264. }
  1265. memcpy(&sync_fw, recv_buff,
  1266. sizeof(struct fw_sync_header));
  1267. /* check 1st firmware block resp for highest bit set */
  1268. if (check_winner) {
  1269. if (le32_to_cpu(sync_fw.cmd) & 0x80000000) {
  1270. mwifiex_dbg(adapter, WARN,
  1271. "USB is not the winner %#x\n",
  1272. sync_fw.cmd);
  1273. /* returning success */
  1274. ret = 0;
  1275. goto cleanup;
  1276. }
  1277. mwifiex_dbg(adapter, MSG,
  1278. "start to download FW...\n");
  1279. check_winner = 0;
  1280. break;
  1281. }
  1282. /* check the firmware block response for CRC errors */
  1283. if (sync_fw.cmd) {
  1284. mwifiex_dbg(adapter, ERROR,
  1285. "FW received block with CRC %#x\n",
  1286. sync_fw.cmd);
  1287. ret = -1;
  1288. continue;
  1289. }
  1290. retries = USB8XXX_FW_MAX_RETRY + 1;
  1291. break;
  1292. }
  1293. fw_seqnum++;
  1294. } while ((dnld_cmd != FW_HAS_LAST_BLOCK) && retries);
  1295. cleanup:
  1296. mwifiex_dbg(adapter, MSG,
  1297. "info: FW download over, size %d bytes\n", tlen);
  1298. kfree(recv_buff);
  1299. kfree(fwdata);
  1300. if (retries)
  1301. ret = 0;
  1302. fw_exit:
  1303. return ret;
  1304. }
  1305. static int mwifiex_usb_dnld_fw(struct mwifiex_adapter *adapter,
  1306. struct mwifiex_fw_image *fw)
  1307. {
  1308. int ret;
  1309. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  1310. if (card->usb_boot_state == USB8XXX_FW_DNLD) {
  1311. ret = mwifiex_prog_fw_w_helper(adapter, fw);
  1312. if (ret)
  1313. return -1;
  1314. /* Boot state changes after successful firmware download */
  1315. if (card->usb_boot_state == USB8XXX_FW_DNLD)
  1316. return -1;
  1317. }
  1318. ret = mwifiex_usb_rx_init(adapter);
  1319. if (!ret)
  1320. ret = mwifiex_usb_tx_init(adapter);
  1321. return ret;
  1322. }
  1323. static void mwifiex_submit_rx_urb(struct mwifiex_adapter *adapter, u8 ep)
  1324. {
  1325. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  1326. skb_push(card->rx_cmd.skb, INTF_HEADER_LEN);
  1327. if ((ep == card->rx_cmd_ep) &&
  1328. (!atomic_read(&card->rx_cmd_urb_pending)))
  1329. mwifiex_usb_submit_rx_urb(&card->rx_cmd,
  1330. MWIFIEX_RX_CMD_BUF_SIZE);
  1331. return;
  1332. }
  1333. static int mwifiex_usb_cmd_event_complete(struct mwifiex_adapter *adapter,
  1334. struct sk_buff *skb)
  1335. {
  1336. mwifiex_submit_rx_urb(adapter, MWIFIEX_USB_EP_CMD_EVENT);
  1337. return 0;
  1338. }
  1339. /* This function wakes up the card. */
  1340. static int mwifiex_pm_wakeup_card(struct mwifiex_adapter *adapter)
  1341. {
  1342. /* Simulation of HS_AWAKE event */
  1343. adapter->pm_wakeup_fw_try = false;
  1344. del_timer(&adapter->wakeup_timer);
  1345. adapter->pm_wakeup_card_req = false;
  1346. adapter->ps_state = PS_STATE_AWAKE;
  1347. return 0;
  1348. }
  1349. static void mwifiex_usb_submit_rem_rx_urbs(struct mwifiex_adapter *adapter)
  1350. {
  1351. struct usb_card_rec *card = (struct usb_card_rec *)adapter->card;
  1352. int i;
  1353. struct urb_context *ctx;
  1354. for (i = 0; i < MWIFIEX_RX_DATA_URB; i++) {
  1355. if (card->rx_data_list[i].skb)
  1356. continue;
  1357. ctx = &card->rx_data_list[i];
  1358. mwifiex_usb_submit_rx_urb(ctx, MWIFIEX_RX_DATA_BUF_SIZE);
  1359. }
  1360. }
  1361. /* This function is called after the card has woken up. */
  1362. static inline int
  1363. mwifiex_pm_wakeup_card_complete(struct mwifiex_adapter *adapter)
  1364. {
  1365. return 0;
  1366. }
  1367. static struct mwifiex_if_ops usb_ops = {
  1368. .register_dev = mwifiex_register_dev,
  1369. .unregister_dev = mwifiex_unregister_dev,
  1370. .wakeup = mwifiex_pm_wakeup_card,
  1371. .wakeup_complete = mwifiex_pm_wakeup_card_complete,
  1372. /* USB specific */
  1373. .dnld_fw = mwifiex_usb_dnld_fw,
  1374. .cmdrsp_complete = mwifiex_usb_cmd_event_complete,
  1375. .event_complete = mwifiex_usb_cmd_event_complete,
  1376. .host_to_card = mwifiex_usb_host_to_card,
  1377. .submit_rem_rx_urbs = mwifiex_usb_submit_rem_rx_urbs,
  1378. .multi_port_resync = mwifiex_usb_port_resync,
  1379. .is_port_ready = mwifiex_usb_is_port_ready,
  1380. };
  1381. module_usb_driver(mwifiex_usb_driver);
  1382. MODULE_AUTHOR("Marvell International Ltd.");
  1383. MODULE_DESCRIPTION("Marvell WiFi-Ex USB Driver version" USB_VERSION);
  1384. MODULE_VERSION(USB_VERSION);
  1385. MODULE_LICENSE("GPL v2");
  1386. MODULE_FIRMWARE(USB8766_DEFAULT_FW_NAME);
  1387. MODULE_FIRMWARE(USB8797_DEFAULT_FW_NAME);
  1388. MODULE_FIRMWARE(USB8801_DEFAULT_FW_NAME);
  1389. MODULE_FIRMWARE(USB8997_DEFAULT_FW_NAME);