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