linux/drivers/net/wireless/marvell/mwifiex/usb.c
<<
>>
Prefs
   1/*
   2 * NXP Wireless LAN device driver: USB specific handling
   3 *
   4 * Copyright 2011-2020 NXP
   5 *
   6 * This software file (the "File") is distributed by NXP
   7 * 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
  25static struct mwifiex_if_ops usb_ops;
  26
  27static 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
  51MODULE_DEVICE_TABLE(usb, mwifiex_usb_table);
  52
  53static 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 */
  58static 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
 156exit_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
 163static 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
 237setup_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
 256static 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
 296static 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
 356static 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 */
 396static 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 */
 530static 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 */
 597static 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
 642static 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
 668static 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
 677static 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
 690static 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
 713static 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
 733static 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
 780static 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
 793static 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
 805static 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
 866static 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 */
 951static 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
1065send_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
1104postcopy_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
1123static 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);
1156done:
1157        if (err == -1)
1158                mwifiex_write_data_complete(adapter, skb_send, 0, -1);
1159unlock:
1160        spin_unlock_bh(&port->tx_aggr_lock);
1161}
1162
1163/* This function write a command/data packet to card. */
1164static 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
1225static 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
1268static 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. */
1303static 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
1342static 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
1362static 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
1373static 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
1497cleanup:
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;
1506fw_exit:
1507        return ret;
1508}
1509
1510static 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
1533static 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
1546static 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. */
1555static 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
1566static 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. */
1581static inline int
1582mwifiex_pm_wakeup_card_complete(struct mwifiex_adapter *adapter)
1583{
1584        return 0;
1585}
1586
1587static 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
1603module_usb_driver(mwifiex_usb_driver);
1604
1605MODULE_AUTHOR("Marvell International Ltd.");
1606MODULE_DESCRIPTION("Marvell WiFi-Ex USB Driver version" USB_VERSION);
1607MODULE_VERSION(USB_VERSION);
1608MODULE_LICENSE("GPL v2");
1609MODULE_FIRMWARE(USB8766_DEFAULT_FW_NAME);
1610MODULE_FIRMWARE(USB8797_DEFAULT_FW_NAME);
1611MODULE_FIRMWARE(USB8801_DEFAULT_FW_NAME);
1612MODULE_FIRMWARE(USB8997_DEFAULT_FW_NAME);
1613