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