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

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