drivers/net/wireless/rsi/rsi_91x_usb.c

   1 /*
   2  * Copyright (c) 2014 Redpine Signals Inc.
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  *
  16  */
  17
  18 #include <linux/module.h>
  19 #include <linux/types.h>
  20 #include <net/rsi_91x.h>
  21 #include "rsi_usb.h"
  22 #include "rsi_hal.h"
  23 #include "rsi_coex.h"
  24
  25 /* Default operating mode is wlan STA + BT */
  26 static u16 dev_oper_mode = DEV_OPMODE_STA_BT_DUAL;
  27 module_param(dev_oper_mode, ushort, 0444);
  28 MODULE_PARM_DESC(dev_oper_mode,
  29                  "1[Wi-Fi], 4[BT], 8[BT LE], 5[Wi-Fi STA + BT classic]\n"
  30                  "9[Wi-Fi STA + BT LE], 13[Wi-Fi STA + BT classic + BT LE]\n"
  31                  "6[AP + BT classic], 14[AP + BT classic + BT LE]");
  32
  33 static int rsi_rx_urb_submit(struct rsi_hw *adapter, u8 ep_num, gfp_t flags);
  34
  35 /**
  36  * rsi_usb_card_write() - This function writes to the USB Card.
  37  * @adapter: Pointer to the adapter structure.
  38  * @buf: Pointer to the buffer from where the data has to be taken.
  39  * @len: Length to be written.
  40  * @endpoint: Type of endpoint.
  41  *
  42  * Return: status: 0 on success, a negative error code on failure.
  43  */
  44 static int rsi_usb_card_write(struct rsi_hw *adapter,
  45                               u8 *buf,
  46                               u16 len,
  47                               u8 endpoint)
  48 {
  49         struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
  50         int status;
  51         u8 *seg = dev->tx_buffer;
  52         int transfer;
  53         int ep = dev->bulkout_endpoint_addr[endpoint - 1];
  54
  55         memset(seg, 0, len + RSI_USB_TX_HEAD_ROOM);
  56         memcpy(seg + RSI_USB_TX_HEAD_ROOM, buf, len);
  57         len += RSI_USB_TX_HEAD_ROOM;
  58         transfer = len;
  59         status = usb_bulk_msg(dev->usbdev,
  60                               usb_sndbulkpipe(dev->usbdev, ep),
  61                               (void *)seg,
  62                               (int)len,
  63                               &transfer,
  64                               HZ * 5);
  65
  66         if (status < 0) {
  67                 rsi_dbg(ERR_ZONE,
  68                         "Card write failed with error code :%10d\n", status);
  69                 dev->write_fail = 1;
  70         }
  71         return status;
  72 }
  73
  74 /**
  75  * rsi_write_multiple() - This function writes multiple bytes of information
  76  *                        to the USB card.
  77  * @adapter: Pointer to the adapter structure.
  78  * @endpoint: Type of endpoint.
  79  * @data: Pointer to the data that has to be written.
  80  * @count: Number of multiple bytes to be written.
  81  *
  82  * Return: 0 on success, a negative error code on failure.
  83  */
  84 static int rsi_write_multiple(struct rsi_hw *adapter,
  85                               u8 endpoint,
  86                               u8 *data,
  87                               u32 count)
  88 {
  89         struct rsi_91x_usbdev *dev;
  90
  91         if (!adapter)
  92                 return -ENODEV;
  93
  94         if (endpoint == 0)
  95                 return -EINVAL;
  96
  97         dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
  98         if (dev->write_fail)
  99                 return -ENETDOWN;
 100
 101         return rsi_usb_card_write(adapter, data, count, endpoint);
 102 }
 103
 104 /**
 105  * rsi_find_bulk_in_and_out_endpoints() - This function initializes the bulk
 106  *                                        endpoints to the device.
 107  * @interface: Pointer to the USB interface structure.
 108  * @adapter: Pointer to the adapter structure.
 109  *
 110  * Return: ret_val: 0 on success, -ENOMEM on failure.
 111  */
 112 static int rsi_find_bulk_in_and_out_endpoints(struct usb_interface *interface,
 113                                               struct rsi_hw *adapter)
 114 {
 115         struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
 116         struct usb_host_interface *iface_desc;
 117         struct usb_endpoint_descriptor *endpoint;
 118         __le16 buffer_size;
 119         int ii, bin_found = 0, bout_found = 0;
 120
 121         iface_desc = interface->cur_altsetting;
 122
 123         for (ii = 0; ii < iface_desc->desc.bNumEndpoints; ++ii) {
 124                 endpoint = &(iface_desc->endpoint[ii].desc);
 125
 126                 if (!dev->bulkin_endpoint_addr[bin_found] &&
 127                     (endpoint->bEndpointAddress & USB_DIR_IN) &&
 128                     ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
 129                     USB_ENDPOINT_XFER_BULK)) {
 130                         buffer_size = endpoint->wMaxPacketSize;
 131                         dev->bulkin_size[bin_found] = buffer_size;
 132                         dev->bulkin_endpoint_addr[bin_found] =
 133                                 endpoint->bEndpointAddress;
 134                         bin_found++;
 135                 }
 136
 137                 if (!dev->bulkout_endpoint_addr[bout_found] &&
 138                     !(endpoint->bEndpointAddress & USB_DIR_IN) &&
 139                     ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
 140                     USB_ENDPOINT_XFER_BULK)) {
 141                         buffer_size = endpoint->wMaxPacketSize;
 142                         dev->bulkout_endpoint_addr[bout_found] =
 143                                 endpoint->bEndpointAddress;
 144                         dev->bulkout_size[bout_found] = buffer_size;
 145                         bout_found++;
 146                 }
 147
 148                 if (bin_found >= MAX_BULK_EP || bout_found >= MAX_BULK_EP)
 149                         break;
 150         }
 151
 152         if (!(dev->bulkin_endpoint_addr[0] && dev->bulkout_endpoint_addr[0])) {
 153                 dev_err(&interface->dev, "missing wlan bulk endpoints\n");
 154                 return -EINVAL;
 155         }
 156
 157         if (adapter->priv->coex_mode > 1) {
 158                 if (!dev->bulkin_endpoint_addr[1]) {
 159                         dev_err(&interface->dev, "missing bt bulk-in endpoint\n");
 160                         return -EINVAL;
 161                 }
 162         }
 163
 164         return 0;
 165 }
 166
 167 #define RSI_USB_REQ_OUT (USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE)
 168 #define RSI_USB_REQ_IN  (USB_TYPE_VENDOR | USB_DIR_IN | USB_RECIP_DEVICE)
 169
 170 /* rsi_usb_reg_read() - This function reads data from given register address.
 171  * @usbdev: Pointer to the usb_device structure.
 172  * @reg: Address of the register to be read.
 173  * @value: Value to be read.
 174  * @len: length of data to be read.
 175  *
 176  * Return: status: 0 on success, a negative error code on failure.
 177  */
 178 static int rsi_usb_reg_read(struct usb_device *usbdev,
 179                             u32 reg,
 180                             u16 *value,
 181                             u16 len)
 182 {
 183         u8 *buf;
 184         int status = -ENOMEM;
 185
 186         if (len > RSI_USB_CTRL_BUF_SIZE)
 187                 return -EINVAL;
 188
 189         buf  = kmalloc(RSI_USB_CTRL_BUF_SIZE, GFP_KERNEL);
 190         if (!buf)
 191                 return status;
 192
 193         status = usb_control_msg(usbdev,
 194                                  usb_rcvctrlpipe(usbdev, 0),
 195                                  USB_VENDOR_REGISTER_READ,
 196                                  RSI_USB_REQ_IN,
 197                                  ((reg & 0xffff0000) >> 16), (reg & 0xffff),
 198                                  (void *)buf,
 199                                  len,
 200                                  USB_CTRL_GET_TIMEOUT);
 201
 202         *value = (buf[0] | (buf[1] << 8));
 203         if (status < 0) {
 204                 rsi_dbg(ERR_ZONE,
 205                         "%s: Reg read failed with error code :%d\n",
 206                         __func__, status);
 207         }
 208         kfree(buf);
 209
 210         return status;
 211 }
 212
 213 /**
 214  * rsi_usb_reg_write() - This function writes the given data into the given
 215  *                       register address.
 216  * @usbdev: Pointer to the usb_device structure.
 217  * @reg: Address of the register.
 218  * @value: Value to write.
 219  * @len: Length of data to be written.
 220  *
 221  * Return: status: 0 on success, a negative error code on failure.
 222  */
 223 static int rsi_usb_reg_write(struct usb_device *usbdev,
 224                              u32 reg,
 225                              u32 value,
 226                              u16 len)
 227 {
 228         u8 *usb_reg_buf;
 229         int status = -ENOMEM;
 230
 231         if (len > RSI_USB_CTRL_BUF_SIZE)
 232                 return -EINVAL;
 233
 234         usb_reg_buf  = kmalloc(RSI_USB_CTRL_BUF_SIZE, GFP_KERNEL);
 235         if (!usb_reg_buf)
 236                 return status;
 237
 238         usb_reg_buf[0] = (cpu_to_le32(value) & 0x00ff);
 239         usb_reg_buf[1] = (cpu_to_le32(value) & 0xff00) >> 8;
 240         usb_reg_buf[2] = (cpu_to_le32(value) & 0x00ff0000) >> 16;
 241         usb_reg_buf[3] = (cpu_to_le32(value) & 0xff000000) >> 24;
 242
 243         status = usb_control_msg(usbdev,
 244                                  usb_sndctrlpipe(usbdev, 0),
 245                                  USB_VENDOR_REGISTER_WRITE,
 246                                  RSI_USB_REQ_OUT,
 247                                  ((cpu_to_le32(reg) & 0xffff0000) >> 16),
 248                                  (cpu_to_le32(reg) & 0xffff),
 249                                  (void *)usb_reg_buf,
 250                                  len,
 251                                  USB_CTRL_SET_TIMEOUT);
 252         if (status < 0) {
 253                 rsi_dbg(ERR_ZONE,
 254                         "%s: Reg write failed with error code :%d\n",
 255                         __func__, status);
 256         }
 257         kfree(usb_reg_buf);
 258
 259         return status;
 260 }
 261
 262 /**
 263  * rsi_rx_done_handler() - This function is called when a packet is received
 264  *                         from USB stack. This is callback to receive done.
 265  * @urb: Received URB.
 266  *
 267  * Return: None.
 268  */
 269 static void rsi_rx_done_handler(struct urb *urb)
 270 {
 271         struct rx_usb_ctrl_block *rx_cb = urb->context;
 272         struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)rx_cb->data;
 273         int status = -EINVAL;
 274
 275         if (urb->status) {
 276                 dev_kfree_skb(rx_cb->rx_skb);
 277                 return;
 278         }
 279
 280         if (urb->actual_length <= 0 ||
 281             urb->actual_length > rx_cb->rx_skb->len) {
 282                 rsi_dbg(INFO_ZONE, "%s: Invalid packet length = %d\n",
 283                         __func__, urb->actual_length);
 284                 goto out;
 285         }
 286         if (skb_queue_len(&dev->rx_q) >= RSI_MAX_RX_PKTS) {
 287                 rsi_dbg(INFO_ZONE, "Max RX packets reached\n");
 288                 goto out;
 289         }
 290         skb_trim(rx_cb->rx_skb, urb->actual_length);
 291         skb_queue_tail(&dev->rx_q, rx_cb->rx_skb);
 292
 293         rsi_set_event(&dev->rx_thread.event);
 294         status = 0;
 295
 296 out:
 297         if (rsi_rx_urb_submit(dev->priv, rx_cb->ep_num, GFP_ATOMIC))
 298                 rsi_dbg(ERR_ZONE, "%s: Failed in urb submission", __func__);
 299
 300         if (status)
 301                 dev_kfree_skb(rx_cb->rx_skb);
 302 }
 303
 304 static void rsi_rx_urb_kill(struct rsi_hw *adapter, u8 ep_num)
 305 {
 306         struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
 307         struct rx_usb_ctrl_block *rx_cb = &dev->rx_cb[ep_num - 1];
 308         struct urb *urb = rx_cb->rx_urb;
 309
 310         usb_kill_urb(urb);
 311 }
 312
 313 /**
 314  * rsi_rx_urb_submit() - This function submits the given URB to the USB stack.
 315  * @adapter: Pointer to the adapter structure.
 316  * @ep_num: Endpoint number.
 317  * @mem_flags: The type of memory to allocate.
 318  *
 319  * Return: 0 on success, a negative error code on failure.
 320  */
 321 static int rsi_rx_urb_submit(struct rsi_hw *adapter, u8 ep_num, gfp_t mem_flags)
 322 {
 323         struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
 324         struct rx_usb_ctrl_block *rx_cb = &dev->rx_cb[ep_num - 1];
 325         struct urb *urb = rx_cb->rx_urb;
 326         int status;
 327         struct sk_buff *skb;
 328         u8 dword_align_bytes = 0;
 329
 330 #define RSI_MAX_RX_USB_PKT_SIZE 3000
 331         skb = dev_alloc_skb(RSI_MAX_RX_USB_PKT_SIZE);
 332         if (!skb)
 333                 return -ENOMEM;
 334         skb_reserve(skb, MAX_DWORD_ALIGN_BYTES);
 335         skb_put(skb, RSI_MAX_RX_USB_PKT_SIZE - MAX_DWORD_ALIGN_BYTES);
 336         dword_align_bytes = (unsigned long)skb->data & 0x3f;
 337         if (dword_align_bytes > 0)
 338                 skb_push(skb, dword_align_bytes);
 339         urb->transfer_buffer = skb->data;
 340         rx_cb->rx_skb = skb;
 341
 342         usb_fill_bulk_urb(urb,
 343                           dev->usbdev,
 344                           usb_rcvbulkpipe(dev->usbdev,
 345                           dev->bulkin_endpoint_addr[ep_num - 1]),
 346                           urb->transfer_buffer,
 347                           skb->len,
 348                           rsi_rx_done_handler,
 349                           rx_cb);
 350
 351         status = usb_submit_urb(urb, mem_flags);
 352         if (status) {
 353                 rsi_dbg(ERR_ZONE, "%s: Failed in urb submission\n", __func__);
 354                 dev_kfree_skb(skb);
 355         }
 356
 357         return status;
 358 }
 359
 360 static int rsi_usb_read_register_multiple(struct rsi_hw *adapter, u32 addr,
 361                                           u8 *data, u16 count)
 362 {
 363         struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
 364         u8 *buf;
 365         u16 transfer;
 366         int status;
 367
 368         if (!addr)
 369                 return -EINVAL;
 370
 371         buf = kzalloc(RSI_USB_BUF_SIZE, GFP_KERNEL);
 372         if (!buf)
 373                 return -ENOMEM;
 374
 375         while (count) {
 376                 transfer = min_t(u16, count, RSI_USB_BUF_SIZE);
 377                 status = usb_control_msg(dev->usbdev,
 378                                          usb_rcvctrlpipe(dev->usbdev, 0),
 379                                          USB_VENDOR_REGISTER_READ,
 380                                          RSI_USB_REQ_IN,
 381                                          ((addr & 0xffff0000) >> 16),
 382                                          (addr & 0xffff), (void *)buf,
 383                                          transfer, USB_CTRL_GET_TIMEOUT);
 384                 if (status < 0) {
 385                         rsi_dbg(ERR_ZONE,
 386                                 "Reg read failed with error code :%d\n",
 387                                  status);
 388                         kfree(buf);
 389                         return status;
 390                 }
 391                 memcpy(data, buf, transfer);
 392                 count -= transfer;
 393                 data += transfer;
 394                 addr += transfer;
 395         }
 396         kfree(buf);
 397         return 0;
 398 }
 399
 400 /**
 401  * rsi_usb_write_register_multiple() - This function writes multiple bytes of
 402  *                                     information to multiple registers.
 403  * @adapter: Pointer to the adapter structure.
 404  * @addr: Address of the register.
 405  * @data: Pointer to the data that has to be written.
 406  * @count: Number of multiple bytes to be written on to the registers.
 407  *
 408  * Return: status: 0 on success, a negative error code on failure.
 409  */
 410 static int rsi_usb_write_register_multiple(struct rsi_hw *adapter, u32 addr,
 411                                            u8 *data, u16 count)
 412 {
 413         struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
 414         u8 *buf;
 415         u16 transfer;
 416         int status = 0;
 417
 418         buf = kzalloc(RSI_USB_BUF_SIZE, GFP_KERNEL);
 419         if (!buf)
 420                 return -ENOMEM;
 421
 422         while (count) {
 423                 transfer = min_t(u16, count, RSI_USB_BUF_SIZE);
 424                 memcpy(buf, data, transfer);
 425                 status = usb_control_msg(dev->usbdev,
 426                                          usb_sndctrlpipe(dev->usbdev, 0),
 427                                          USB_VENDOR_REGISTER_WRITE,
 428                                          RSI_USB_REQ_OUT,
 429                                          ((addr & 0xffff0000) >> 16),
 430                                          (addr & 0xffff),
 431                                          (void *)buf,
 432                                          transfer,
 433                                          USB_CTRL_SET_TIMEOUT);
 434                 if (status < 0) {
 435                         rsi_dbg(ERR_ZONE,
 436                                 "Reg write failed with error code :%d\n",
 437                                 status);
 438                         kfree(buf);
 439                         return status;
 440                 }
 441                 count -= transfer;
 442                 data += transfer;
 443                 addr += transfer;
 444         }
 445
 446         kfree(buf);
 447         return 0;
 448 }
 449
 450 /**
 451  *rsi_usb_host_intf_write_pkt() - This function writes the packet to the
 452  *                                 USB card.
 453  * @adapter: Pointer to the adapter structure.
 454  * @pkt: Pointer to the data to be written on to the card.
 455  * @len: Length of the data to be written on to the card.
 456  *
 457  * Return: 0 on success, a negative error code on failure.
 458  */
 459 static int rsi_usb_host_intf_write_pkt(struct rsi_hw *adapter,
 460                                        u8 *pkt,
 461                                        u32 len)
 462 {
 463         u32 queueno = ((pkt[1] >> 4) & 0x7);
 464         u8 endpoint;
 465
 466         endpoint = ((queueno == RSI_WIFI_MGMT_Q || queueno == RSI_WIFI_DATA_Q ||
 467                      queueno == RSI_COEX_Q) ? WLAN_EP : BT_EP);
 468
 469         return rsi_write_multiple(adapter,
 470                                   endpoint,
 471                                   (u8 *)pkt,
 472                                   len);
 473 }
 474
 475 static int rsi_usb_master_reg_read(struct rsi_hw *adapter, u32 reg,
 476                                    u32 *value, u16 len)
 477 {
 478         struct usb_device *usbdev =
 479                 ((struct rsi_91x_usbdev *)adapter->rsi_dev)->usbdev;
 480         u16 temp;
 481         int ret;
 482
 483         ret = rsi_usb_reg_read(usbdev, reg, &temp, len);
 484         if (ret < 0)
 485                 return ret;
 486         *value = temp;
 487
 488         return 0;
 489 }
 490
 491 static int rsi_usb_master_reg_write(struct rsi_hw *adapter,
 492                                     unsigned long reg,
 493                                     unsigned long value, u16 len)
 494 {
 495         struct usb_device *usbdev =
 496                 ((struct rsi_91x_usbdev *)adapter->rsi_dev)->usbdev;
 497
 498         return rsi_usb_reg_write(usbdev, reg, value, len);
 499 }
 500
 501 static int rsi_usb_load_data_master_write(struct rsi_hw *adapter,
 502                                           u32 base_address,
 503                                           u32 instructions_sz, u16 block_size,
 504                                           u8 *ta_firmware)
 505 {
 506         u16 num_blocks;
 507         u32 cur_indx, i;
 508         u8 temp_buf[256];
 509         int status;
 510
 511         num_blocks = instructions_sz / block_size;
 512         rsi_dbg(INFO_ZONE, "num_blocks: %d\n", num_blocks);
 513
 514         for (cur_indx = 0, i = 0; i < num_blocks; i++, cur_indx += block_size) {
 515                 memcpy(temp_buf, ta_firmware + cur_indx, block_size);
 516                 status = rsi_usb_write_register_multiple(adapter, base_address,
 517                                                          (u8 *)(temp_buf),
 518                                                          block_size);
 519                 if (status < 0)
 520                         return status;
 521
 522                 rsi_dbg(INFO_ZONE, "%s: loading block: %d\n", __func__, i);
 523                 base_address += block_size;
 524         }
 525
 526         if (instructions_sz % block_size) {
 527                 memset(temp_buf, 0, block_size);
 528                 memcpy(temp_buf, ta_firmware + cur_indx,
 529                        instructions_sz % block_size);
 530                 status = rsi_usb_write_register_multiple
 531                                                 (adapter, base_address,
 532                                                  (u8 *)temp_buf,
 533                                                  instructions_sz % block_size);
 534                 if (status < 0)
 535                         return status;
 536                 rsi_dbg(INFO_ZONE,
 537                         "Written Last Block in Address 0x%x Successfully\n",
 538                         cur_indx);
 539         }
 540         return 0;
 541 }
 542
 543 static struct rsi_host_intf_ops usb_host_intf_ops = {
 544         .write_pkt              = rsi_usb_host_intf_write_pkt,
 545         .read_reg_multiple      = rsi_usb_read_register_multiple,
 546         .write_reg_multiple     = rsi_usb_write_register_multiple,
 547         .master_reg_read        = rsi_usb_master_reg_read,
 548         .master_reg_write       = rsi_usb_master_reg_write,
 549         .load_data_master_write = rsi_usb_load_data_master_write,
 550 };
 551
 552 /**
 553  * rsi_deinit_usb_interface() - This function deinitializes the usb interface.
 554  * @adapter: Pointer to the adapter structure.
 555  *
 556  * Return: None.
 557  */
 558 static void rsi_deinit_usb_interface(struct rsi_hw *adapter)
 559 {
 560         struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
 561
 562         rsi_kill_thread(&dev->rx_thread);
 563
 564         usb_free_urb(dev->rx_cb[0].rx_urb);
 565         if (adapter->priv->coex_mode > 1)
 566                 usb_free_urb(dev->rx_cb[1].rx_urb);
 567
 568         kfree(dev->tx_buffer);
 569 }
 570
 571 static int rsi_usb_init_rx(struct rsi_hw *adapter)
 572 {
 573         struct rsi_91x_usbdev *dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
 574         struct rx_usb_ctrl_block *rx_cb;
 575         u8 idx, num_rx_cb;
 576
 577         num_rx_cb = (adapter->priv->coex_mode > 1 ? 2 : 1);
 578
 579         for (idx = 0; idx < num_rx_cb; idx++) {
 580                 rx_cb = &dev->rx_cb[idx];
 581
 582                 rx_cb->rx_urb = usb_alloc_urb(0, GFP_KERNEL);
 583                 if (!rx_cb->rx_urb) {
 584                         rsi_dbg(ERR_ZONE, "Failed alloc rx urb[%d]\n", idx);
 585                         goto err;
 586                 }
 587                 rx_cb->ep_num = idx + 1;
 588                 rx_cb->data = (void *)dev;
 589         }
 590         skb_queue_head_init(&dev->rx_q);
 591         rsi_init_event(&dev->rx_thread.event);
 592         if (rsi_create_kthread(adapter->priv, &dev->rx_thread,
 593                                rsi_usb_rx_thread, "RX-Thread")) {
 594                 rsi_dbg(ERR_ZONE, "%s: Unable to init rx thrd\n", __func__);
 595                 goto err;
 596         }
 597
 598         return 0;
 599
 600 err:
 601         usb_free_urb(dev->rx_cb[0].rx_urb);
 602         if (adapter->priv->coex_mode > 1)
 603                 usb_free_urb(dev->rx_cb[1].rx_urb);
 604
 605         return -1;
 606 }
 607
 608 /**
 609  * rsi_init_usb_interface() - This function initializes the usb interface.
 610  * @adapter: Pointer to the adapter structure.
 611  * @pfunction: Pointer to USB interface structure.
 612  *
 613  * Return: 0 on success, a negative error code on failure.
 614  */
 615 static int rsi_init_usb_interface(struct rsi_hw *adapter,
 616                                   struct usb_interface *pfunction)
 617 {
 618         struct rsi_91x_usbdev *rsi_dev;
 619         int status;
 620
 621         rsi_dev = kzalloc(sizeof(*rsi_dev), GFP_KERNEL);
 622         if (!rsi_dev)
 623                 return -ENOMEM;
 624
 625         adapter->rsi_dev = rsi_dev;
 626         rsi_dev->usbdev = interface_to_usbdev(pfunction);
 627         rsi_dev->priv = (void *)adapter;
 628
 629         if (rsi_find_bulk_in_and_out_endpoints(pfunction, adapter)) {
 630                 status = -EINVAL;
 631                 goto fail_eps;
 632         }
 633
 634         adapter->device = &pfunction->dev;
 635         usb_set_intfdata(pfunction, adapter);
 636
 637         rsi_dev->tx_buffer = kmalloc(2048, GFP_KERNEL);
 638         if (!rsi_dev->tx_buffer) {
 639                 status = -ENOMEM;
 640                 goto fail_eps;
 641         }
 642
 643         if (rsi_usb_init_rx(adapter)) {
 644                 rsi_dbg(ERR_ZONE, "Failed to init RX handle\n");
 645                 status = -ENOMEM;
 646                 goto fail_rx;
 647         }
 648
 649         rsi_dev->tx_blk_size = 252;
 650         adapter->block_size = rsi_dev->tx_blk_size;
 651
 652         /* Initializing function callbacks */
 653         adapter->check_hw_queue_status = rsi_usb_check_queue_status;
 654         adapter->determine_event_timeout = rsi_usb_event_timeout;
 655         adapter->rsi_host_intf = RSI_HOST_INTF_USB;
 656         adapter->host_intf_ops = &usb_host_intf_ops;
 657
 658 #ifdef CONFIG_RSI_DEBUGFS
 659         /* In USB, one less than the MAX_DEBUGFS_ENTRIES entries is required */
 660         adapter->num_debugfs_entries = (MAX_DEBUGFS_ENTRIES - 1);
 661 #endif
 662
 663         rsi_dbg(INIT_ZONE, "%s: Enabled the interface\n", __func__);
 664         return 0;
 665
 666 fail_rx:
 667         kfree(rsi_dev->tx_buffer);
 668
 669 fail_eps:
 670
 671         return status;
 672 }
 673
 674 static int usb_ulp_read_write(struct rsi_hw *adapter, u16 addr, u32 data,
 675                               u16 len_in_bits)
 676 {
 677         int ret;
 678
 679         ret = rsi_usb_master_reg_write
 680                         (adapter, RSI_GSPI_DATA_REG1,
 681                          ((addr << 6) | ((data >> 16) & 0xffff)), 2);
 682         if (ret < 0)
 683                 return ret;
 684
 685         ret = rsi_usb_master_reg_write(adapter, RSI_GSPI_DATA_REG0,
 686                                        (data & 0xffff), 2);
 687         if (ret < 0)
 688                 return ret;
 689
 690         /* Initializing GSPI for ULP read/writes */
 691         rsi_usb_master_reg_write(adapter, RSI_GSPI_CTRL_REG0,
 692                                  RSI_GSPI_CTRL_REG0_VALUE, 2);
 693
 694         ret = rsi_usb_master_reg_write(adapter, RSI_GSPI_CTRL_REG1,
 695                                        ((len_in_bits - 1) | RSI_GSPI_TRIG), 2);
 696         if (ret < 0)
 697                 return ret;
 698
 699         msleep(20);
 700
 701         return 0;
 702 }
 703
 704 static int rsi_reset_card(struct rsi_hw *adapter)
 705 {
 706         int ret;
 707
 708         rsi_dbg(INFO_ZONE, "Resetting Card...\n");
 709         rsi_usb_master_reg_write(adapter, RSI_TA_HOLD_REG, 0xE, 4);
 710
 711         /* This msleep will ensure Thread-Arch processor to go to hold
 712          * and any pending dma transfers to rf in device to finish.
 713          */
 714         msleep(100);
 715
 716         ret = rsi_usb_master_reg_write(adapter, SWBL_REGOUT,
 717                                        RSI_FW_WDT_DISABLE_REQ,
 718                                        RSI_COMMON_REG_SIZE);
 719         if (ret < 0) {
 720                 rsi_dbg(ERR_ZONE, "Disabling firmware watchdog timer failed\n");
 721                 goto fail;
 722         }
 723
 724         if (adapter->device_model != RSI_DEV_9116) {
 725                 ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_1,
 726                                          RSI_ULP_WRITE_2, 32);
 727                 if (ret < 0)
 728                         goto fail;
 729                 ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_2,
 730                                          RSI_ULP_WRITE_0, 32);
 731                 if (ret < 0)
 732                         goto fail;
 733                 ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_DELAY_TIMER_1,
 734                                          RSI_ULP_WRITE_50, 32);
 735                 if (ret < 0)
 736                         goto fail;
 737                 ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_DELAY_TIMER_2,
 738                                          RSI_ULP_WRITE_0, 32);
 739                 if (ret < 0)
 740                         goto fail;
 741                 ret = usb_ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_ENABLE,
 742                                          RSI_ULP_TIMER_ENABLE, 32);
 743                 if (ret < 0)
 744                         goto fail;
 745         } else {
 746                 ret = rsi_usb_master_reg_write(adapter,
 747                                                NWP_WWD_INTERRUPT_TIMER,
 748                                                NWP_WWD_INT_TIMER_CLKS,
 749                                                RSI_9116_REG_SIZE);
 750                 if (ret < 0)
 751                         goto fail;
 752                 ret = rsi_usb_master_reg_write(adapter,
 753                                                NWP_WWD_SYSTEM_RESET_TIMER,
 754                                                NWP_WWD_SYS_RESET_TIMER_CLKS,
 755                                                RSI_9116_REG_SIZE);
 756                 if (ret < 0)
 757                         goto fail;
 758                 ret = rsi_usb_master_reg_write(adapter,
 759                                                NWP_WWD_MODE_AND_RSTART,
 760                                                NWP_WWD_TIMER_DISABLE,
 761                                                RSI_9116_REG_SIZE);
 762                 if (ret < 0)
 763                         goto fail;
 764         }
 765
 766         rsi_dbg(INFO_ZONE, "Reset card done\n");
 767         return ret;
 768
 769 fail:
 770         rsi_dbg(ERR_ZONE, "Reset card failed\n");
 771         return ret;
 772 }
 773
 774 /**
 775  * rsi_probe() - This function is called by kernel when the driver provided
 776  *               Vendor and device IDs are matched. All the initialization
 777  *               work is done here.
 778  * @pfunction: Pointer to the USB interface structure.
 779  * @id: Pointer to the usb_device_id structure.
 780  *
 781  * Return: 0 on success, a negative error code on failure.
 782  */
 783 static int rsi_probe(struct usb_interface *pfunction,
 784                      const struct usb_device_id *id)
 785 {
 786         struct rsi_hw *adapter;
 787         struct rsi_91x_usbdev *dev;
 788         u16 fw_status;
 789         int status;
 790
 791         rsi_dbg(INIT_ZONE, "%s: Init function called\n", __func__);
 792
 793         adapter = rsi_91x_init(dev_oper_mode);
 794         if (!adapter) {
 795                 rsi_dbg(ERR_ZONE, "%s: Failed to init os intf ops\n",
 796                         __func__);
 797                 return -ENOMEM;
 798         }
 799         adapter->rsi_host_intf = RSI_HOST_INTF_USB;
 800
 801         status = rsi_init_usb_interface(adapter, pfunction);
 802         if (status) {
 803                 rsi_dbg(ERR_ZONE, "%s: Failed to init usb interface\n",
 804                         __func__);
 805                 goto err;
 806         }
 807
 808         rsi_dbg(ERR_ZONE, "%s: Initialized os intf ops\n", __func__);
 809
 810         if (id->idProduct == RSI_USB_PID_9113) {
 811                 rsi_dbg(INIT_ZONE, "%s: 9113 module detected\n", __func__);
 812                 adapter->device_model = RSI_DEV_9113;
 813         } else if (id->idProduct == RSI_USB_PID_9116) {
 814                 rsi_dbg(INIT_ZONE, "%s: 9116 module detected\n", __func__);
 815                 adapter->device_model = RSI_DEV_9116;
 816         } else {
 817                 rsi_dbg(ERR_ZONE, "%s: Unsupported RSI device id 0x%x\n",
 818                         __func__, id->idProduct);
 819                 status = -ENODEV;
 820                 goto err1;
 821         }
 822
 823         dev = (struct rsi_91x_usbdev *)adapter->rsi_dev;
 824
 825         status = rsi_usb_reg_read(dev->usbdev, FW_STATUS_REG, &fw_status, 2);
 826         if (status < 0)
 827                 goto err1;
 828         else
 829                 fw_status &= 1;
 830
 831         if (!fw_status) {
 832                 rsi_dbg(INIT_ZONE, "Loading firmware...\n");
 833                 status = rsi_hal_device_init(adapter);
 834                 if (status) {
 835                         rsi_dbg(ERR_ZONE, "%s: Failed in device init\n",
 836                                 __func__);
 837                         goto err1;
 838                 }
 839                 rsi_dbg(INIT_ZONE, "%s: Device Init Done\n", __func__);
 840         }
 841
 842         status = rsi_rx_urb_submit(adapter, WLAN_EP, GFP_KERNEL);
 843         if (status)
 844                 goto err1;
 845
 846         if (adapter->priv->coex_mode > 1) {
 847                 status = rsi_rx_urb_submit(adapter, BT_EP, GFP_KERNEL);
 848                 if (status)
 849                         goto err_kill_wlan_urb;
 850         }
 851
 852         return 0;
 853
 854 err_kill_wlan_urb:
 855         rsi_rx_urb_kill(adapter, WLAN_EP);
 856 err1:
 857         rsi_deinit_usb_interface(adapter);
 858 err:
 859         rsi_91x_deinit(adapter);
 860         rsi_dbg(ERR_ZONE, "%s: Failed in probe...Exiting\n", __func__);
 861         return status;
 862 }
 863
 864 /**
 865  * rsi_disconnect() - This function performs the reverse of the probe function,
 866  *                    it deinitialize the driver structure.
 867  * @pfunction: Pointer to the USB interface structure.
 868  *
 869  * Return: None.
 870  */
 871 static void rsi_disconnect(struct usb_interface *pfunction)
 872 {
 873         struct rsi_hw *adapter = usb_get_intfdata(pfunction);
 874
 875         if (!adapter)
 876                 return;
 877
 878         rsi_mac80211_detach(adapter);
 879
 880         if (IS_ENABLED(CONFIG_RSI_COEX) && adapter->priv->coex_mode > 1 &&
 881             adapter->priv->bt_adapter) {
 882                 rsi_bt_ops.detach(adapter->priv->bt_adapter);
 883                 adapter->priv->bt_adapter = NULL;
 884         }
 885
 886         if (adapter->priv->coex_mode > 1)
 887                 rsi_rx_urb_kill(adapter, BT_EP);
 888         rsi_rx_urb_kill(adapter, WLAN_EP);
 889
 890         rsi_reset_card(adapter);
 891         rsi_deinit_usb_interface(adapter);
 892         rsi_91x_deinit(adapter);
 893
 894         rsi_dbg(INFO_ZONE, "%s: Deinitialization completed\n", __func__);
 895 }
 896
 897 #ifdef CONFIG_PM
 898 static int rsi_suspend(struct usb_interface *intf, pm_message_t message)
 899 {
 900         /* Not yet implemented */
 901         return -ENOSYS;
 902 }
 903
 904 static int rsi_resume(struct usb_interface *intf)
 905 {
 906         /* Not yet implemented */
 907         return -ENOSYS;
 908 }
 909 #endif
 910
 911 static const struct usb_device_id rsi_dev_table[] = {
 912         { USB_DEVICE(RSI_USB_VENDOR_ID, RSI_USB_PID_9113) },
 913         { USB_DEVICE(RSI_USB_VENDOR_ID, RSI_USB_PID_9116) },
 914         { /* Blank */},
 915 };
 916
 917 static struct usb_driver rsi_driver = {
 918         .name       = "RSI-USB WLAN",
 919         .probe      = rsi_probe,
 920         .disconnect = rsi_disconnect,
 921         .id_table   = rsi_dev_table,
 922 #ifdef CONFIG_PM
 923         .suspend    = rsi_suspend,
 924         .resume     = rsi_resume,
 925 #endif
 926 };
 927
 928 module_usb_driver(rsi_driver);
 929
 930 MODULE_AUTHOR("Redpine Signals Inc");
 931 MODULE_DESCRIPTION("Common USB layer for RSI drivers");
 932 MODULE_DEVICE_TABLE(usb, rsi_dev_table);
 933 MODULE_FIRMWARE(FIRMWARE_RSI9113);
 934 MODULE_VERSION("0.1");
 935 MODULE_LICENSE("Dual BSD/GPL");