drivers/net/wireless/rt2x00/rt2800usb.c

   1 /*
   2         Copyright (C) 2010 Willow Garage <http://www.willowgarage.com>
   3         Copyright (C) 2009 - 2010 Ivo van Doorn <IvDoorn@gmail.com>
   4         Copyright (C) 2009 Mattias Nissler <mattias.nissler@gmx.de>
   5         Copyright (C) 2009 Felix Fietkau <nbd@openwrt.org>
   6         Copyright (C) 2009 Xose Vazquez Perez <xose.vazquez@gmail.com>
   7         Copyright (C) 2009 Axel Kollhofer <rain_maker@root-forum.org>
   8         <http://rt2x00.serialmonkey.com>
   9
  10         This program is free software; you can redistribute it and/or modify
  11         it under the terms of the GNU General Public License as published by
  12         the Free Software Foundation; either version 2 of the License, or
  13         (at your option) any later version.
  14
  15         This program is distributed in the hope that it will be useful,
  16         but WITHOUT ANY WARRANTY; without even the implied warranty of
  17         MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  18         GNU General Public License for more details.
  19
  20         You should have received a copy of the GNU General Public License
  21         along with this program; if not, write to the
  22         Free Software Foundation, Inc.,
  23         59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  24  */
  25
  26 /*
  27         Module: rt2800usb
  28         Abstract: rt2800usb device specific routines.
  29         Supported chipsets: RT2800U.
  30  */
  31
  32 #include <linux/delay.h>
  33 #include <linux/etherdevice.h>
  34 #include <linux/init.h>
  35 #include <linux/kernel.h>
  36 #include <linux/module.h>
  37 #include <linux/usb.h>
  38
  39 #include "rt2x00.h"
  40 #include "rt2x00usb.h"
  41 #include "rt2800lib.h"
  42 #include "rt2800.h"
  43 #include "rt2800usb.h"
  44
  45 /*
  46  * Allow hardware encryption to be disabled.
  47  */
  48 static bool modparam_nohwcrypt;
  49 module_param_named(nohwcrypt, modparam_nohwcrypt, bool, S_IRUGO);
  50 MODULE_PARM_DESC(nohwcrypt, "Disable hardware encryption.");
  51
  52 static bool rt2800usb_hwcrypt_disabled(struct rt2x00_dev *rt2x00dev)
  53 {
  54         return modparam_nohwcrypt;
  55 }
  56
  57 /*
  58  * Queue handlers.
  59  */
  60 static void rt2800usb_start_queue(struct data_queue *queue)
  61 {
  62         struct rt2x00_dev *rt2x00dev = queue->rt2x00dev;
  63         u32 reg;
  64
  65         switch (queue->qid) {
  66         case QID_RX:
  67                 rt2x00usb_register_read(rt2x00dev, MAC_SYS_CTRL, &reg);
  68                 rt2x00_set_field32(&reg, MAC_SYS_CTRL_ENABLE_RX, 1);
  69                 rt2x00usb_register_write(rt2x00dev, MAC_SYS_CTRL, reg);
  70                 break;
  71         case QID_BEACON:
  72                 rt2x00usb_register_read(rt2x00dev, BCN_TIME_CFG, &reg);
  73                 rt2x00_set_field32(&reg, BCN_TIME_CFG_TSF_TICKING, 1);
  74                 rt2x00_set_field32(&reg, BCN_TIME_CFG_TBTT_ENABLE, 1);
  75                 rt2x00_set_field32(&reg, BCN_TIME_CFG_BEACON_GEN, 1);
  76                 rt2x00usb_register_write(rt2x00dev, BCN_TIME_CFG, reg);
  77                 break;
  78         default:
  79                 break;
  80         }
  81 }
  82
  83 static void rt2800usb_stop_queue(struct data_queue *queue)
  84 {
  85         struct rt2x00_dev *rt2x00dev = queue->rt2x00dev;
  86         u32 reg;
  87
  88         switch (queue->qid) {
  89         case QID_RX:
  90                 rt2x00usb_register_read(rt2x00dev, MAC_SYS_CTRL, &reg);
  91                 rt2x00_set_field32(&reg, MAC_SYS_CTRL_ENABLE_RX, 0);
  92                 rt2x00usb_register_write(rt2x00dev, MAC_SYS_CTRL, reg);
  93                 break;
  94         case QID_BEACON:
  95                 rt2x00usb_register_read(rt2x00dev, BCN_TIME_CFG, &reg);
  96                 rt2x00_set_field32(&reg, BCN_TIME_CFG_TSF_TICKING, 0);
  97                 rt2x00_set_field32(&reg, BCN_TIME_CFG_TBTT_ENABLE, 0);
  98                 rt2x00_set_field32(&reg, BCN_TIME_CFG_BEACON_GEN, 0);
  99                 rt2x00usb_register_write(rt2x00dev, BCN_TIME_CFG, reg);
 100                 break;
 101         default:
 102                 break;
 103         }
 104 }
 105
 106 /*
 107  * test if there is an entry in any TX queue for which DMA is done
 108  * but the TX status has not been returned yet
 109  */
 110 static bool rt2800usb_txstatus_pending(struct rt2x00_dev *rt2x00dev)
 111 {
 112         struct data_queue *queue;
 113
 114         tx_queue_for_each(rt2x00dev, queue) {
 115                 if (rt2x00queue_get_entry(queue, Q_INDEX_DMA_DONE) !=
 116                     rt2x00queue_get_entry(queue, Q_INDEX_DONE))
 117                         return true;
 118         }
 119         return false;
 120 }
 121
 122 static inline bool rt2800usb_entry_txstatus_timeout(struct queue_entry *entry)
 123 {
 124         bool tout;
 125
 126         if (!test_bit(ENTRY_DATA_STATUS_PENDING, &entry->flags))
 127                 return false;
 128
 129         tout = time_after(jiffies, entry->last_action + msecs_to_jiffies(100));
 130         if (unlikely(tout))
 131                 rt2x00_warn(entry->queue->rt2x00dev,
 132                             "TX status timeout for entry %d in queue %d\n",
 133                             entry->entry_idx, entry->queue->qid);
 134         return tout;
 135
 136 }
 137
 138 static bool rt2800usb_txstatus_timeout(struct rt2x00_dev *rt2x00dev)
 139 {
 140         struct data_queue *queue;
 141         struct queue_entry *entry;
 142
 143         tx_queue_for_each(rt2x00dev, queue) {
 144                 entry = rt2x00queue_get_entry(queue, Q_INDEX_DONE);
 145                 if (rt2800usb_entry_txstatus_timeout(entry))
 146                         return true;
 147         }
 148         return false;
 149 }
 150
 151 static bool rt2800usb_tx_sta_fifo_read_completed(struct rt2x00_dev *rt2x00dev,
 152                                                  int urb_status, u32 tx_status)
 153 {
 154         bool valid;
 155
 156         if (urb_status) {
 157                 rt2x00_warn(rt2x00dev, "TX status read failed %d\n",
 158                             urb_status);
 159
 160                 goto stop_reading;
 161         }
 162
 163         valid = rt2x00_get_field32(tx_status, TX_STA_FIFO_VALID);
 164         if (valid) {
 165                 if (!kfifo_put(&rt2x00dev->txstatus_fifo, &tx_status))
 166                         rt2x00_warn(rt2x00dev, "TX status FIFO overrun\n");
 167
 168                 queue_work(rt2x00dev->workqueue, &rt2x00dev->txdone_work);
 169
 170                 /* Reschedule urb to read TX status again instantly */
 171                 return true;
 172         }
 173
 174         /* Check if there is any entry that timedout waiting on TX status */
 175         if (rt2800usb_txstatus_timeout(rt2x00dev))
 176                 queue_work(rt2x00dev->workqueue, &rt2x00dev->txdone_work);
 177
 178         if (rt2800usb_txstatus_pending(rt2x00dev)) {
 179                 /* Read register after 250 us */
 180                 hrtimer_start(&rt2x00dev->txstatus_timer, ktime_set(0, 250000),
 181                               HRTIMER_MODE_REL);
 182                 return false;
 183         }
 184
 185 stop_reading:
 186         clear_bit(TX_STATUS_READING, &rt2x00dev->flags);
 187         /*
 188          * There is small race window above, between txstatus pending check and
 189          * clear_bit someone could do rt2x00usb_interrupt_txdone, so recheck
 190          * here again if status reading is needed.
 191          */
 192         if (rt2800usb_txstatus_pending(rt2x00dev) &&
 193             !test_and_set_bit(TX_STATUS_READING, &rt2x00dev->flags))
 194                 return true;
 195         else
 196                 return false;
 197 }
 198
 199 static void rt2800usb_async_read_tx_status(struct rt2x00_dev *rt2x00dev)
 200 {
 201
 202         if (test_and_set_bit(TX_STATUS_READING, &rt2x00dev->flags))
 203                 return;
 204
 205         /* Read TX_STA_FIFO register after 500 us */
 206         hrtimer_start(&rt2x00dev->txstatus_timer, ktime_set(0, 500000),
 207                       HRTIMER_MODE_REL);
 208 }
 209
 210 static void rt2800usb_tx_dma_done(struct queue_entry *entry)
 211 {
 212         struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
 213
 214         rt2800usb_async_read_tx_status(rt2x00dev);
 215 }
 216
 217 static enum hrtimer_restart rt2800usb_tx_sta_fifo_timeout(struct hrtimer *timer)
 218 {
 219         struct rt2x00_dev *rt2x00dev =
 220             container_of(timer, struct rt2x00_dev, txstatus_timer);
 221
 222         rt2x00usb_register_read_async(rt2x00dev, TX_STA_FIFO,
 223                                       rt2800usb_tx_sta_fifo_read_completed);
 224
 225         return HRTIMER_NORESTART;
 226 }
 227
 228 /*
 229  * Firmware functions
 230  */
 231 static char *rt2800usb_get_firmware_name(struct rt2x00_dev *rt2x00dev)
 232 {
 233         return FIRMWARE_RT2870;
 234 }
 235
 236 static int rt2800usb_write_firmware(struct rt2x00_dev *rt2x00dev,
 237                                     const u8 *data, const size_t len)
 238 {
 239         int status;
 240         u32 offset;
 241         u32 length;
 242
 243         /*
 244          * Check which section of the firmware we need.
 245          */
 246         if (rt2x00_rt(rt2x00dev, RT2860) ||
 247             rt2x00_rt(rt2x00dev, RT2872) ||
 248             rt2x00_rt(rt2x00dev, RT3070)) {
 249                 offset = 0;
 250                 length = 4096;
 251         } else {
 252                 offset = 4096;
 253                 length = 4096;
 254         }
 255
 256         /*
 257          * Write firmware to device.
 258          */
 259         rt2x00usb_register_multiwrite(rt2x00dev, FIRMWARE_IMAGE_BASE,
 260                                       data + offset, length);
 261
 262         rt2x00usb_register_write(rt2x00dev, H2M_MAILBOX_CID, ~0);
 263         rt2x00usb_register_write(rt2x00dev, H2M_MAILBOX_STATUS, ~0);
 264
 265         /*
 266          * Send firmware request to device to load firmware,
 267          * we need to specify a long timeout time.
 268          */
 269         status = rt2x00usb_vendor_request_sw(rt2x00dev, USB_DEVICE_MODE,
 270                                              0, USB_MODE_FIRMWARE,
 271                                              REGISTER_TIMEOUT_FIRMWARE);
 272         if (status < 0) {
 273                 rt2x00_err(rt2x00dev, "Failed to write Firmware to device\n");
 274                 return status;
 275         }
 276
 277         msleep(10);
 278         rt2x00usb_register_write(rt2x00dev, H2M_MAILBOX_CSR, 0);
 279
 280         return 0;
 281 }
 282
 283 /*
 284  * Device state switch handlers.
 285  */
 286 static int rt2800usb_init_registers(struct rt2x00_dev *rt2x00dev)
 287 {
 288         u32 reg;
 289
 290         /*
 291          * Wait until BBP and RF are ready.
 292          */
 293         if (rt2800_wait_csr_ready(rt2x00dev))
 294                 return -EBUSY;
 295
 296         rt2x00usb_register_read(rt2x00dev, PBF_SYS_CTRL, &reg);
 297         rt2x00usb_register_write(rt2x00dev, PBF_SYS_CTRL, reg & ~0x00002000);
 298
 299         reg = 0;
 300         rt2x00_set_field32(&reg, MAC_SYS_CTRL_RESET_CSR, 1);
 301         rt2x00_set_field32(&reg, MAC_SYS_CTRL_RESET_BBP, 1);
 302         rt2x00usb_register_write(rt2x00dev, MAC_SYS_CTRL, reg);
 303
 304         rt2x00usb_register_write(rt2x00dev, USB_DMA_CFG, 0x00000000);
 305
 306         rt2x00usb_vendor_request_sw(rt2x00dev, USB_DEVICE_MODE, 0,
 307                                     USB_MODE_RESET, REGISTER_TIMEOUT);
 308
 309         rt2x00usb_register_write(rt2x00dev, MAC_SYS_CTRL, 0x00000000);
 310
 311         return 0;
 312 }
 313
 314 static int rt2800usb_enable_radio(struct rt2x00_dev *rt2x00dev)
 315 {
 316         u32 reg;
 317
 318         if (unlikely(rt2800_wait_wpdma_ready(rt2x00dev)))
 319                 return -EIO;
 320
 321         rt2x00usb_register_read(rt2x00dev, USB_DMA_CFG, &reg);
 322         rt2x00_set_field32(&reg, USB_DMA_CFG_PHY_CLEAR, 0);
 323         rt2x00_set_field32(&reg, USB_DMA_CFG_RX_BULK_AGG_EN, 0);
 324         rt2x00_set_field32(&reg, USB_DMA_CFG_RX_BULK_AGG_TIMEOUT, 128);
 325         /*
 326          * Total room for RX frames in kilobytes, PBF might still exceed
 327          * this limit so reduce the number to prevent errors.
 328          */
 329         rt2x00_set_field32(&reg, USB_DMA_CFG_RX_BULK_AGG_LIMIT,
 330                            ((rt2x00dev->ops->rx->entry_num * DATA_FRAME_SIZE)
 331                             / 1024) - 3);
 332         rt2x00_set_field32(&reg, USB_DMA_CFG_RX_BULK_EN, 1);
 333         rt2x00_set_field32(&reg, USB_DMA_CFG_TX_BULK_EN, 1);
 334         rt2x00usb_register_write(rt2x00dev, USB_DMA_CFG, reg);
 335
 336         return rt2800_enable_radio(rt2x00dev);
 337 }
 338
 339 static void rt2800usb_disable_radio(struct rt2x00_dev *rt2x00dev)
 340 {
 341         rt2800_disable_radio(rt2x00dev);
 342         rt2x00usb_disable_radio(rt2x00dev);
 343 }
 344
 345 static int rt2800usb_set_state(struct rt2x00_dev *rt2x00dev,
 346                                enum dev_state state)
 347 {
 348         if (state == STATE_AWAKE)
 349                 rt2800_mcu_request(rt2x00dev, MCU_WAKEUP, 0xff, 0, 2);
 350         else
 351                 rt2800_mcu_request(rt2x00dev, MCU_SLEEP, 0xff, 0xff, 2);
 352
 353         return 0;
 354 }
 355
 356 static int rt2800usb_set_device_state(struct rt2x00_dev *rt2x00dev,
 357                                       enum dev_state state)
 358 {
 359         int retval = 0;
 360
 361         switch (state) {
 362         case STATE_RADIO_ON:
 363                 /*
 364                  * Before the radio can be enabled, the device first has
 365                  * to be woken up. After that it needs a bit of time
 366                  * to be fully awake and then the radio can be enabled.
 367                  */
 368                 rt2800usb_set_state(rt2x00dev, STATE_AWAKE);
 369                 msleep(1);
 370                 retval = rt2800usb_enable_radio(rt2x00dev);
 371                 break;
 372         case STATE_RADIO_OFF:
 373                 /*
 374                  * After the radio has been disabled, the device should
 375                  * be put to sleep for powersaving.
 376                  */
 377                 rt2800usb_disable_radio(rt2x00dev);
 378                 rt2800usb_set_state(rt2x00dev, STATE_SLEEP);
 379                 break;
 380         case STATE_RADIO_IRQ_ON:
 381         case STATE_RADIO_IRQ_OFF:
 382                 /* No support, but no error either */
 383                 break;
 384         case STATE_DEEP_SLEEP:
 385         case STATE_SLEEP:
 386         case STATE_STANDBY:
 387         case STATE_AWAKE:
 388                 retval = rt2800usb_set_state(rt2x00dev, state);
 389                 break;
 390         default:
 391                 retval = -ENOTSUPP;
 392                 break;
 393         }
 394
 395         if (unlikely(retval))
 396                 rt2x00_err(rt2x00dev, "Device failed to enter state %d (%d)\n",
 397                            state, retval);
 398
 399         return retval;
 400 }
 401
 402 /*
 403  * Watchdog handlers
 404  */
 405 static void rt2800usb_watchdog(struct rt2x00_dev *rt2x00dev)
 406 {
 407         unsigned int i;
 408         u32 reg;
 409
 410         rt2x00usb_register_read(rt2x00dev, TXRXQ_PCNT, &reg);
 411         if (rt2x00_get_field32(reg, TXRXQ_PCNT_TX0Q)) {
 412                 rt2x00_warn(rt2x00dev, "TX HW queue 0 timed out, invoke forced kick\n");
 413
 414                 rt2x00usb_register_write(rt2x00dev, PBF_CFG, 0xf40012);
 415
 416                 for (i = 0; i < 10; i++) {
 417                         udelay(10);
 418                         if (!rt2x00_get_field32(reg, TXRXQ_PCNT_TX0Q))
 419                                 break;
 420                 }
 421
 422                 rt2x00usb_register_write(rt2x00dev, PBF_CFG, 0xf40006);
 423         }
 424
 425         rt2x00usb_register_read(rt2x00dev, TXRXQ_PCNT, &reg);
 426         if (rt2x00_get_field32(reg, TXRXQ_PCNT_TX1Q)) {
 427                 rt2x00_warn(rt2x00dev, "TX HW queue 1 timed out, invoke forced kick\n");
 428
 429                 rt2x00usb_register_write(rt2x00dev, PBF_CFG, 0xf4000a);
 430
 431                 for (i = 0; i < 10; i++) {
 432                         udelay(10);
 433                         if (!rt2x00_get_field32(reg, TXRXQ_PCNT_TX1Q))
 434                                 break;
 435                 }
 436
 437                 rt2x00usb_register_write(rt2x00dev, PBF_CFG, 0xf40006);
 438         }
 439
 440         rt2x00usb_watchdog(rt2x00dev);
 441 }
 442
 443 /*
 444  * TX descriptor initialization
 445  */
 446 static __le32 *rt2800usb_get_txwi(struct queue_entry *entry)
 447 {
 448         if (entry->queue->qid == QID_BEACON)
 449                 return (__le32 *) (entry->skb->data);
 450         else
 451                 return (__le32 *) (entry->skb->data + TXINFO_DESC_SIZE);
 452 }
 453
 454 static void rt2800usb_write_tx_desc(struct queue_entry *entry,
 455                                     struct txentry_desc *txdesc)
 456 {
 457         struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
 458         __le32 *txi = (__le32 *) entry->skb->data;
 459         u32 word;
 460
 461         /*
 462          * Initialize TXINFO descriptor
 463          */
 464         rt2x00_desc_read(txi, 0, &word);
 465
 466         /*
 467          * The size of TXINFO_W0_USB_DMA_TX_PKT_LEN is
 468          * TXWI + 802.11 header + L2 pad + payload + pad,
 469          * so need to decrease size of TXINFO.
 470          */
 471         rt2x00_set_field32(&word, TXINFO_W0_USB_DMA_TX_PKT_LEN,
 472                            roundup(entry->skb->len, 4) - TXINFO_DESC_SIZE);
 473         rt2x00_set_field32(&word, TXINFO_W0_WIV,
 474                            !test_bit(ENTRY_TXD_ENCRYPT_IV, &txdesc->flags));
 475         rt2x00_set_field32(&word, TXINFO_W0_QSEL, 2);
 476         rt2x00_set_field32(&word, TXINFO_W0_SW_USE_LAST_ROUND, 0);
 477         rt2x00_set_field32(&word, TXINFO_W0_USB_DMA_NEXT_VALID, 0);
 478         rt2x00_set_field32(&word, TXINFO_W0_USB_DMA_TX_BURST,
 479                            test_bit(ENTRY_TXD_BURST, &txdesc->flags));
 480         rt2x00_desc_write(txi, 0, word);
 481
 482         /*
 483          * Register descriptor details in skb frame descriptor.
 484          */
 485         skbdesc->flags |= SKBDESC_DESC_IN_SKB;
 486         skbdesc->desc = txi;
 487         skbdesc->desc_len = TXINFO_DESC_SIZE + entry->queue->winfo_size;
 488 }
 489
 490 /*
 491  * TX data initialization
 492  */
 493 static int rt2800usb_get_tx_data_len(struct queue_entry *entry)
 494 {
 495         /*
 496          * pad(1~3 bytes) is needed after each 802.11 payload.
 497          * USB end pad(4 bytes) is needed at each USB bulk out packet end.
 498          * TX frame format is :
 499          * | TXINFO | TXWI | 802.11 header | L2 pad | payload | pad | USB end pad |
 500          *                 |<------------- tx_pkt_len ------------->|
 501          */
 502
 503         return roundup(entry->skb->len, 4) + 4;
 504 }
 505
 506 /*
 507  * TX control handlers
 508  */
 509 static enum txdone_entry_desc_flags
 510 rt2800usb_txdone_entry_check(struct queue_entry *entry, u32 reg)
 511 {
 512         __le32 *txwi;
 513         u32 word;
 514         int wcid, ack, pid;
 515         int tx_wcid, tx_ack, tx_pid, is_agg;
 516
 517         /*
 518          * This frames has returned with an IO error,
 519          * so the status report is not intended for this
 520          * frame.
 521          */
 522         if (test_bit(ENTRY_DATA_IO_FAILED, &entry->flags))
 523                 return TXDONE_FAILURE;
 524
 525         wcid    = rt2x00_get_field32(reg, TX_STA_FIFO_WCID);
 526         ack     = rt2x00_get_field32(reg, TX_STA_FIFO_TX_ACK_REQUIRED);
 527         pid     = rt2x00_get_field32(reg, TX_STA_FIFO_PID_TYPE);
 528         is_agg  = rt2x00_get_field32(reg, TX_STA_FIFO_TX_AGGRE);
 529
 530         /*
 531          * Validate if this TX status report is intended for
 532          * this entry by comparing the WCID/ACK/PID fields.
 533          */
 534         txwi = rt2800usb_get_txwi(entry);
 535
 536         rt2x00_desc_read(txwi, 1, &word);
 537         tx_wcid = rt2x00_get_field32(word, TXWI_W1_WIRELESS_CLI_ID);
 538         tx_ack  = rt2x00_get_field32(word, TXWI_W1_ACK);
 539         tx_pid  = rt2x00_get_field32(word, TXWI_W1_PACKETID);
 540
 541         if (wcid != tx_wcid || ack != tx_ack || (!is_agg && pid != tx_pid)) {
 542                 rt2x00_dbg(entry->queue->rt2x00dev,
 543                            "TX status report missed for queue %d entry %d\n",
 544                            entry->queue->qid, entry->entry_idx);
 545                 return TXDONE_UNKNOWN;
 546         }
 547
 548         return TXDONE_SUCCESS;
 549 }
 550
 551 static void rt2800usb_txdone(struct rt2x00_dev *rt2x00dev)
 552 {
 553         struct data_queue *queue;
 554         struct queue_entry *entry;
 555         u32 reg;
 556         u8 qid;
 557         enum txdone_entry_desc_flags done_status;
 558
 559         while (kfifo_get(&rt2x00dev->txstatus_fifo, &reg)) {
 560                 /*
 561                  * TX_STA_FIFO_PID_QUEUE is a 2-bit field, thus qid is
 562                  * guaranteed to be one of the TX QIDs .
 563                  */
 564                 qid = rt2x00_get_field32(reg, TX_STA_FIFO_PID_QUEUE);
 565                 queue = rt2x00queue_get_tx_queue(rt2x00dev, qid);
 566
 567                 if (unlikely(rt2x00queue_empty(queue))) {
 568                         rt2x00_warn(rt2x00dev, "Got TX status for an empty queue %u, dropping\n",
 569                                     qid);
 570                         break;
 571                 }
 572
 573                 entry = rt2x00queue_get_entry(queue, Q_INDEX_DONE);
 574
 575                 if (unlikely(test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags) ||
 576                              !test_bit(ENTRY_DATA_STATUS_PENDING, &entry->flags))) {
 577                         rt2x00_warn(rt2x00dev, "Data pending for entry %u in queue %u\n",
 578                                     entry->entry_idx, qid);
 579                         break;
 580                 }
 581
 582                 done_status = rt2800usb_txdone_entry_check(entry, reg);
 583                 if (likely(done_status == TXDONE_SUCCESS))
 584                         rt2800_txdone_entry(entry, reg, rt2800usb_get_txwi(entry));
 585                 else
 586                         rt2x00lib_txdone_noinfo(entry, done_status);
 587         }
 588 }
 589
 590 static void rt2800usb_txdone_nostatus(struct rt2x00_dev *rt2x00dev)
 591 {
 592         struct data_queue *queue;
 593         struct queue_entry *entry;
 594
 595         /*
 596          * Process any trailing TX status reports for IO failures,
 597          * we loop until we find the first non-IO error entry. This
 598          * can either be a frame which is free, is being uploaded,
 599          * or has completed the upload but didn't have an entry
 600          * in the TX_STAT_FIFO register yet.
 601          */
 602         tx_queue_for_each(rt2x00dev, queue) {
 603                 while (!rt2x00queue_empty(queue)) {
 604                         entry = rt2x00queue_get_entry(queue, Q_INDEX_DONE);
 605
 606                         if (test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags) ||
 607                             !test_bit(ENTRY_DATA_STATUS_PENDING, &entry->flags))
 608                                 break;
 609
 610                         if (test_bit(ENTRY_DATA_IO_FAILED, &entry->flags))
 611                                 rt2x00lib_txdone_noinfo(entry, TXDONE_FAILURE);
 612                         else if (rt2800usb_entry_txstatus_timeout(entry))
 613                                 rt2x00lib_txdone_noinfo(entry, TXDONE_UNKNOWN);
 614                         else
 615                                 break;
 616                 }
 617         }
 618 }
 619
 620 static void rt2800usb_work_txdone(struct work_struct *work)
 621 {
 622         struct rt2x00_dev *rt2x00dev =
 623             container_of(work, struct rt2x00_dev, txdone_work);
 624
 625         while (!kfifo_is_empty(&rt2x00dev->txstatus_fifo) ||
 626                rt2800usb_txstatus_timeout(rt2x00dev)) {
 627
 628                 rt2800usb_txdone(rt2x00dev);
 629
 630                 rt2800usb_txdone_nostatus(rt2x00dev);
 631
 632                 /*
 633                  * The hw may delay sending the packet after DMA complete
 634                  * if the medium is busy, thus the TX_STA_FIFO entry is
 635                  * also delayed -> use a timer to retrieve it.
 636                  */
 637                 if (rt2800usb_txstatus_pending(rt2x00dev))
 638                         rt2800usb_async_read_tx_status(rt2x00dev);
 639         }
 640 }
 641
 642 /*
 643  * RX control handlers
 644  */
 645 static void rt2800usb_fill_rxdone(struct queue_entry *entry,
 646                                   struct rxdone_entry_desc *rxdesc)
 647 {
 648         struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
 649         __le32 *rxi = (__le32 *)entry->skb->data;
 650         __le32 *rxd;
 651         u32 word;
 652         int rx_pkt_len;
 653
 654         /*
 655          * Copy descriptor to the skbdesc->desc buffer, making it safe from
 656          * moving of frame data in rt2x00usb.
 657          */
 658         memcpy(skbdesc->desc, rxi, skbdesc->desc_len);
 659
 660         /*
 661          * RX frame format is :
 662          * | RXINFO | RXWI | header | L2 pad | payload | pad | RXD | USB pad |
 663          *          |<------------ rx_pkt_len -------------->|
 664          */
 665         rt2x00_desc_read(rxi, 0, &word);
 666         rx_pkt_len = rt2x00_get_field32(word, RXINFO_W0_USB_DMA_RX_PKT_LEN);
 667
 668         /*
 669          * Remove the RXINFO structure from the sbk.
 670          */
 671         skb_pull(entry->skb, RXINFO_DESC_SIZE);
 672
 673         /*
 674          * Check for rx_pkt_len validity. Return if invalid, leaving
 675          * rxdesc->size zeroed out by the upper level.
 676          */
 677         if (unlikely(rx_pkt_len == 0 ||
 678                         rx_pkt_len > entry->queue->data_size)) {
 679                 rt2x00_err(entry->queue->rt2x00dev,
 680                            "Bad frame size %d, forcing to 0\n", rx_pkt_len);
 681                 return;
 682         }
 683
 684         rxd = (__le32 *)(entry->skb->data + rx_pkt_len);
 685
 686         /*
 687          * It is now safe to read the descriptor on all architectures.
 688          */
 689         rt2x00_desc_read(rxd, 0, &word);
 690
 691         if (rt2x00_get_field32(word, RXD_W0_CRC_ERROR))
 692                 rxdesc->flags |= RX_FLAG_FAILED_FCS_CRC;
 693
 694         rxdesc->cipher_status = rt2x00_get_field32(word, RXD_W0_CIPHER_ERROR);
 695
 696         if (rt2x00_get_field32(word, RXD_W0_DECRYPTED)) {
 697                 /*
 698                  * Hardware has stripped IV/EIV data from 802.11 frame during
 699                  * decryption. Unfortunately the descriptor doesn't contain
 700                  * any fields with the EIV/IV data either, so they can't
 701                  * be restored by rt2x00lib.
 702                  */
 703                 rxdesc->flags |= RX_FLAG_IV_STRIPPED;
 704
 705                 /*
 706                  * The hardware has already checked the Michael Mic and has
 707                  * stripped it from the frame. Signal this to mac80211.
 708                  */
 709                 rxdesc->flags |= RX_FLAG_MMIC_STRIPPED;
 710
 711                 if (rxdesc->cipher_status == RX_CRYPTO_SUCCESS)
 712                         rxdesc->flags |= RX_FLAG_DECRYPTED;
 713                 else if (rxdesc->cipher_status == RX_CRYPTO_FAIL_MIC)
 714                         rxdesc->flags |= RX_FLAG_MMIC_ERROR;
 715         }
 716
 717         if (rt2x00_get_field32(word, RXD_W0_MY_BSS))
 718                 rxdesc->dev_flags |= RXDONE_MY_BSS;
 719
 720         if (rt2x00_get_field32(word, RXD_W0_L2PAD))
 721                 rxdesc->dev_flags |= RXDONE_L2PAD;
 722
 723         /*
 724          * Remove RXD descriptor from end of buffer.
 725          */
 726         skb_trim(entry->skb, rx_pkt_len);
 727
 728         /*
 729          * Process the RXWI structure.
 730          */
 731         rt2800_process_rxwi(entry, rxdesc);
 732 }
 733
 734 /*
 735  * Device probe functions.
 736  */
 737 static int rt2800usb_read_eeprom(struct rt2x00_dev *rt2x00dev)
 738 {
 739         int retval;
 740
 741         if (rt2800_efuse_detect(rt2x00dev))
 742                 retval = rt2800_read_eeprom_efuse(rt2x00dev);
 743         else
 744                 retval = rt2x00usb_eeprom_read(rt2x00dev, rt2x00dev->eeprom,
 745                                                EEPROM_SIZE);
 746
 747         return retval;
 748 }
 749
 750 static int rt2800usb_probe_hw(struct rt2x00_dev *rt2x00dev)
 751 {
 752         int retval;
 753
 754         retval = rt2800_probe_hw(rt2x00dev);
 755         if (retval)
 756                 return retval;
 757
 758         /*
 759          * Set txstatus timer function.
 760          */
 761         rt2x00dev->txstatus_timer.function = rt2800usb_tx_sta_fifo_timeout;
 762
 763         /*
 764          * Overwrite TX done handler
 765          */
 766         PREPARE_WORK(&rt2x00dev->txdone_work, rt2800usb_work_txdone);
 767
 768         return 0;
 769 }
 770
 771 static const struct ieee80211_ops rt2800usb_mac80211_ops = {
 772         .tx                     = rt2x00mac_tx,
 773         .start                  = rt2x00mac_start,
 774         .stop                   = rt2x00mac_stop,
 775         .add_interface          = rt2x00mac_add_interface,
 776         .remove_interface       = rt2x00mac_remove_interface,
 777         .config                 = rt2x00mac_config,
 778         .configure_filter       = rt2x00mac_configure_filter,
 779         .set_tim                = rt2x00mac_set_tim,
 780         .set_key                = rt2x00mac_set_key,
 781         .sw_scan_start          = rt2x00mac_sw_scan_start,
 782         .sw_scan_complete       = rt2x00mac_sw_scan_complete,
 783         .get_stats              = rt2x00mac_get_stats,
 784         .get_tkip_seq           = rt2800_get_tkip_seq,
 785         .set_rts_threshold      = rt2800_set_rts_threshold,
 786         .sta_add                = rt2x00mac_sta_add,
 787         .sta_remove             = rt2x00mac_sta_remove,
 788         .bss_info_changed       = rt2x00mac_bss_info_changed,
 789         .conf_tx                = rt2800_conf_tx,
 790         .get_tsf                = rt2800_get_tsf,
 791         .rfkill_poll            = rt2x00mac_rfkill_poll,
 792         .ampdu_action           = rt2800_ampdu_action,
 793         .flush                  = rt2x00mac_flush,
 794         .get_survey             = rt2800_get_survey,
 795         .get_ringparam          = rt2x00mac_get_ringparam,
 796         .tx_frames_pending      = rt2x00mac_tx_frames_pending,
 797 };
 798
 799 static const struct rt2800_ops rt2800usb_rt2800_ops = {
 800         .register_read          = rt2x00usb_register_read,
 801         .register_read_lock     = rt2x00usb_register_read_lock,
 802         .register_write         = rt2x00usb_register_write,
 803         .register_write_lock    = rt2x00usb_register_write_lock,
 804         .register_multiread     = rt2x00usb_register_multiread,
 805         .register_multiwrite    = rt2x00usb_register_multiwrite,
 806         .regbusy_read           = rt2x00usb_regbusy_read,
 807         .read_eeprom            = rt2800usb_read_eeprom,
 808         .hwcrypt_disabled       = rt2800usb_hwcrypt_disabled,
 809         .drv_write_firmware     = rt2800usb_write_firmware,
 810         .drv_init_registers     = rt2800usb_init_registers,
 811         .drv_get_txwi           = rt2800usb_get_txwi,
 812 };
 813
 814 static const struct rt2x00lib_ops rt2800usb_rt2x00_ops = {
 815         .probe_hw               = rt2800usb_probe_hw,
 816         .get_firmware_name      = rt2800usb_get_firmware_name,
 817         .check_firmware         = rt2800_check_firmware,
 818         .load_firmware          = rt2800_load_firmware,
 819         .initialize             = rt2x00usb_initialize,
 820         .uninitialize           = rt2x00usb_uninitialize,
 821         .clear_entry            = rt2x00usb_clear_entry,
 822         .set_device_state       = rt2800usb_set_device_state,
 823         .rfkill_poll            = rt2800_rfkill_poll,
 824         .link_stats             = rt2800_link_stats,
 825         .reset_tuner            = rt2800_reset_tuner,
 826         .link_tuner             = rt2800_link_tuner,
 827         .gain_calibration       = rt2800_gain_calibration,
 828         .vco_calibration        = rt2800_vco_calibration,
 829         .watchdog               = rt2800usb_watchdog,
 830         .start_queue            = rt2800usb_start_queue,
 831         .kick_queue             = rt2x00usb_kick_queue,
 832         .stop_queue             = rt2800usb_stop_queue,
 833         .flush_queue            = rt2x00usb_flush_queue,
 834         .tx_dma_done            = rt2800usb_tx_dma_done,
 835         .write_tx_desc          = rt2800usb_write_tx_desc,
 836         .write_tx_data          = rt2800_write_tx_data,
 837         .write_beacon           = rt2800_write_beacon,
 838         .clear_beacon           = rt2800_clear_beacon,
 839         .get_tx_data_len        = rt2800usb_get_tx_data_len,
 840         .fill_rxdone            = rt2800usb_fill_rxdone,
 841         .config_shared_key      = rt2800_config_shared_key,
 842         .config_pairwise_key    = rt2800_config_pairwise_key,
 843         .config_filter          = rt2800_config_filter,
 844         .config_intf            = rt2800_config_intf,
 845         .config_erp             = rt2800_config_erp,
 846         .config_ant             = rt2800_config_ant,
 847         .config                 = rt2800_config,
 848         .sta_add                = rt2800_sta_add,
 849         .sta_remove             = rt2800_sta_remove,
 850 };
 851
 852 static const struct data_queue_desc rt2800usb_queue_rx = {
 853         .entry_num              = 128,
 854         .data_size              = AGGREGATION_SIZE,
 855         .desc_size              = RXINFO_DESC_SIZE,
 856         .winfo_size             = RXWI_DESC_SIZE,
 857         .priv_size              = sizeof(struct queue_entry_priv_usb),
 858 };
 859
 860 static const struct data_queue_desc rt2800usb_queue_tx = {
 861         .entry_num              = 16,
 862         .data_size              = AGGREGATION_SIZE,
 863         .desc_size              = TXINFO_DESC_SIZE,
 864         .winfo_size             = TXWI_DESC_SIZE,
 865         .priv_size              = sizeof(struct queue_entry_priv_usb),
 866 };
 867
 868 static const struct data_queue_desc rt2800usb_queue_bcn = {
 869         .entry_num              = 8,
 870         .data_size              = MGMT_FRAME_SIZE,
 871         .desc_size              = TXINFO_DESC_SIZE,
 872         .winfo_size             = TXWI_DESC_SIZE,
 873         .priv_size              = sizeof(struct queue_entry_priv_usb),
 874 };
 875
 876 static const struct rt2x00_ops rt2800usb_ops = {
 877         .name                   = KBUILD_MODNAME,
 878         .drv_data_size          = sizeof(struct rt2800_drv_data),
 879         .max_ap_intf            = 8,
 880         .eeprom_size            = EEPROM_SIZE,
 881         .rf_size                = RF_SIZE,
 882         .tx_queues              = NUM_TX_QUEUES,
 883         .extra_tx_headroom      = TXINFO_DESC_SIZE + TXWI_DESC_SIZE,
 884         .rx                     = &rt2800usb_queue_rx,
 885         .tx                     = &rt2800usb_queue_tx,
 886         .bcn                    = &rt2800usb_queue_bcn,
 887         .lib                    = &rt2800usb_rt2x00_ops,
 888         .drv                    = &rt2800usb_rt2800_ops,
 889         .hw                     = &rt2800usb_mac80211_ops,
 890 #ifdef CONFIG_RT2X00_LIB_DEBUGFS
 891         .debugfs                = &rt2800_rt2x00debug,
 892 #endif /* CONFIG_RT2X00_LIB_DEBUGFS */
 893 };
 894
 895 static const struct data_queue_desc rt2800usb_queue_rx_5592 = {
 896         .entry_num              = 128,
 897         .data_size              = AGGREGATION_SIZE,
 898         .desc_size              = RXINFO_DESC_SIZE,
 899         .winfo_size             = RXWI_DESC_SIZE_5592,
 900         .priv_size              = sizeof(struct queue_entry_priv_usb),
 901 };
 902
 903 static const struct data_queue_desc rt2800usb_queue_tx_5592 = {
 904         .entry_num              = 16,
 905         .data_size              = AGGREGATION_SIZE,
 906         .desc_size              = TXINFO_DESC_SIZE,
 907         .winfo_size             = TXWI_DESC_SIZE_5592,
 908         .priv_size              = sizeof(struct queue_entry_priv_usb),
 909 };
 910
 911 static const struct data_queue_desc rt2800usb_queue_bcn_5592 = {
 912         .entry_num              = 8,
 913         .data_size              = MGMT_FRAME_SIZE,
 914         .desc_size              = TXINFO_DESC_SIZE,
 915         .winfo_size             = TXWI_DESC_SIZE_5592,
 916         .priv_size              = sizeof(struct queue_entry_priv_usb),
 917 };
 918
 919
 920 static const struct rt2x00_ops rt2800usb_ops_5592 = {
 921         .name                   = KBUILD_MODNAME,
 922         .drv_data_size          = sizeof(struct rt2800_drv_data),
 923         .max_ap_intf            = 8,
 924         .eeprom_size            = EEPROM_SIZE,
 925         .rf_size                = RF_SIZE,
 926         .tx_queues              = NUM_TX_QUEUES,
 927         .extra_tx_headroom      = TXINFO_DESC_SIZE + TXWI_DESC_SIZE_5592,
 928         .rx                     = &rt2800usb_queue_rx_5592,
 929         .tx                     = &rt2800usb_queue_tx_5592,
 930         .bcn                    = &rt2800usb_queue_bcn_5592,
 931         .lib                    = &rt2800usb_rt2x00_ops,
 932         .drv                    = &rt2800usb_rt2800_ops,
 933         .hw                     = &rt2800usb_mac80211_ops,
 934 #ifdef CONFIG_RT2X00_LIB_DEBUGFS
 935         .debugfs                = &rt2800_rt2x00debug,
 936 #endif /* CONFIG_RT2X00_LIB_DEBUGFS */
 937 };
 938
 939 /*
 940  * rt2800usb module information.
 941  */
 942 static struct usb_device_id rt2800usb_device_table[] = {
 943         /* Abocom */
 944         { USB_DEVICE(0x07b8, 0x2870) },
 945         { USB_DEVICE(0x07b8, 0x2770) },
 946         { USB_DEVICE(0x07b8, 0x3070) },
 947         { USB_DEVICE(0x07b8, 0x3071) },
 948         { USB_DEVICE(0x07b8, 0x3072) },
 949         { USB_DEVICE(0x1482, 0x3c09) },
 950         /* AirTies */
 951         { USB_DEVICE(0x1eda, 0x2012) },
 952         { USB_DEVICE(0x1eda, 0x2210) },
 953         { USB_DEVICE(0x1eda, 0x2310) },
 954         /* Allwin */
 955         { USB_DEVICE(0x8516, 0x2070) },
 956         { USB_DEVICE(0x8516, 0x2770) },
 957         { USB_DEVICE(0x8516, 0x2870) },
 958         { USB_DEVICE(0x8516, 0x3070) },
 959         { USB_DEVICE(0x8516, 0x3071) },
 960         { USB_DEVICE(0x8516, 0x3072) },
 961         /* Alpha Networks */
 962         { USB_DEVICE(0x14b2, 0x3c06) },
 963         { USB_DEVICE(0x14b2, 0x3c07) },
 964         { USB_DEVICE(0x14b2, 0x3c09) },
 965         { USB_DEVICE(0x14b2, 0x3c12) },
 966         { USB_DEVICE(0x14b2, 0x3c23) },
 967         { USB_DEVICE(0x14b2, 0x3c25) },
 968         { USB_DEVICE(0x14b2, 0x3c27) },
 969         { USB_DEVICE(0x14b2, 0x3c28) },
 970         { USB_DEVICE(0x14b2, 0x3c2c) },
 971         /* Amit */
 972         { USB_DEVICE(0x15c5, 0x0008) },
 973         /* Askey */
 974         { USB_DEVICE(0x1690, 0x0740) },
 975         /* ASUS */
 976         { USB_DEVICE(0x0b05, 0x1731) },
 977         { USB_DEVICE(0x0b05, 0x1732) },
 978         { USB_DEVICE(0x0b05, 0x1742) },
 979         { USB_DEVICE(0x0b05, 0x1784) },
 980         { USB_DEVICE(0x1761, 0x0b05) },
 981         /* AzureWave */
 982         { USB_DEVICE(0x13d3, 0x3247) },
 983         { USB_DEVICE(0x13d3, 0x3273) },
 984         { USB_DEVICE(0x13d3, 0x3305) },
 985         { USB_DEVICE(0x13d3, 0x3307) },
 986         { USB_DEVICE(0x13d3, 0x3321) },
 987         /* Belkin */
 988         { USB_DEVICE(0x050d, 0x8053) },
 989         { USB_DEVICE(0x050d, 0x805c) },
 990         { USB_DEVICE(0x050d, 0x815c) },
 991         { USB_DEVICE(0x050d, 0x825a) },
 992         { USB_DEVICE(0x050d, 0x825b) },
 993         { USB_DEVICE(0x050d, 0x935a) },
 994         { USB_DEVICE(0x050d, 0x935b) },
 995         /* Buffalo */
 996         { USB_DEVICE(0x0411, 0x00e8) },
 997         { USB_DEVICE(0x0411, 0x0158) },
 998         { USB_DEVICE(0x0411, 0x015d) },
 999         { USB_DEVICE(0x0411, 0x016f) },
1000         { USB_DEVICE(0x0411, 0x01a2) },
1001         { USB_DEVICE(0x0411, 0x01ee) },
1002         /* Corega */
1003         { USB_DEVICE(0x07aa, 0x002f) },
1004         { USB_DEVICE(0x07aa, 0x003c) },
1005         { USB_DEVICE(0x07aa, 0x003f) },
1006         { USB_DEVICE(0x18c5, 0x0012) },
1007         /* D-Link */
1008         { USB_DEVICE(0x07d1, 0x3c09) },
1009         { USB_DEVICE(0x07d1, 0x3c0a) },
1010         { USB_DEVICE(0x07d1, 0x3c0d) },
1011         { USB_DEVICE(0x07d1, 0x3c0e) },
1012         { USB_DEVICE(0x07d1, 0x3c0f) },
1013         { USB_DEVICE(0x07d1, 0x3c11) },
1014         { USB_DEVICE(0x07d1, 0x3c13) },
1015         { USB_DEVICE(0x07d1, 0x3c15) },
1016         { USB_DEVICE(0x07d1, 0x3c16) },
1017         { USB_DEVICE(0x07d1, 0x3c17) },
1018         { USB_DEVICE(0x2001, 0x3c1b) },
1019         /* Draytek */
1020         { USB_DEVICE(0x07fa, 0x7712) },
1021         /* DVICO */
1022         { USB_DEVICE(0x0fe9, 0xb307) },
1023         /* Edimax */
1024         { USB_DEVICE(0x7392, 0x4085) },
1025         { USB_DEVICE(0x7392, 0x7711) },
1026         { USB_DEVICE(0x7392, 0x7717) },
1027         { USB_DEVICE(0x7392, 0x7718) },
1028         { USB_DEVICE(0x7392, 0x7722) },
1029         /* Encore */
1030         { USB_DEVICE(0x203d, 0x1480) },
1031         { USB_DEVICE(0x203d, 0x14a9) },
1032         /* EnGenius */
1033         { USB_DEVICE(0x1740, 0x9701) },
1034         { USB_DEVICE(0x1740, 0x9702) },
1035         { USB_DEVICE(0x1740, 0x9703) },
1036         { USB_DEVICE(0x1740, 0x9705) },
1037         { USB_DEVICE(0x1740, 0x9706) },
1038         { USB_DEVICE(0x1740, 0x9707) },
1039         { USB_DEVICE(0x1740, 0x9708) },
1040         { USB_DEVICE(0x1740, 0x9709) },
1041         /* Gemtek */
1042         { USB_DEVICE(0x15a9, 0x0012) },
1043         /* Gigabyte */
1044         { USB_DEVICE(0x1044, 0x800b) },
1045         { USB_DEVICE(0x1044, 0x800d) },
1046         /* Hawking */
1047         { USB_DEVICE(0x0e66, 0x0001) },
1048         { USB_DEVICE(0x0e66, 0x0003) },
1049         { USB_DEVICE(0x0e66, 0x0009) },
1050         { USB_DEVICE(0x0e66, 0x000b) },
1051         { USB_DEVICE(0x0e66, 0x0013) },
1052         { USB_DEVICE(0x0e66, 0x0017) },
1053         { USB_DEVICE(0x0e66, 0x0018) },
1054         /* I-O DATA */
1055         { USB_DEVICE(0x04bb, 0x0945) },
1056         { USB_DEVICE(0x04bb, 0x0947) },
1057         { USB_DEVICE(0x04bb, 0x0948) },
1058         /* Linksys */
1059         { USB_DEVICE(0x13b1, 0x0031) },
1060         { USB_DEVICE(0x1737, 0x0070) },
1061         { USB_DEVICE(0x1737, 0x0071) },
1062         { USB_DEVICE(0x1737, 0x0077) },
1063         { USB_DEVICE(0x1737, 0x0078) },
1064         /* Logitec */
1065         { USB_DEVICE(0x0789, 0x0162) },
1066         { USB_DEVICE(0x0789, 0x0163) },
1067         { USB_DEVICE(0x0789, 0x0164) },
1068         { USB_DEVICE(0x0789, 0x0166) },
1069         /* Motorola */
1070         { USB_DEVICE(0x100d, 0x9031) },
1071         /* MSI */
1072         { USB_DEVICE(0x0db0, 0x3820) },
1073         { USB_DEVICE(0x0db0, 0x3821) },
1074         { USB_DEVICE(0x0db0, 0x3822) },
1075         { USB_DEVICE(0x0db0, 0x3870) },
1076         { USB_DEVICE(0x0db0, 0x3871) },
1077         { USB_DEVICE(0x0db0, 0x6899) },
1078         { USB_DEVICE(0x0db0, 0x821a) },
1079         { USB_DEVICE(0x0db0, 0x822a) },
1080         { USB_DEVICE(0x0db0, 0x822b) },
1081         { USB_DEVICE(0x0db0, 0x822c) },
1082         { USB_DEVICE(0x0db0, 0x870a) },
1083         { USB_DEVICE(0x0db0, 0x871a) },
1084         { USB_DEVICE(0x0db0, 0x871b) },
1085         { USB_DEVICE(0x0db0, 0x871c) },
1086         { USB_DEVICE(0x0db0, 0x899a) },
1087         /* Ovislink */
1088         { USB_DEVICE(0x1b75, 0x3071) },
1089         { USB_DEVICE(0x1b75, 0x3072) },
1090         /* Para */
1091         { USB_DEVICE(0x20b8, 0x8888) },
1092         /* Pegatron */
1093         { USB_DEVICE(0x1d4d, 0x0002) },
1094         { USB_DEVICE(0x1d4d, 0x000c) },
1095         { USB_DEVICE(0x1d4d, 0x000e) },
1096         { USB_DEVICE(0x1d4d, 0x0011) },
1097         /* Philips */
1098         { USB_DEVICE(0x0471, 0x200f) },
1099         /* Planex */
1100         { USB_DEVICE(0x2019, 0x5201) },
1101         { USB_DEVICE(0x2019, 0xab25) },
1102         { USB_DEVICE(0x2019, 0xed06) },
1103         /* Quanta */
1104         { USB_DEVICE(0x1a32, 0x0304) },
1105         /* Ralink */
1106         { USB_DEVICE(0x148f, 0x2070) },
1107         { USB_DEVICE(0x148f, 0x2770) },
1108         { USB_DEVICE(0x148f, 0x2870) },
1109         { USB_DEVICE(0x148f, 0x3070) },
1110         { USB_DEVICE(0x148f, 0x3071) },
1111         { USB_DEVICE(0x148f, 0x3072) },
1112         /* Samsung */
1113         { USB_DEVICE(0x04e8, 0x2018) },
1114         /* Siemens */
1115         { USB_DEVICE(0x129b, 0x1828) },
1116         /* Sitecom */
1117         { USB_DEVICE(0x0df6, 0x0017) },
1118         { USB_DEVICE(0x0df6, 0x002b) },
1119         { USB_DEVICE(0x0df6, 0x002c) },
1120         { USB_DEVICE(0x0df6, 0x002d) },
1121         { USB_DEVICE(0x0df6, 0x0039) },
1122         { USB_DEVICE(0x0df6, 0x003b) },
1123         { USB_DEVICE(0x0df6, 0x003d) },
1124         { USB_DEVICE(0x0df6, 0x003e) },
1125         { USB_DEVICE(0x0df6, 0x003f) },
1126         { USB_DEVICE(0x0df6, 0x0040) },
1127         { USB_DEVICE(0x0df6, 0x0042) },
1128         { USB_DEVICE(0x0df6, 0x0047) },
1129         { USB_DEVICE(0x0df6, 0x0048) },
1130         { USB_DEVICE(0x0df6, 0x0051) },
1131         { USB_DEVICE(0x0df6, 0x005f) },
1132         { USB_DEVICE(0x0df6, 0x0060) },
1133         /* SMC */
1134         { USB_DEVICE(0x083a, 0x6618) },
1135         { USB_DEVICE(0x083a, 0x7511) },
1136         { USB_DEVICE(0x083a, 0x7512) },
1137         { USB_DEVICE(0x083a, 0x7522) },
1138         { USB_DEVICE(0x083a, 0x8522) },
1139         { USB_DEVICE(0x083a, 0xa618) },
1140         { USB_DEVICE(0x083a, 0xa701) },
1141         { USB_DEVICE(0x083a, 0xa702) },
1142         { USB_DEVICE(0x083a, 0xa703) },
1143         { USB_DEVICE(0x083a, 0xb522) },
1144         /* Sparklan */
1145         { USB_DEVICE(0x15a9, 0x0006) },
1146         /* Sweex */
1147         { USB_DEVICE(0x177f, 0x0153) },
1148         { USB_DEVICE(0x177f, 0x0164) },
1149         { USB_DEVICE(0x177f, 0x0302) },
1150         { USB_DEVICE(0x177f, 0x0313) },
1151         { USB_DEVICE(0x177f, 0x0323) },
1152         { USB_DEVICE(0x177f, 0x0324) },
1153         /* U-Media */
1154         { USB_DEVICE(0x157e, 0x300e) },
1155         { USB_DEVICE(0x157e, 0x3013) },
1156         /* ZCOM */
1157         { USB_DEVICE(0x0cde, 0x0022) },
1158         { USB_DEVICE(0x0cde, 0x0025) },
1159         /* Zinwell */
1160         { USB_DEVICE(0x5a57, 0x0280) },
1161         { USB_DEVICE(0x5a57, 0x0282) },
1162         { USB_DEVICE(0x5a57, 0x0283) },
1163         { USB_DEVICE(0x5a57, 0x5257) },
1164         /* Zyxel */
1165         { USB_DEVICE(0x0586, 0x3416) },
1166         { USB_DEVICE(0x0586, 0x3418) },
1167         { USB_DEVICE(0x0586, 0x341a) },
1168         { USB_DEVICE(0x0586, 0x341e) },
1169         { USB_DEVICE(0x0586, 0x343e) },
1170 #ifdef CONFIG_RT2800USB_RT33XX
1171         /* Belkin */
1172         { USB_DEVICE(0x050d, 0x945b) },
1173         /* D-Link */
1174         { USB_DEVICE(0x2001, 0x3c17) },
1175         /* Panasonic */
1176         { USB_DEVICE(0x083a, 0xb511) },
1177         /* Philips */
1178         { USB_DEVICE(0x0471, 0x20dd) },
1179         /* Ralink */
1180         { USB_DEVICE(0x148f, 0x3370) },
1181         { USB_DEVICE(0x148f, 0x8070) },
1182         /* Sitecom */
1183         { USB_DEVICE(0x0df6, 0x0050) },
1184         /* Sweex */
1185         { USB_DEVICE(0x177f, 0x0163) },
1186         { USB_DEVICE(0x177f, 0x0165) },
1187 #endif
1188 #ifdef CONFIG_RT2800USB_RT35XX
1189         /* Allwin */
1190         { USB_DEVICE(0x8516, 0x3572) },
1191         /* Askey */
1192         { USB_DEVICE(0x1690, 0x0744) },
1193         { USB_DEVICE(0x1690, 0x0761) },
1194         { USB_DEVICE(0x1690, 0x0764) },
1195         /* ASUS */
1196         { USB_DEVICE(0x0b05, 0x179d) },
1197         /* Cisco */
1198         { USB_DEVICE(0x167b, 0x4001) },
1199         /* EnGenius */
1200         { USB_DEVICE(0x1740, 0x9801) },
1201         /* I-O DATA */
1202         { USB_DEVICE(0x04bb, 0x0944) },
1203         /* Linksys */
1204         { USB_DEVICE(0x13b1, 0x002f) },
1205         { USB_DEVICE(0x1737, 0x0079) },
1206         /* Ralink */
1207         { USB_DEVICE(0x148f, 0x3572) },
1208         /* Sitecom */
1209         { USB_DEVICE(0x0df6, 0x0041) },
1210         { USB_DEVICE(0x0df6, 0x0062) },
1211         { USB_DEVICE(0x0df6, 0x0065) },
1212         { USB_DEVICE(0x0df6, 0x0066) },
1213         { USB_DEVICE(0x0df6, 0x0068) },
1214         /* Toshiba */
1215         { USB_DEVICE(0x0930, 0x0a07) },
1216         /* Zinwell */
1217         { USB_DEVICE(0x5a57, 0x0284) },
1218 #endif
1219 #ifdef CONFIG_RT2800USB_RT53XX
1220         /* Arcadyan */
1221         { USB_DEVICE(0x043e, 0x7a12) },
1222         { USB_DEVICE(0x043e, 0x7a32) },
1223         /* Azurewave */
1224         { USB_DEVICE(0x13d3, 0x3329) },
1225         { USB_DEVICE(0x13d3, 0x3365) },
1226         /* D-Link */
1227         { USB_DEVICE(0x2001, 0x3c15) },
1228         { USB_DEVICE(0x2001, 0x3c19) },
1229         { USB_DEVICE(0x2001, 0x3c1c) },
1230         { USB_DEVICE(0x2001, 0x3c1d) },
1231         { USB_DEVICE(0x2001, 0x3c1e) },
1232         /* LG innotek */
1233         { USB_DEVICE(0x043e, 0x7a22) },
1234         { USB_DEVICE(0x043e, 0x7a42) },
1235         /* Panasonic */
1236         { USB_DEVICE(0x04da, 0x1801) },
1237         { USB_DEVICE(0x04da, 0x1800) },
1238         { USB_DEVICE(0x04da, 0x23f6) },
1239         /* Philips */
1240         { USB_DEVICE(0x0471, 0x2104) },
1241         { USB_DEVICE(0x0471, 0x2126) },
1242         { USB_DEVICE(0x0471, 0x2180) },
1243         { USB_DEVICE(0x0471, 0x2181) },
1244         { USB_DEVICE(0x0471, 0x2182) },
1245         /* Ralink */
1246         { USB_DEVICE(0x148f, 0x5370) },
1247         { USB_DEVICE(0x148f, 0x5372) },
1248 #endif
1249 #ifdef CONFIG_RT2800USB_RT55XX
1250         /* Arcadyan */
1251         { USB_DEVICE(0x043e, 0x7a32), .driver_info = 5592 },
1252         /* AVM GmbH */
1253         { USB_DEVICE(0x057c, 0x8501), .driver_info = 5592 },
1254         /* D-Link DWA-160-B2 */
1255         { USB_DEVICE(0x2001, 0x3c1a), .driver_info = 5592 },
1256         /* Proware */
1257         { USB_DEVICE(0x043e, 0x7a13), .driver_info = 5592 },
1258         /* Ralink */
1259         { USB_DEVICE(0x148f, 0x5572), .driver_info = 5592 },
1260 #endif
1261 #ifdef CONFIG_RT2800USB_UNKNOWN
1262         /*
1263          * Unclear what kind of devices these are (they aren't supported by the
1264          * vendor linux driver).
1265          */
1266         /* Abocom */
1267         { USB_DEVICE(0x07b8, 0x3073) },
1268         { USB_DEVICE(0x07b8, 0x3074) },
1269         /* Alpha Networks */
1270         { USB_DEVICE(0x14b2, 0x3c08) },
1271         { USB_DEVICE(0x14b2, 0x3c11) },
1272         /* Amigo */
1273         { USB_DEVICE(0x0e0b, 0x9031) },
1274         { USB_DEVICE(0x0e0b, 0x9041) },
1275         /* ASUS */
1276         { USB_DEVICE(0x0b05, 0x166a) },
1277         { USB_DEVICE(0x0b05, 0x1760) },
1278         { USB_DEVICE(0x0b05, 0x1761) },
1279         { USB_DEVICE(0x0b05, 0x1790) },
1280         { USB_DEVICE(0x0b05, 0x17a7) },
1281         /* AzureWave */
1282         { USB_DEVICE(0x13d3, 0x3262) },
1283         { USB_DEVICE(0x13d3, 0x3284) },
1284         { USB_DEVICE(0x13d3, 0x3322) },
1285         { USB_DEVICE(0x13d3, 0x3340) },
1286         { USB_DEVICE(0x13d3, 0x3399) },
1287         { USB_DEVICE(0x13d3, 0x3400) },
1288         { USB_DEVICE(0x13d3, 0x3401) },
1289         /* Belkin */
1290         { USB_DEVICE(0x050d, 0x1003) },
1291         /* Buffalo */
1292         { USB_DEVICE(0x0411, 0x012e) },
1293         { USB_DEVICE(0x0411, 0x0148) },
1294         { USB_DEVICE(0x0411, 0x0150) },
1295         /* Corega */
1296         { USB_DEVICE(0x07aa, 0x0041) },
1297         { USB_DEVICE(0x07aa, 0x0042) },
1298         { USB_DEVICE(0x18c5, 0x0008) },
1299         /* D-Link */
1300         { USB_DEVICE(0x07d1, 0x3c0b) },
1301         /* Encore */
1302         { USB_DEVICE(0x203d, 0x14a1) },
1303         /* EnGenius */
1304         { USB_DEVICE(0x1740, 0x0600) },
1305         { USB_DEVICE(0x1740, 0x0602) },
1306         /* Gemtek */
1307         { USB_DEVICE(0x15a9, 0x0010) },
1308         /* Gigabyte */
1309         { USB_DEVICE(0x1044, 0x800c) },
1310         /* Hercules */
1311         { USB_DEVICE(0x06f8, 0xe036) },
1312         /* Huawei */
1313         { USB_DEVICE(0x148f, 0xf101) },
1314         /* I-O DATA */
1315         { USB_DEVICE(0x04bb, 0x094b) },
1316         /* LevelOne */
1317         { USB_DEVICE(0x1740, 0x0605) },
1318         { USB_DEVICE(0x1740, 0x0615) },
1319         /* Logitec */
1320         { USB_DEVICE(0x0789, 0x0168) },
1321         { USB_DEVICE(0x0789, 0x0169) },
1322         /* Motorola */
1323         { USB_DEVICE(0x100d, 0x9032) },
1324         /* Pegatron */
1325         { USB_DEVICE(0x05a6, 0x0101) },
1326         { USB_DEVICE(0x1d4d, 0x0010) },
1327         /* Planex */
1328         { USB_DEVICE(0x2019, 0xab24) },
1329         /* Qcom */
1330         { USB_DEVICE(0x18e8, 0x6259) },
1331         /* RadioShack */
1332         { USB_DEVICE(0x08b9, 0x1197) },
1333         /* Sitecom */
1334         { USB_DEVICE(0x0df6, 0x003c) },
1335         { USB_DEVICE(0x0df6, 0x004a) },
1336         { USB_DEVICE(0x0df6, 0x004d) },
1337         { USB_DEVICE(0x0df6, 0x0053) },
1338         { USB_DEVICE(0x0df6, 0x0069) },
1339         { USB_DEVICE(0x0df6, 0x006f) },
1340         /* SMC */
1341         { USB_DEVICE(0x083a, 0xa512) },
1342         { USB_DEVICE(0x083a, 0xc522) },
1343         { USB_DEVICE(0x083a, 0xd522) },
1344         { USB_DEVICE(0x083a, 0xf511) },
1345         /* Sweex */
1346         { USB_DEVICE(0x177f, 0x0254) },
1347         /* TP-LINK */
1348         { USB_DEVICE(0xf201, 0x5370) },
1349 #endif
1350         { 0, }
1351 };
1352
1353 MODULE_AUTHOR(DRV_PROJECT);
1354 MODULE_VERSION(DRV_VERSION);
1355 MODULE_DESCRIPTION("Ralink RT2800 USB Wireless LAN driver.");
1356 MODULE_SUPPORTED_DEVICE("Ralink RT2870 USB chipset based cards");
1357 MODULE_DEVICE_TABLE(usb, rt2800usb_device_table);
1358 MODULE_FIRMWARE(FIRMWARE_RT2870);
1359 MODULE_LICENSE("GPL");
1360
1361 static int rt2800usb_probe(struct usb_interface *usb_intf,
1362                            const struct usb_device_id *id)
1363 {
1364         if (id->driver_info == 5592)
1365                 return rt2x00usb_probe(usb_intf, &rt2800usb_ops_5592);
1366
1367         return rt2x00usb_probe(usb_intf, &rt2800usb_ops);
1368 }
1369
1370 static struct usb_driver rt2800usb_driver = {
1371         .name           = KBUILD_MODNAME,
1372         .id_table       = rt2800usb_device_table,
1373         .probe          = rt2800usb_probe,
1374         .disconnect     = rt2x00usb_disconnect,
1375         .suspend        = rt2x00usb_suspend,
1376         .resume         = rt2x00usb_resume,
1377         .reset_resume   = rt2x00usb_resume,
1378         .disable_hub_initiated_lpm = 1,
1379 };
1380
1381 module_usb_driver(rt2800usb_driver);