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