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