drivers/net/wireless/broadcom/brcm80211/brcmfmac/usb.c

   1 /*
   2  * Copyright (c) 2011 Broadcom Corporation
   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 ANY
  11  * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
  13  * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
  14  * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16
  17 #include <linux/kernel.h>
  18 #include <linux/module.h>
  19 #include <linux/firmware.h>
  20 #include <linux/usb.h>
  21 #include <linux/vmalloc.h>
  22
  23 #include <brcmu_utils.h>
  24 #include <brcm_hw_ids.h>
  25 #include <brcmu_wifi.h>
  26 #include "bus.h"
  27 #include "debug.h"
  28 #include "firmware.h"
  29 #include "usb.h"
  30 #include "core.h"
  31 #include "common.h"
  32 #include "bcdc.h"
  33
  34
  35 #define IOCTL_RESP_TIMEOUT              msecs_to_jiffies(2000)
  36
  37 #define BRCMF_USB_RESET_GETVER_SPINWAIT 100     /* in unit of ms */
  38 #define BRCMF_USB_RESET_GETVER_LOOP_CNT 10
  39
  40 #define BRCMF_POSTBOOT_ID               0xA123  /* ID to detect if dongle
  41                                                    has boot up */
  42 #define BRCMF_USB_NRXQ                  50
  43 #define BRCMF_USB_NTXQ                  50
  44
  45 #define BRCMF_USB_CBCTL_WRITE           0
  46 #define BRCMF_USB_CBCTL_READ            1
  47 #define BRCMF_USB_MAX_PKT_SIZE          1600
  48
  49 BRCMF_FW_DEF(43143, "/*(DEBLOBBED)*/");
  50 BRCMF_FW_DEF(43236B, "/*(DEBLOBBED)*/");
  51 BRCMF_FW_DEF(43242A, "/*(DEBLOBBED)*/");
  52 BRCMF_FW_DEF(43569, "/*(DEBLOBBED)*/");
  53 BRCMF_FW_DEF(4373, "/*(DEBLOBBED)*/");
  54
  55 static struct brcmf_firmware_mapping brcmf_usb_fwnames[] = {
  56         BRCMF_FW_ENTRY(BRCM_CC_43143_CHIP_ID, 0xFFFFFFFF, 43143),
  57         BRCMF_FW_ENTRY(BRCM_CC_43235_CHIP_ID, 0x00000008, 43236B),
  58         BRCMF_FW_ENTRY(BRCM_CC_43236_CHIP_ID, 0x00000008, 43236B),
  59         BRCMF_FW_ENTRY(BRCM_CC_43238_CHIP_ID, 0x00000008, 43236B),
  60         BRCMF_FW_ENTRY(BRCM_CC_43242_CHIP_ID, 0xFFFFFFFF, 43242A),
  61         BRCMF_FW_ENTRY(BRCM_CC_43566_CHIP_ID, 0xFFFFFFFF, 43569),
  62         BRCMF_FW_ENTRY(BRCM_CC_43569_CHIP_ID, 0xFFFFFFFF, 43569),
  63         BRCMF_FW_ENTRY(CY_CC_4373_CHIP_ID, 0xFFFFFFFF, 4373)
  64 };
  65
  66 #define TRX_MAGIC               0x30524448      /* "HDR0" */
  67 #define TRX_MAX_OFFSET          3               /* Max number of file offsets */
  68 #define TRX_UNCOMP_IMAGE        0x20            /* Trx holds uncompressed img */
  69 #define TRX_RDL_CHUNK           1500            /* size of each dl transfer */
  70 #define TRX_OFFSETS_DLFWLEN_IDX 0
  71
  72 /* Control messages: bRequest values */
  73 #define DL_GETSTATE     0       /* returns the rdl_state_t struct */
  74 #define DL_CHECK_CRC    1       /* currently unused */
  75 #define DL_GO           2       /* execute downloaded image */
  76 #define DL_START        3       /* initialize dl state */
  77 #define DL_REBOOT       4       /* reboot the device in 2 seconds */
  78 #define DL_GETVER       5       /* returns the bootrom_id_t struct */
  79 #define DL_GO_PROTECTED 6       /* execute the downloaded code and set reset
  80                                  * event to occur in 2 seconds.  It is the
  81                                  * responsibility of the downloaded code to
  82                                  * clear this event
  83                                  */
  84 #define DL_EXEC         7       /* jump to a supplied address */
  85 #define DL_RESETCFG     8       /* To support single enum on dongle
  86                                  * - Not used by bootloader
  87                                  */
  88 #define DL_DEFER_RESP_OK 9      /* Potentially defer the response to setup
  89                                  * if resp unavailable
  90                                  */
  91
  92 /* states */
  93 #define DL_WAITING      0       /* waiting to rx first pkt */
  94 #define DL_READY        1       /* hdr was good, waiting for more of the
  95                                  * compressed image
  96                                  */
  97 #define DL_BAD_HDR      2       /* hdr was corrupted */
  98 #define DL_BAD_CRC      3       /* compressed image was corrupted */
  99 #define DL_RUNNABLE     4       /* download was successful,waiting for go cmd */
 100 #define DL_START_FAIL   5       /* failed to initialize correctly */
 101 #define DL_NVRAM_TOOBIG 6       /* host specified nvram data exceeds DL_NVRAM
 102                                  * value
 103                                  */
 104 #define DL_IMAGE_TOOBIG 7       /* firmware image too big */
 105
 106
 107 struct trx_header_le {
 108         __le32 magic;           /* "HDR0" */
 109         __le32 len;             /* Length of file including header */
 110         __le32 crc32;           /* CRC from flag_version to end of file */
 111         __le32 flag_version;    /* 0:15 flags, 16:31 version */
 112         __le32 offsets[TRX_MAX_OFFSET]; /* Offsets of partitions from start of
 113                                          * header
 114                                          */
 115 };
 116
 117 struct rdl_state_le {
 118         __le32 state;
 119         __le32 bytes;
 120 };
 121
 122 struct bootrom_id_le {
 123         __le32 chip;            /* Chip id */
 124         __le32 chiprev;         /* Chip rev */
 125         __le32 ramsize;         /* Size of  RAM */
 126         __le32 remapbase;       /* Current remap base address */
 127         __le32 boardtype;       /* Type of board */
 128         __le32 boardrev;        /* Board revision */
 129 };
 130
 131 struct brcmf_usb_image {
 132         struct list_head list;
 133         s8 *fwname;
 134         u8 *image;
 135         int image_len;
 136 };
 137
 138 struct brcmf_usbdev_info {
 139         struct brcmf_usbdev bus_pub; /* MUST BE FIRST */
 140         spinlock_t qlock;
 141         struct list_head rx_freeq;
 142         struct list_head rx_postq;
 143         struct list_head tx_freeq;
 144         struct list_head tx_postq;
 145         uint rx_pipe, tx_pipe;
 146
 147         int rx_low_watermark;
 148         int tx_low_watermark;
 149         int tx_high_watermark;
 150         int tx_freecount;
 151         bool tx_flowblock;
 152         spinlock_t tx_flowblock_lock;
 153
 154         struct brcmf_usbreq *tx_reqs;
 155         struct brcmf_usbreq *rx_reqs;
 156
 157         char fw_name[BRCMF_FW_NAME_LEN];
 158         const u8 *image;        /* buffer for combine fw and nvram */
 159         int image_len;
 160
 161         struct usb_device *usbdev;
 162         struct device *dev;
 163         struct completion dev_init_done;
 164
 165         int ctl_in_pipe, ctl_out_pipe;
 166         struct urb *ctl_urb; /* URB for control endpoint */
 167         struct usb_ctrlrequest ctl_write;
 168         struct usb_ctrlrequest ctl_read;
 169         u32 ctl_urb_actual_length;
 170         int ctl_urb_status;
 171         int ctl_completed;
 172         wait_queue_head_t ioctl_resp_wait;
 173         ulong ctl_op;
 174         u8 ifnum;
 175
 176         struct urb *bulk_urb; /* used for FW download */
 177
 178         bool wowl_enabled;
 179         struct brcmf_mp_device *settings;
 180 };
 181
 182 static void brcmf_usb_rx_refill(struct brcmf_usbdev_info *devinfo,
 183                                 struct brcmf_usbreq  *req);
 184
 185 static struct brcmf_usbdev *brcmf_usb_get_buspub(struct device *dev)
 186 {
 187         struct brcmf_bus *bus_if = dev_get_drvdata(dev);
 188         return bus_if->bus_priv.usb;
 189 }
 190
 191 static struct brcmf_usbdev_info *brcmf_usb_get_businfo(struct device *dev)
 192 {
 193         return brcmf_usb_get_buspub(dev)->devinfo;
 194 }
 195
 196 static int brcmf_usb_ioctl_resp_wait(struct brcmf_usbdev_info *devinfo)
 197 {
 198         return wait_event_timeout(devinfo->ioctl_resp_wait,
 199                                   devinfo->ctl_completed, IOCTL_RESP_TIMEOUT);
 200 }
 201
 202 static void brcmf_usb_ioctl_resp_wake(struct brcmf_usbdev_info *devinfo)
 203 {
 204         wake_up(&devinfo->ioctl_resp_wait);
 205 }
 206
 207 static void
 208 brcmf_usb_ctl_complete(struct brcmf_usbdev_info *devinfo, int type, int status)
 209 {
 210         brcmf_dbg(USB, "Enter, status=%d\n", status);
 211
 212         if (unlikely(devinfo == NULL))
 213                 return;
 214
 215         if (type == BRCMF_USB_CBCTL_READ) {
 216                 if (status == 0)
 217                         devinfo->bus_pub.stats.rx_ctlpkts++;
 218                 else
 219                         devinfo->bus_pub.stats.rx_ctlerrs++;
 220         } else if (type == BRCMF_USB_CBCTL_WRITE) {
 221                 if (status == 0)
 222                         devinfo->bus_pub.stats.tx_ctlpkts++;
 223                 else
 224                         devinfo->bus_pub.stats.tx_ctlerrs++;
 225         }
 226
 227         devinfo->ctl_urb_status = status;
 228         devinfo->ctl_completed = true;
 229         brcmf_usb_ioctl_resp_wake(devinfo);
 230 }
 231
 232 static void
 233 brcmf_usb_ctlread_complete(struct urb *urb)
 234 {
 235         struct brcmf_usbdev_info *devinfo =
 236                 (struct brcmf_usbdev_info *)urb->context;
 237
 238         brcmf_dbg(USB, "Enter\n");
 239         devinfo->ctl_urb_actual_length = urb->actual_length;
 240         brcmf_usb_ctl_complete(devinfo, BRCMF_USB_CBCTL_READ,
 241                 urb->status);
 242 }
 243
 244 static void
 245 brcmf_usb_ctlwrite_complete(struct urb *urb)
 246 {
 247         struct brcmf_usbdev_info *devinfo =
 248                 (struct brcmf_usbdev_info *)urb->context;
 249
 250         brcmf_dbg(USB, "Enter\n");
 251         brcmf_usb_ctl_complete(devinfo, BRCMF_USB_CBCTL_WRITE,
 252                 urb->status);
 253 }
 254
 255 static int
 256 brcmf_usb_send_ctl(struct brcmf_usbdev_info *devinfo, u8 *buf, int len)
 257 {
 258         int ret;
 259         u16 size;
 260
 261         brcmf_dbg(USB, "Enter\n");
 262         if (devinfo == NULL || buf == NULL ||
 263             len == 0 || devinfo->ctl_urb == NULL)
 264                 return -EINVAL;
 265
 266         size = len;
 267         devinfo->ctl_write.wLength = cpu_to_le16p(&size);
 268         devinfo->ctl_urb->transfer_buffer_length = size;
 269         devinfo->ctl_urb_status = 0;
 270         devinfo->ctl_urb_actual_length = 0;
 271
 272         usb_fill_control_urb(devinfo->ctl_urb,
 273                 devinfo->usbdev,
 274                 devinfo->ctl_out_pipe,
 275                 (unsigned char *) &devinfo->ctl_write,
 276                 buf, size,
 277                 (usb_complete_t)brcmf_usb_ctlwrite_complete,
 278                 devinfo);
 279
 280         ret = usb_submit_urb(devinfo->ctl_urb, GFP_ATOMIC);
 281         if (ret < 0)
 282                 brcmf_err("usb_submit_urb failed %d\n", ret);
 283
 284         return ret;
 285 }
 286
 287 static int
 288 brcmf_usb_recv_ctl(struct brcmf_usbdev_info *devinfo, u8 *buf, int len)
 289 {
 290         int ret;
 291         u16 size;
 292
 293         brcmf_dbg(USB, "Enter\n");
 294         if ((devinfo == NULL) || (buf == NULL) || (len == 0)
 295                 || (devinfo->ctl_urb == NULL))
 296                 return -EINVAL;
 297
 298         size = len;
 299         devinfo->ctl_read.wLength = cpu_to_le16p(&size);
 300         devinfo->ctl_urb->transfer_buffer_length = size;
 301
 302         devinfo->ctl_read.bRequestType = USB_DIR_IN
 303                 | USB_TYPE_CLASS | USB_RECIP_INTERFACE;
 304         devinfo->ctl_read.bRequest = 1;
 305
 306         usb_fill_control_urb(devinfo->ctl_urb,
 307                 devinfo->usbdev,
 308                 devinfo->ctl_in_pipe,
 309                 (unsigned char *) &devinfo->ctl_read,
 310                 buf, size,
 311                 (usb_complete_t)brcmf_usb_ctlread_complete,
 312                 devinfo);
 313
 314         ret = usb_submit_urb(devinfo->ctl_urb, GFP_ATOMIC);
 315         if (ret < 0)
 316                 brcmf_err("usb_submit_urb failed %d\n", ret);
 317
 318         return ret;
 319 }
 320
 321 static int brcmf_usb_tx_ctlpkt(struct device *dev, u8 *buf, u32 len)
 322 {
 323         int err = 0;
 324         int timeout = 0;
 325         struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
 326
 327         brcmf_dbg(USB, "Enter\n");
 328         if (devinfo->bus_pub.state != BRCMFMAC_USB_STATE_UP)
 329                 return -EIO;
 330
 331         if (test_and_set_bit(0, &devinfo->ctl_op))
 332                 return -EIO;
 333
 334         devinfo->ctl_completed = false;
 335         err = brcmf_usb_send_ctl(devinfo, buf, len);
 336         if (err) {
 337                 brcmf_err("fail %d bytes: %d\n", err, len);
 338                 clear_bit(0, &devinfo->ctl_op);
 339                 return err;
 340         }
 341         timeout = brcmf_usb_ioctl_resp_wait(devinfo);
 342         clear_bit(0, &devinfo->ctl_op);
 343         if (!timeout) {
 344                 brcmf_err("Txctl wait timed out\n");
 345                 err = -EIO;
 346         }
 347         return err;
 348 }
 349
 350 static int brcmf_usb_rx_ctlpkt(struct device *dev, u8 *buf, u32 len)
 351 {
 352         int err = 0;
 353         int timeout = 0;
 354         struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
 355
 356         brcmf_dbg(USB, "Enter\n");
 357         if (devinfo->bus_pub.state != BRCMFMAC_USB_STATE_UP)
 358                 return -EIO;
 359
 360         if (test_and_set_bit(0, &devinfo->ctl_op))
 361                 return -EIO;
 362
 363         devinfo->ctl_completed = false;
 364         err = brcmf_usb_recv_ctl(devinfo, buf, len);
 365         if (err) {
 366                 brcmf_err("fail %d bytes: %d\n", err, len);
 367                 clear_bit(0, &devinfo->ctl_op);
 368                 return err;
 369         }
 370         timeout = brcmf_usb_ioctl_resp_wait(devinfo);
 371         err = devinfo->ctl_urb_status;
 372         clear_bit(0, &devinfo->ctl_op);
 373         if (!timeout) {
 374                 brcmf_err("rxctl wait timed out\n");
 375                 err = -EIO;
 376         }
 377         if (!err)
 378                 return devinfo->ctl_urb_actual_length;
 379         else
 380                 return err;
 381 }
 382
 383 static struct brcmf_usbreq *brcmf_usb_deq(struct brcmf_usbdev_info *devinfo,
 384                                           struct list_head *q, int *counter)
 385 {
 386         unsigned long flags;
 387         struct brcmf_usbreq  *req;
 388         spin_lock_irqsave(&devinfo->qlock, flags);
 389         if (list_empty(q)) {
 390                 spin_unlock_irqrestore(&devinfo->qlock, flags);
 391                 return NULL;
 392         }
 393         req = list_entry(q->next, struct brcmf_usbreq, list);
 394         list_del_init(q->next);
 395         if (counter)
 396                 (*counter)--;
 397         spin_unlock_irqrestore(&devinfo->qlock, flags);
 398         return req;
 399
 400 }
 401
 402 static void brcmf_usb_enq(struct brcmf_usbdev_info *devinfo,
 403                           struct list_head *q, struct brcmf_usbreq *req,
 404                           int *counter)
 405 {
 406         unsigned long flags;
 407         spin_lock_irqsave(&devinfo->qlock, flags);
 408         list_add_tail(&req->list, q);
 409         if (counter)
 410                 (*counter)++;
 411         spin_unlock_irqrestore(&devinfo->qlock, flags);
 412 }
 413
 414 static struct brcmf_usbreq *
 415 brcmf_usbdev_qinit(struct list_head *q, int qsize)
 416 {
 417         int i;
 418         struct brcmf_usbreq *req, *reqs;
 419
 420         reqs = kcalloc(qsize, sizeof(struct brcmf_usbreq), GFP_ATOMIC);
 421         if (reqs == NULL)
 422                 return NULL;
 423
 424         req = reqs;
 425
 426         for (i = 0; i < qsize; i++) {
 427                 req->urb = usb_alloc_urb(0, GFP_ATOMIC);
 428                 if (!req->urb)
 429                         goto fail;
 430
 431                 INIT_LIST_HEAD(&req->list);
 432                 list_add_tail(&req->list, q);
 433                 req++;
 434         }
 435         return reqs;
 436 fail:
 437         brcmf_err("fail!\n");
 438         while (!list_empty(q)) {
 439                 req = list_entry(q->next, struct brcmf_usbreq, list);
 440                 if (req)
 441                         usb_free_urb(req->urb);
 442                 list_del(q->next);
 443         }
 444         kfree(reqs);
 445         return NULL;
 446
 447 }
 448
 449 static void brcmf_usb_free_q(struct list_head *q, bool pending)
 450 {
 451         struct brcmf_usbreq *req, *next;
 452         int i = 0;
 453         list_for_each_entry_safe(req, next, q, list) {
 454                 if (!req->urb) {
 455                         brcmf_err("bad req\n");
 456                         break;
 457                 }
 458                 i++;
 459                 if (pending) {
 460                         usb_kill_urb(req->urb);
 461                 } else {
 462                         usb_free_urb(req->urb);
 463                         list_del_init(&req->list);
 464                 }
 465         }
 466 }
 467
 468 static void brcmf_usb_del_fromq(struct brcmf_usbdev_info *devinfo,
 469                                 struct brcmf_usbreq *req)
 470 {
 471         unsigned long flags;
 472
 473         spin_lock_irqsave(&devinfo->qlock, flags);
 474         list_del_init(&req->list);
 475         spin_unlock_irqrestore(&devinfo->qlock, flags);
 476 }
 477
 478
 479 static void brcmf_usb_tx_complete(struct urb *urb)
 480 {
 481         struct brcmf_usbreq *req = (struct brcmf_usbreq *)urb->context;
 482         struct brcmf_usbdev_info *devinfo = req->devinfo;
 483         unsigned long flags;
 484
 485         brcmf_dbg(USB, "Enter, urb->status=%d, skb=%p\n", urb->status,
 486                   req->skb);
 487         brcmf_usb_del_fromq(devinfo, req);
 488
 489         brcmf_proto_bcdc_txcomplete(devinfo->dev, req->skb, urb->status == 0);
 490         req->skb = NULL;
 491         brcmf_usb_enq(devinfo, &devinfo->tx_freeq, req, &devinfo->tx_freecount);
 492         spin_lock_irqsave(&devinfo->tx_flowblock_lock, flags);
 493         if (devinfo->tx_freecount > devinfo->tx_high_watermark &&
 494                 devinfo->tx_flowblock) {
 495                 brcmf_proto_bcdc_txflowblock(devinfo->dev, false);
 496                 devinfo->tx_flowblock = false;
 497         }
 498         spin_unlock_irqrestore(&devinfo->tx_flowblock_lock, flags);
 499 }
 500
 501 static void brcmf_usb_rx_complete(struct urb *urb)
 502 {
 503         struct brcmf_usbreq  *req = (struct brcmf_usbreq *)urb->context;
 504         struct brcmf_usbdev_info *devinfo = req->devinfo;
 505         struct sk_buff *skb;
 506
 507         brcmf_dbg(USB, "Enter, urb->status=%d\n", urb->status);
 508         brcmf_usb_del_fromq(devinfo, req);
 509         skb = req->skb;
 510         req->skb = NULL;
 511
 512         /* zero lenght packets indicate usb "failure". Do not refill */
 513         if (urb->status != 0 || !urb->actual_length) {
 514                 brcmu_pkt_buf_free_skb(skb);
 515                 brcmf_usb_enq(devinfo, &devinfo->rx_freeq, req, NULL);
 516                 return;
 517         }
 518
 519         if (devinfo->bus_pub.state == BRCMFMAC_USB_STATE_UP) {
 520                 skb_put(skb, urb->actual_length);
 521                 brcmf_rx_frame(devinfo->dev, skb, true);
 522                 brcmf_usb_rx_refill(devinfo, req);
 523         } else {
 524                 brcmu_pkt_buf_free_skb(skb);
 525                 brcmf_usb_enq(devinfo, &devinfo->rx_freeq, req, NULL);
 526         }
 527         return;
 528
 529 }
 530
 531 static void brcmf_usb_rx_refill(struct brcmf_usbdev_info *devinfo,
 532                                 struct brcmf_usbreq  *req)
 533 {
 534         struct sk_buff *skb;
 535         int ret;
 536
 537         if (!req || !devinfo)
 538                 return;
 539
 540         skb = dev_alloc_skb(devinfo->bus_pub.bus_mtu);
 541         if (!skb) {
 542                 brcmf_usb_enq(devinfo, &devinfo->rx_freeq, req, NULL);
 543                 return;
 544         }
 545         req->skb = skb;
 546
 547         usb_fill_bulk_urb(req->urb, devinfo->usbdev, devinfo->rx_pipe,
 548                           skb->data, skb_tailroom(skb), brcmf_usb_rx_complete,
 549                           req);
 550         req->devinfo = devinfo;
 551         brcmf_usb_enq(devinfo, &devinfo->rx_postq, req, NULL);
 552
 553         ret = usb_submit_urb(req->urb, GFP_ATOMIC);
 554         if (ret) {
 555                 brcmf_usb_del_fromq(devinfo, req);
 556                 brcmu_pkt_buf_free_skb(req->skb);
 557                 req->skb = NULL;
 558                 brcmf_usb_enq(devinfo, &devinfo->rx_freeq, req, NULL);
 559         }
 560         return;
 561 }
 562
 563 static void brcmf_usb_rx_fill_all(struct brcmf_usbdev_info *devinfo)
 564 {
 565         struct brcmf_usbreq *req;
 566
 567         if (devinfo->bus_pub.state != BRCMFMAC_USB_STATE_UP) {
 568                 brcmf_err("bus is not up=%d\n", devinfo->bus_pub.state);
 569                 return;
 570         }
 571         while ((req = brcmf_usb_deq(devinfo, &devinfo->rx_freeq, NULL)) != NULL)
 572                 brcmf_usb_rx_refill(devinfo, req);
 573 }
 574
 575 static void
 576 brcmf_usb_state_change(struct brcmf_usbdev_info *devinfo, int state)
 577 {
 578         struct brcmf_bus *bcmf_bus = devinfo->bus_pub.bus;
 579         int old_state;
 580
 581         brcmf_dbg(USB, "Enter, current state=%d, new state=%d\n",
 582                   devinfo->bus_pub.state, state);
 583
 584         if (devinfo->bus_pub.state == state)
 585                 return;
 586
 587         old_state = devinfo->bus_pub.state;
 588         devinfo->bus_pub.state = state;
 589
 590         /* update state of upper layer */
 591         if (state == BRCMFMAC_USB_STATE_DOWN) {
 592                 brcmf_dbg(USB, "DBUS is down\n");
 593                 brcmf_bus_change_state(bcmf_bus, BRCMF_BUS_DOWN);
 594         } else if (state == BRCMFMAC_USB_STATE_UP) {
 595                 brcmf_dbg(USB, "DBUS is up\n");
 596                 brcmf_bus_change_state(bcmf_bus, BRCMF_BUS_UP);
 597         } else {
 598                 brcmf_dbg(USB, "DBUS current state=%d\n", state);
 599         }
 600 }
 601
 602 static int brcmf_usb_tx(struct device *dev, struct sk_buff *skb)
 603 {
 604         struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
 605         struct brcmf_usbreq  *req;
 606         int ret;
 607         unsigned long flags;
 608
 609         brcmf_dbg(USB, "Enter, skb=%p\n", skb);
 610         if (devinfo->bus_pub.state != BRCMFMAC_USB_STATE_UP) {
 611                 ret = -EIO;
 612                 goto fail;
 613         }
 614
 615         req = brcmf_usb_deq(devinfo, &devinfo->tx_freeq,
 616                                         &devinfo->tx_freecount);
 617         if (!req) {
 618                 brcmf_err("no req to send\n");
 619                 ret = -ENOMEM;
 620                 goto fail;
 621         }
 622
 623         req->skb = skb;
 624         req->devinfo = devinfo;
 625         usb_fill_bulk_urb(req->urb, devinfo->usbdev, devinfo->tx_pipe,
 626                           skb->data, skb->len, brcmf_usb_tx_complete, req);
 627         req->urb->transfer_flags |= URB_ZERO_PACKET;
 628         brcmf_usb_enq(devinfo, &devinfo->tx_postq, req, NULL);
 629         ret = usb_submit_urb(req->urb, GFP_ATOMIC);
 630         if (ret) {
 631                 brcmf_err("brcmf_usb_tx usb_submit_urb FAILED\n");
 632                 brcmf_usb_del_fromq(devinfo, req);
 633                 req->skb = NULL;
 634                 brcmf_usb_enq(devinfo, &devinfo->tx_freeq, req,
 635                               &devinfo->tx_freecount);
 636                 goto fail;
 637         }
 638
 639         spin_lock_irqsave(&devinfo->tx_flowblock_lock, flags);
 640         if (devinfo->tx_freecount < devinfo->tx_low_watermark &&
 641             !devinfo->tx_flowblock) {
 642                 brcmf_proto_bcdc_txflowblock(dev, true);
 643                 devinfo->tx_flowblock = true;
 644         }
 645         spin_unlock_irqrestore(&devinfo->tx_flowblock_lock, flags);
 646         return 0;
 647
 648 fail:
 649         return ret;
 650 }
 651
 652
 653 static int brcmf_usb_up(struct device *dev)
 654 {
 655         struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
 656
 657         brcmf_dbg(USB, "Enter\n");
 658         if (devinfo->bus_pub.state == BRCMFMAC_USB_STATE_UP)
 659                 return 0;
 660
 661         /* Success, indicate devinfo is fully up */
 662         brcmf_usb_state_change(devinfo, BRCMFMAC_USB_STATE_UP);
 663
 664         if (devinfo->ctl_urb) {
 665                 devinfo->ctl_in_pipe = usb_rcvctrlpipe(devinfo->usbdev, 0);
 666                 devinfo->ctl_out_pipe = usb_sndctrlpipe(devinfo->usbdev, 0);
 667
 668                 /* CTL Write */
 669                 devinfo->ctl_write.bRequestType =
 670                         USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE;
 671                 devinfo->ctl_write.bRequest = 0;
 672                 devinfo->ctl_write.wValue = cpu_to_le16(0);
 673                 devinfo->ctl_write.wIndex = cpu_to_le16(devinfo->ifnum);
 674
 675                 /* CTL Read */
 676                 devinfo->ctl_read.bRequestType =
 677                         USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE;
 678                 devinfo->ctl_read.bRequest = 1;
 679                 devinfo->ctl_read.wValue = cpu_to_le16(0);
 680                 devinfo->ctl_read.wIndex = cpu_to_le16(devinfo->ifnum);
 681         }
 682         brcmf_usb_rx_fill_all(devinfo);
 683         return 0;
 684 }
 685
 686 static void brcmf_cancel_all_urbs(struct brcmf_usbdev_info *devinfo)
 687 {
 688         int i;
 689
 690         if (devinfo->ctl_urb)
 691                 usb_kill_urb(devinfo->ctl_urb);
 692         if (devinfo->bulk_urb)
 693                 usb_kill_urb(devinfo->bulk_urb);
 694         if (devinfo->tx_reqs)
 695                 for (i = 0; i < devinfo->bus_pub.ntxq; i++)
 696                         usb_kill_urb(devinfo->tx_reqs[i].urb);
 697         if (devinfo->rx_reqs)
 698                 for (i = 0; i < devinfo->bus_pub.nrxq; i++)
 699                         usb_kill_urb(devinfo->rx_reqs[i].urb);
 700 }
 701
 702 static void brcmf_usb_down(struct device *dev)
 703 {
 704         struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
 705
 706         brcmf_dbg(USB, "Enter\n");
 707         if (devinfo == NULL)
 708                 return;
 709
 710         if (devinfo->bus_pub.state == BRCMFMAC_USB_STATE_DOWN)
 711                 return;
 712
 713         brcmf_usb_state_change(devinfo, BRCMFMAC_USB_STATE_DOWN);
 714
 715         brcmf_cancel_all_urbs(devinfo);
 716 }
 717
 718 static void
 719 brcmf_usb_sync_complete(struct urb *urb)
 720 {
 721         struct brcmf_usbdev_info *devinfo =
 722                         (struct brcmf_usbdev_info *)urb->context;
 723
 724         devinfo->ctl_completed = true;
 725         brcmf_usb_ioctl_resp_wake(devinfo);
 726 }
 727
 728 static int brcmf_usb_dl_cmd(struct brcmf_usbdev_info *devinfo, u8 cmd,
 729                             void *buffer, int buflen)
 730 {
 731         int ret;
 732         char *tmpbuf;
 733         u16 size;
 734
 735         if ((!devinfo) || (devinfo->ctl_urb == NULL))
 736                 return -EINVAL;
 737
 738         tmpbuf = kmalloc(buflen, GFP_ATOMIC);
 739         if (!tmpbuf)
 740                 return -ENOMEM;
 741
 742         size = buflen;
 743         devinfo->ctl_urb->transfer_buffer_length = size;
 744
 745         devinfo->ctl_read.wLength = cpu_to_le16p(&size);
 746         devinfo->ctl_read.bRequestType = USB_DIR_IN | USB_TYPE_VENDOR |
 747                 USB_RECIP_INTERFACE;
 748         devinfo->ctl_read.bRequest = cmd;
 749
 750         usb_fill_control_urb(devinfo->ctl_urb,
 751                 devinfo->usbdev,
 752                 usb_rcvctrlpipe(devinfo->usbdev, 0),
 753                 (unsigned char *) &devinfo->ctl_read,
 754                 (void *) tmpbuf, size,
 755                 (usb_complete_t)brcmf_usb_sync_complete, devinfo);
 756
 757         devinfo->ctl_completed = false;
 758         ret = usb_submit_urb(devinfo->ctl_urb, GFP_ATOMIC);
 759         if (ret < 0) {
 760                 brcmf_err("usb_submit_urb failed %d\n", ret);
 761                 goto finalize;
 762         }
 763
 764         if (!brcmf_usb_ioctl_resp_wait(devinfo)) {
 765                 usb_kill_urb(devinfo->ctl_urb);
 766                 ret = -ETIMEDOUT;
 767         } else {
 768                 memcpy(buffer, tmpbuf, buflen);
 769         }
 770
 771 finalize:
 772         kfree(tmpbuf);
 773         return ret;
 774 }
 775
 776 static bool
 777 brcmf_usb_dlneeded(struct brcmf_usbdev_info *devinfo)
 778 {
 779         struct bootrom_id_le id;
 780         u32 chipid, chiprev;
 781
 782         brcmf_dbg(USB, "Enter\n");
 783
 784         if (devinfo == NULL)
 785                 return false;
 786
 787         /* Check if firmware downloaded already by querying runtime ID */
 788         id.chip = cpu_to_le32(0xDEAD);
 789         brcmf_usb_dl_cmd(devinfo, DL_GETVER, &id, sizeof(id));
 790
 791         chipid = le32_to_cpu(id.chip);
 792         chiprev = le32_to_cpu(id.chiprev);
 793
 794         if ((chipid & 0x4300) == 0x4300)
 795                 brcmf_dbg(USB, "chip %x rev 0x%x\n", chipid, chiprev);
 796         else
 797                 brcmf_dbg(USB, "chip %d rev 0x%x\n", chipid, chiprev);
 798         if (chipid == BRCMF_POSTBOOT_ID) {
 799                 brcmf_dbg(USB, "firmware already downloaded\n");
 800                 brcmf_usb_dl_cmd(devinfo, DL_RESETCFG, &id, sizeof(id));
 801                 return false;
 802         } else {
 803                 devinfo->bus_pub.devid = chipid;
 804                 devinfo->bus_pub.chiprev = chiprev;
 805         }
 806         return true;
 807 }
 808
 809 static int
 810 brcmf_usb_resetcfg(struct brcmf_usbdev_info *devinfo)
 811 {
 812         struct bootrom_id_le id;
 813         u32 loop_cnt;
 814         int err;
 815
 816         brcmf_dbg(USB, "Enter\n");
 817
 818         loop_cnt = 0;
 819         do {
 820                 mdelay(BRCMF_USB_RESET_GETVER_SPINWAIT);
 821                 loop_cnt++;
 822                 id.chip = cpu_to_le32(0xDEAD);       /* Get the ID */
 823                 err = brcmf_usb_dl_cmd(devinfo, DL_GETVER, &id, sizeof(id));
 824                 if ((err) && (err != -ETIMEDOUT))
 825                         return err;
 826                 if (id.chip == cpu_to_le32(BRCMF_POSTBOOT_ID))
 827                         break;
 828         } while (loop_cnt < BRCMF_USB_RESET_GETVER_LOOP_CNT);
 829
 830         if (id.chip == cpu_to_le32(BRCMF_POSTBOOT_ID)) {
 831                 brcmf_dbg(USB, "postboot chip 0x%x/rev 0x%x\n",
 832                           le32_to_cpu(id.chip), le32_to_cpu(id.chiprev));
 833
 834                 brcmf_usb_dl_cmd(devinfo, DL_RESETCFG, &id, sizeof(id));
 835                 return 0;
 836         } else {
 837                 brcmf_err("Cannot talk to Dongle. Firmware is not UP, %d ms\n",
 838                           BRCMF_USB_RESET_GETVER_SPINWAIT * loop_cnt);
 839                 return -EINVAL;
 840         }
 841 }
 842
 843
 844 static int
 845 brcmf_usb_dl_send_bulk(struct brcmf_usbdev_info *devinfo, void *buffer, int len)
 846 {
 847         int ret;
 848
 849         if ((devinfo == NULL) || (devinfo->bulk_urb == NULL))
 850                 return -EINVAL;
 851
 852         /* Prepare the URB */
 853         usb_fill_bulk_urb(devinfo->bulk_urb, devinfo->usbdev,
 854                           devinfo->tx_pipe, buffer, len,
 855                           (usb_complete_t)brcmf_usb_sync_complete, devinfo);
 856
 857         devinfo->bulk_urb->transfer_flags |= URB_ZERO_PACKET;
 858
 859         devinfo->ctl_completed = false;
 860         ret = usb_submit_urb(devinfo->bulk_urb, GFP_ATOMIC);
 861         if (ret) {
 862                 brcmf_err("usb_submit_urb failed %d\n", ret);
 863                 return ret;
 864         }
 865         ret = brcmf_usb_ioctl_resp_wait(devinfo);
 866         return (ret == 0);
 867 }
 868
 869 static int
 870 brcmf_usb_dl_writeimage(struct brcmf_usbdev_info *devinfo, u8 *fw, int fwlen)
 871 {
 872         unsigned int sendlen, sent, dllen;
 873         char *bulkchunk = NULL, *dlpos;
 874         struct rdl_state_le state;
 875         u32 rdlstate, rdlbytes;
 876         int err = 0;
 877
 878         brcmf_dbg(USB, "Enter, fw %p, len %d\n", fw, fwlen);
 879
 880         bulkchunk = kmalloc(TRX_RDL_CHUNK, GFP_ATOMIC);
 881         if (bulkchunk == NULL) {
 882                 err = -ENOMEM;
 883                 goto fail;
 884         }
 885
 886         /* 1) Prepare USB boot loader for runtime image */
 887         brcmf_usb_dl_cmd(devinfo, DL_START, &state, sizeof(state));
 888
 889         rdlstate = le32_to_cpu(state.state);
 890         rdlbytes = le32_to_cpu(state.bytes);
 891
 892         /* 2) Check we are in the Waiting state */
 893         if (rdlstate != DL_WAITING) {
 894                 brcmf_err("Failed to DL_START\n");
 895                 err = -EINVAL;
 896                 goto fail;
 897         }
 898         sent = 0;
 899         dlpos = fw;
 900         dllen = fwlen;
 901
 902         /* Get chip id and rev */
 903         while (rdlbytes != dllen) {
 904                 /* Wait until the usb device reports it received all
 905                  * the bytes we sent */
 906                 if ((rdlbytes == sent) && (rdlbytes != dllen)) {
 907                         if ((dllen-sent) < TRX_RDL_CHUNK)
 908                                 sendlen = dllen-sent;
 909                         else
 910                                 sendlen = TRX_RDL_CHUNK;
 911
 912                         /* simply avoid having to send a ZLP by ensuring we
 913                          * never have an even
 914                          * multiple of 64
 915                          */
 916                         if (!(sendlen % 64))
 917                                 sendlen -= 4;
 918
 919                         /* send data */
 920                         memcpy(bulkchunk, dlpos, sendlen);
 921                         if (brcmf_usb_dl_send_bulk(devinfo, bulkchunk,
 922                                                    sendlen)) {
 923                                 brcmf_err("send_bulk failed\n");
 924                                 err = -EINVAL;
 925                                 goto fail;
 926                         }
 927
 928                         dlpos += sendlen;
 929                         sent += sendlen;
 930                 }
 931                 err = brcmf_usb_dl_cmd(devinfo, DL_GETSTATE, &state,
 932                                        sizeof(state));
 933                 if (err) {
 934                         brcmf_err("DL_GETSTATE Failed\n");
 935                         goto fail;
 936                 }
 937
 938                 rdlstate = le32_to_cpu(state.state);
 939                 rdlbytes = le32_to_cpu(state.bytes);
 940
 941                 /* restart if an error is reported */
 942                 if (rdlstate == DL_BAD_HDR || rdlstate == DL_BAD_CRC) {
 943                         brcmf_err("Bad Hdr or Bad CRC state %d\n",
 944                                   rdlstate);
 945                         err = -EINVAL;
 946                         goto fail;
 947                 }
 948         }
 949
 950 fail:
 951         kfree(bulkchunk);
 952         brcmf_dbg(USB, "Exit, err=%d\n", err);
 953         return err;
 954 }
 955
 956 static int brcmf_usb_dlstart(struct brcmf_usbdev_info *devinfo, u8 *fw, int len)
 957 {
 958         int err;
 959
 960         brcmf_dbg(USB, "Enter\n");
 961
 962         if (devinfo == NULL)
 963                 return -EINVAL;
 964
 965         if (devinfo->bus_pub.devid == 0xDEAD)
 966                 return -EINVAL;
 967
 968         err = brcmf_usb_dl_writeimage(devinfo, fw, len);
 969         if (err == 0)
 970                 devinfo->bus_pub.state = BRCMFMAC_USB_STATE_DL_DONE;
 971         else
 972                 devinfo->bus_pub.state = BRCMFMAC_USB_STATE_DL_FAIL;
 973         brcmf_dbg(USB, "Exit, err=%d\n", err);
 974
 975         return err;
 976 }
 977
 978 static int brcmf_usb_dlrun(struct brcmf_usbdev_info *devinfo)
 979 {
 980         struct rdl_state_le state;
 981
 982         brcmf_dbg(USB, "Enter\n");
 983         if (!devinfo)
 984                 return -EINVAL;
 985
 986         if (devinfo->bus_pub.devid == 0xDEAD)
 987                 return -EINVAL;
 988
 989         /* Check we are runnable */
 990         state.state = 0;
 991         brcmf_usb_dl_cmd(devinfo, DL_GETSTATE, &state, sizeof(state));
 992
 993         /* Start the image */
 994         if (state.state == cpu_to_le32(DL_RUNNABLE)) {
 995                 if (brcmf_usb_dl_cmd(devinfo, DL_GO, &state, sizeof(state)))
 996                         return -ENODEV;
 997                 if (brcmf_usb_resetcfg(devinfo))
 998                         return -ENODEV;
 999                 /* The Dongle may go for re-enumeration. */
1000         } else {
1001                 brcmf_err("Dongle not runnable\n");
1002                 return -EINVAL;
1003         }
1004         brcmf_dbg(USB, "Exit\n");
1005         return 0;
1006 }
1007
1008 static int
1009 brcmf_usb_fw_download(struct brcmf_usbdev_info *devinfo)
1010 {
1011         int err;
1012
1013         brcmf_dbg(USB, "Enter\n");
1014         if (devinfo == NULL)
1015                 return -ENODEV;
1016
1017         if (!devinfo->image) {
1018                 brcmf_err("No firmware!\n");
1019                 return -ENOENT;
1020         }
1021
1022         err = brcmf_usb_dlstart(devinfo,
1023                 (u8 *)devinfo->image, devinfo->image_len);
1024         if (err == 0)
1025                 err = brcmf_usb_dlrun(devinfo);
1026         return err;
1027 }
1028
1029
1030 static void brcmf_usb_detach(struct brcmf_usbdev_info *devinfo)
1031 {
1032         brcmf_dbg(USB, "Enter, devinfo %p\n", devinfo);
1033
1034         /* free the URBS */
1035         brcmf_usb_free_q(&devinfo->rx_freeq, false);
1036         brcmf_usb_free_q(&devinfo->tx_freeq, false);
1037
1038         usb_free_urb(devinfo->ctl_urb);
1039         usb_free_urb(devinfo->bulk_urb);
1040
1041         kfree(devinfo->tx_reqs);
1042         kfree(devinfo->rx_reqs);
1043
1044         if (devinfo->settings)
1045                 brcmf_release_module_param(devinfo->settings);
1046 }
1047
1048
1049 static int check_file(const u8 *headers)
1050 {
1051         struct trx_header_le *trx;
1052         int actual_len = -1;
1053
1054         brcmf_dbg(USB, "Enter\n");
1055         /* Extract trx header */
1056         trx = (struct trx_header_le *) headers;
1057         if (trx->magic != cpu_to_le32(TRX_MAGIC))
1058                 return -1;
1059
1060         headers += sizeof(struct trx_header_le);
1061
1062         if (le32_to_cpu(trx->flag_version) & TRX_UNCOMP_IMAGE) {
1063                 actual_len = le32_to_cpu(trx->offsets[TRX_OFFSETS_DLFWLEN_IDX]);
1064                 return actual_len + sizeof(struct trx_header_le);
1065         }
1066         return -1;
1067 }
1068
1069
1070 static
1071 struct brcmf_usbdev *brcmf_usb_attach(struct brcmf_usbdev_info *devinfo,
1072                                       int nrxq, int ntxq)
1073 {
1074         brcmf_dbg(USB, "Enter\n");
1075
1076         devinfo->bus_pub.nrxq = nrxq;
1077         devinfo->rx_low_watermark = nrxq / 2;
1078         devinfo->bus_pub.devinfo = devinfo;
1079         devinfo->bus_pub.ntxq = ntxq;
1080         devinfo->bus_pub.state = BRCMFMAC_USB_STATE_DOWN;
1081
1082         /* flow control when too many tx urbs posted */
1083         devinfo->tx_low_watermark = ntxq / 4;
1084         devinfo->tx_high_watermark = devinfo->tx_low_watermark * 3;
1085         devinfo->bus_pub.bus_mtu = BRCMF_USB_MAX_PKT_SIZE;
1086
1087         /* Initialize other structure content */
1088         init_waitqueue_head(&devinfo->ioctl_resp_wait);
1089
1090         /* Initialize the spinlocks */
1091         spin_lock_init(&devinfo->qlock);
1092         spin_lock_init(&devinfo->tx_flowblock_lock);
1093
1094         INIT_LIST_HEAD(&devinfo->rx_freeq);
1095         INIT_LIST_HEAD(&devinfo->rx_postq);
1096
1097         INIT_LIST_HEAD(&devinfo->tx_freeq);
1098         INIT_LIST_HEAD(&devinfo->tx_postq);
1099
1100         devinfo->tx_flowblock = false;
1101
1102         devinfo->rx_reqs = brcmf_usbdev_qinit(&devinfo->rx_freeq, nrxq);
1103         if (!devinfo->rx_reqs)
1104                 goto error;
1105
1106         devinfo->tx_reqs = brcmf_usbdev_qinit(&devinfo->tx_freeq, ntxq);
1107         if (!devinfo->tx_reqs)
1108                 goto error;
1109         devinfo->tx_freecount = ntxq;
1110
1111         devinfo->ctl_urb = usb_alloc_urb(0, GFP_ATOMIC);
1112         if (!devinfo->ctl_urb)
1113                 goto error;
1114         devinfo->bulk_urb = usb_alloc_urb(0, GFP_ATOMIC);
1115         if (!devinfo->bulk_urb)
1116                 goto error;
1117
1118         return &devinfo->bus_pub;
1119
1120 error:
1121         brcmf_err("failed!\n");
1122         brcmf_usb_detach(devinfo);
1123         return NULL;
1124 }
1125
1126 static void brcmf_usb_wowl_config(struct device *dev, bool enabled)
1127 {
1128         struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(dev);
1129
1130         brcmf_dbg(USB, "Configuring WOWL, enabled=%d\n", enabled);
1131         devinfo->wowl_enabled = enabled;
1132         if (enabled)
1133                 device_set_wakeup_enable(devinfo->dev, true);
1134         else
1135                 device_set_wakeup_enable(devinfo->dev, false);
1136 }
1137
1138 static const struct brcmf_bus_ops brcmf_usb_bus_ops = {
1139         .txdata = brcmf_usb_tx,
1140         .stop = brcmf_usb_down,
1141         .txctl = brcmf_usb_tx_ctlpkt,
1142         .rxctl = brcmf_usb_rx_ctlpkt,
1143         .wowl_config = brcmf_usb_wowl_config,
1144 };
1145
1146 static int brcmf_usb_bus_setup(struct brcmf_usbdev_info *devinfo)
1147 {
1148         int ret;
1149
1150         /* Attach to the common driver interface */
1151         ret = brcmf_attach(devinfo->dev, devinfo->settings);
1152         if (ret) {
1153                 brcmf_err("brcmf_attach failed\n");
1154                 return ret;
1155         }
1156
1157         ret = brcmf_usb_up(devinfo->dev);
1158         if (ret)
1159                 goto fail;
1160
1161         ret = brcmf_bus_started(devinfo->dev);
1162         if (ret)
1163                 goto fail;
1164
1165         return 0;
1166 fail:
1167         brcmf_detach(devinfo->dev);
1168         return ret;
1169 }
1170
1171 static void brcmf_usb_probe_phase2(struct device *dev, int ret,
1172                                    const struct firmware *fw,
1173                                    void *nvram, u32 nvlen)
1174 {
1175         struct brcmf_bus *bus = dev_get_drvdata(dev);
1176         struct brcmf_usbdev_info *devinfo = bus->bus_priv.usb->devinfo;
1177
1178         if (ret)
1179                 goto error;
1180
1181         brcmf_dbg(USB, "Start fw downloading\n");
1182
1183         ret = check_file(fw->data);
1184         if (ret < 0) {
1185                 brcmf_err("invalid firmware\n");
1186                 release_firmware(fw);
1187                 goto error;
1188         }
1189
1190         devinfo->image = fw->data;
1191         devinfo->image_len = fw->size;
1192
1193         ret = brcmf_usb_fw_download(devinfo);
1194         release_firmware(fw);
1195         if (ret)
1196                 goto error;
1197
1198         ret = brcmf_usb_bus_setup(devinfo);
1199         if (ret)
1200                 goto error;
1201
1202         complete(&devinfo->dev_init_done);
1203         return;
1204 error:
1205         brcmf_dbg(TRACE, "failed: dev=%s, err=%d\n", dev_name(dev), ret);
1206         complete(&devinfo->dev_init_done);
1207         device_release_driver(dev);
1208 }
1209
1210 static int brcmf_usb_probe_cb(struct brcmf_usbdev_info *devinfo)
1211 {
1212         struct brcmf_bus *bus = NULL;
1213         struct brcmf_usbdev *bus_pub = NULL;
1214         struct device *dev = devinfo->dev;
1215         int ret;
1216
1217         brcmf_dbg(USB, "Enter\n");
1218         bus_pub = brcmf_usb_attach(devinfo, BRCMF_USB_NRXQ, BRCMF_USB_NTXQ);
1219         if (!bus_pub)
1220                 return -ENODEV;
1221
1222         bus = kzalloc(sizeof(struct brcmf_bus), GFP_ATOMIC);
1223         if (!bus) {
1224                 ret = -ENOMEM;
1225                 goto fail;
1226         }
1227
1228         bus->dev = dev;
1229         bus_pub->bus = bus;
1230         bus->bus_priv.usb = bus_pub;
1231         dev_set_drvdata(dev, bus);
1232         bus->ops = &brcmf_usb_bus_ops;
1233         bus->proto_type = BRCMF_PROTO_BCDC;
1234         bus->always_use_fws_queue = true;
1235 #ifdef CONFIG_PM
1236         bus->wowl_supported = true;
1237 #endif
1238
1239         devinfo->settings = brcmf_get_module_param(bus->dev, BRCMF_BUSTYPE_USB,
1240                                                    bus_pub->devid,
1241                                                    bus_pub->chiprev);
1242         if (!devinfo->settings) {
1243                 ret = -ENOMEM;
1244                 goto fail;
1245         }
1246
1247         if (!brcmf_usb_dlneeded(devinfo)) {
1248                 ret = brcmf_usb_bus_setup(devinfo);
1249                 if (ret)
1250                         goto fail;
1251                 /* we are done */
1252                 complete(&devinfo->dev_init_done);
1253                 return 0;
1254         }
1255         bus->chip = bus_pub->devid;
1256         bus->chiprev = bus_pub->chiprev;
1257
1258         ret = brcmf_fw_map_chip_to_name(bus_pub->devid, bus_pub->chiprev,
1259                                         brcmf_usb_fwnames,
1260                                         ARRAY_SIZE(brcmf_usb_fwnames),
1261                                         devinfo->fw_name, NULL);
1262         if (ret)
1263                 goto fail;
1264
1265         /* request firmware here */
1266         ret = brcmf_fw_get_firmwares(dev, 0, devinfo->fw_name, NULL,
1267                                      brcmf_usb_probe_phase2);
1268         if (ret) {
1269                 brcmf_err("firmware request failed: %d\n", ret);
1270                 goto fail;
1271         }
1272
1273         return 0;
1274
1275 fail:
1276         /* Release resources in reverse order */
1277         kfree(bus);
1278         brcmf_usb_detach(devinfo);
1279         return ret;
1280 }
1281
1282 static void
1283 brcmf_usb_disconnect_cb(struct brcmf_usbdev_info *devinfo)
1284 {
1285         if (!devinfo)
1286                 return;
1287         brcmf_dbg(USB, "Enter, bus_pub %p\n", devinfo);
1288
1289         brcmf_detach(devinfo->dev);
1290         kfree(devinfo->bus_pub.bus);
1291         brcmf_usb_detach(devinfo);
1292 }
1293
1294 static int
1295 brcmf_usb_probe(struct usb_interface *intf, const struct usb_device_id *id)
1296 {
1297         struct usb_device *usb = interface_to_usbdev(intf);
1298         struct brcmf_usbdev_info *devinfo;
1299         struct usb_interface_descriptor *desc;
1300         struct usb_endpoint_descriptor *endpoint;
1301         int ret = 0;
1302         u32 num_of_eps;
1303         u8 endpoint_num, ep;
1304
1305         brcmf_dbg(USB, "Enter 0x%04x:0x%04x\n", id->idVendor, id->idProduct);
1306
1307         devinfo = kzalloc(sizeof(*devinfo), GFP_ATOMIC);
1308         if (devinfo == NULL)
1309                 return -ENOMEM;
1310
1311         devinfo->usbdev = usb;
1312         devinfo->dev = &usb->dev;
1313         /* Init completion, to protect for disconnect while still loading.
1314          * Necessary because of the asynchronous firmware load construction
1315          */
1316         init_completion(&devinfo->dev_init_done);
1317
1318         usb_set_intfdata(intf, devinfo);
1319
1320         /* Check that the device supports only one configuration */
1321         if (usb->descriptor.bNumConfigurations != 1) {
1322                 brcmf_err("Number of configurations: %d not supported\n",
1323                           usb->descriptor.bNumConfigurations);
1324                 ret = -ENODEV;
1325                 goto fail;
1326         }
1327
1328         if ((usb->descriptor.bDeviceClass != USB_CLASS_VENDOR_SPEC) &&
1329             (usb->descriptor.bDeviceClass != USB_CLASS_MISC) &&
1330             (usb->descriptor.bDeviceClass != USB_CLASS_WIRELESS_CONTROLLER)) {
1331                 brcmf_err("Device class: 0x%x not supported\n",
1332                           usb->descriptor.bDeviceClass);
1333                 ret = -ENODEV;
1334                 goto fail;
1335         }
1336
1337         desc = &intf->cur_altsetting->desc;
1338         if ((desc->bInterfaceClass != USB_CLASS_VENDOR_SPEC) ||
1339             (desc->bInterfaceSubClass != 2) ||
1340             (desc->bInterfaceProtocol != 0xff)) {
1341                 brcmf_err("non WLAN interface %d: 0x%x:0x%x:0x%x\n",
1342                           desc->bInterfaceNumber, desc->bInterfaceClass,
1343                           desc->bInterfaceSubClass, desc->bInterfaceProtocol);
1344                 ret = -ENODEV;
1345                 goto fail;
1346         }
1347
1348         num_of_eps = desc->bNumEndpoints;
1349         for (ep = 0; ep < num_of_eps; ep++) {
1350                 endpoint = &intf->cur_altsetting->endpoint[ep].desc;
1351                 endpoint_num = usb_endpoint_num(endpoint);
1352                 if (!usb_endpoint_xfer_bulk(endpoint))
1353                         continue;
1354                 if (usb_endpoint_dir_in(endpoint)) {
1355                         if (!devinfo->rx_pipe)
1356                                 devinfo->rx_pipe =
1357                                         usb_rcvbulkpipe(usb, endpoint_num);
1358                 } else {
1359                         if (!devinfo->tx_pipe)
1360                                 devinfo->tx_pipe =
1361                                         usb_sndbulkpipe(usb, endpoint_num);
1362                 }
1363         }
1364         if (devinfo->rx_pipe == 0) {
1365                 brcmf_err("No RX (in) Bulk EP found\n");
1366                 ret = -ENODEV;
1367                 goto fail;
1368         }
1369         if (devinfo->tx_pipe == 0) {
1370                 brcmf_err("No TX (out) Bulk EP found\n");
1371                 ret = -ENODEV;
1372                 goto fail;
1373         }
1374
1375         devinfo->ifnum = desc->bInterfaceNumber;
1376
1377         if (usb->speed == USB_SPEED_SUPER_PLUS)
1378                 brcmf_dbg(USB, "Broadcom super speed plus USB WLAN interface detected\n");
1379         else if (usb->speed == USB_SPEED_SUPER)
1380                 brcmf_dbg(USB, "Broadcom super speed USB WLAN interface detected\n");
1381         else if (usb->speed == USB_SPEED_HIGH)
1382                 brcmf_dbg(USB, "Broadcom high speed USB WLAN interface detected\n");
1383         else
1384                 brcmf_dbg(USB, "Broadcom full speed USB WLAN interface detected\n");
1385
1386         ret = brcmf_usb_probe_cb(devinfo);
1387         if (ret)
1388                 goto fail;
1389
1390         /* Success */
1391         return 0;
1392
1393 fail:
1394         complete(&devinfo->dev_init_done);
1395         kfree(devinfo);
1396         usb_set_intfdata(intf, NULL);
1397         return ret;
1398 }
1399
1400 static void
1401 brcmf_usb_disconnect(struct usb_interface *intf)
1402 {
1403         struct brcmf_usbdev_info *devinfo;
1404
1405         brcmf_dbg(USB, "Enter\n");
1406         devinfo = (struct brcmf_usbdev_info *)usb_get_intfdata(intf);
1407
1408         if (devinfo) {
1409                 wait_for_completion(&devinfo->dev_init_done);
1410                 /* Make sure that devinfo still exists. Firmware probe routines
1411                  * may have released the device and cleared the intfdata.
1412                  */
1413                 if (!usb_get_intfdata(intf))
1414                         goto done;
1415
1416                 brcmf_usb_disconnect_cb(devinfo);
1417                 kfree(devinfo);
1418         }
1419 done:
1420         brcmf_dbg(USB, "Exit\n");
1421 }
1422
1423 /*
1424  * only need to signal the bus being down and update the state.
1425  */
1426 static int brcmf_usb_suspend(struct usb_interface *intf, pm_message_t state)
1427 {
1428         struct usb_device *usb = interface_to_usbdev(intf);
1429         struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(&usb->dev);
1430
1431         brcmf_dbg(USB, "Enter\n");
1432         devinfo->bus_pub.state = BRCMFMAC_USB_STATE_SLEEP;
1433         if (devinfo->wowl_enabled)
1434                 brcmf_cancel_all_urbs(devinfo);
1435         else
1436                 brcmf_detach(&usb->dev);
1437         return 0;
1438 }
1439
1440 /*
1441  * (re-) start the bus.
1442  */
1443 static int brcmf_usb_resume(struct usb_interface *intf)
1444 {
1445         struct usb_device *usb = interface_to_usbdev(intf);
1446         struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(&usb->dev);
1447
1448         brcmf_dbg(USB, "Enter\n");
1449         if (!devinfo->wowl_enabled)
1450                 return brcmf_usb_bus_setup(devinfo);
1451
1452         devinfo->bus_pub.state = BRCMFMAC_USB_STATE_UP;
1453         brcmf_usb_rx_fill_all(devinfo);
1454         return 0;
1455 }
1456
1457 static int brcmf_usb_reset_resume(struct usb_interface *intf)
1458 {
1459         struct usb_device *usb = interface_to_usbdev(intf);
1460         struct brcmf_usbdev_info *devinfo = brcmf_usb_get_businfo(&usb->dev);
1461
1462         brcmf_dbg(USB, "Enter\n");
1463
1464         return brcmf_fw_get_firmwares(&usb->dev, 0, devinfo->fw_name, NULL,
1465                                       brcmf_usb_probe_phase2);
1466 }
1467
1468 #define BRCMF_USB_DEVICE(dev_id)        \
1469         { USB_DEVICE(BRCM_USB_VENDOR_ID_BROADCOM, dev_id) }
1470
1471 #define LINKSYS_USB_DEVICE(dev_id)      \
1472         { USB_DEVICE(BRCM_USB_VENDOR_ID_LINKSYS, dev_id) }
1473
1474 #define CYPRESS_USB_DEVICE(dev_id)      \
1475         { USB_DEVICE(CY_USB_VENDOR_ID_CYPRESS, dev_id) }
1476
1477 static const struct usb_device_id brcmf_usb_devid_table[] = {
1478         BRCMF_USB_DEVICE(BRCM_USB_43143_DEVICE_ID),
1479         BRCMF_USB_DEVICE(BRCM_USB_43236_DEVICE_ID),
1480         BRCMF_USB_DEVICE(BRCM_USB_43242_DEVICE_ID),
1481         BRCMF_USB_DEVICE(BRCM_USB_43569_DEVICE_ID),
1482         LINKSYS_USB_DEVICE(BRCM_USB_43235_LINKSYS_DEVICE_ID),
1483         CYPRESS_USB_DEVICE(CY_USB_4373_DEVICE_ID),
1484         { USB_DEVICE(BRCM_USB_VENDOR_ID_LG, BRCM_USB_43242_LG_DEVICE_ID) },
1485         /* special entry for device with firmware loaded and running */
1486         BRCMF_USB_DEVICE(BRCM_USB_BCMFW_DEVICE_ID),
1487         CYPRESS_USB_DEVICE(BRCM_USB_BCMFW_DEVICE_ID),
1488         { /* end: all zeroes */ }
1489 };
1490
1491 MODULE_DEVICE_TABLE(usb, brcmf_usb_devid_table);
1492
1493 static struct usb_driver brcmf_usbdrvr = {
1494         .name = KBUILD_MODNAME,
1495         .probe = brcmf_usb_probe,
1496         .disconnect = brcmf_usb_disconnect,
1497         .id_table = brcmf_usb_devid_table,
1498         .suspend = brcmf_usb_suspend,
1499         .resume = brcmf_usb_resume,
1500         .reset_resume = brcmf_usb_reset_resume,
1501         .disable_hub_initiated_lpm = 1,
1502 };
1503
1504 static int brcmf_usb_reset_device(struct device *dev, void *notused)
1505 {
1506         /* device past is the usb interface so we
1507          * need to use parent here.
1508          */
1509         brcmf_dev_reset(dev->parent);
1510         return 0;
1511 }
1512
1513 void brcmf_usb_exit(void)
1514 {
1515         struct device_driver *drv = &brcmf_usbdrvr.drvwrap.driver;
1516         int ret;
1517
1518         brcmf_dbg(USB, "Enter\n");
1519         ret = driver_for_each_device(drv, NULL, NULL,
1520                                      brcmf_usb_reset_device);
1521         usb_deregister(&brcmf_usbdrvr);
1522 }
1523
1524 void brcmf_usb_register(void)
1525 {
1526         brcmf_dbg(USB, "Enter\n");
1527         usb_register(&brcmf_usbdrvr);
1528 }