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