drivers/net/wireless/marvell/mwifiex/usb.c

   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         .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                         *(__le16 *)payload = cpu_to_le16(skb_tmp->len);
 915                         *(__le16 *)&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                         *(__le16 *)payload = cpu_to_le16(skb_tmp->len + pad);
 921                         *(__le16 *)&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                 *(__le16 *)&payload[2] =
1101                         cpu_to_le16(MWIFIEX_TYPE_AGGR_DATA_V2 | 0x80);
1102                 *(__le16 *)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);