drivers/net/wireless/rt2x00/rt2x00usb.c

   1 /*
   2         Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com>
   3         <http://rt2x00.serialmonkey.com>
   4
   5         This program is free software; you can redistribute it and/or modify
   6         it under the terms of the GNU General Public License as published by
   7         the Free Software Foundation; either version 2 of the License, or
   8         (at your option) any later version.
   9
  10         This program is distributed in the hope that it will be useful,
  11         but WITHOUT ANY WARRANTY; without even the implied warranty of
  12         MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13         GNU General Public License for more details.
  14
  15         You should have received a copy of the GNU General Public License
  16         along with this program; if not, write to the
  17         Free Software Foundation, Inc.,
  18         59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  19  */
  20
  21 /*
  22         Module: rt2x00usb
  23         Abstract: rt2x00 generic usb device routines.
  24  */
  25
  26 #include <linux/kernel.h>
  27 #include <linux/module.h>
  28 #include <linux/slab.h>
  29 #include <linux/usb.h>
  30 #include <linux/bug.h>
  31
  32 #include "rt2x00.h"
  33 #include "rt2x00usb.h"
  34
  35 /*
  36  * Interfacing with the HW.
  37  */
  38 int rt2x00usb_vendor_request(struct rt2x00_dev *rt2x00dev,
  39                              const u8 request, const u8 requesttype,
  40                              const u16 offset, const u16 value,
  41                              void *buffer, const u16 buffer_length,
  42                              const int timeout)
  43 {
  44         struct usb_device *usb_dev = to_usb_device_intf(rt2x00dev->dev);
  45         int status;
  46         unsigned int i;
  47         unsigned int pipe =
  48             (requesttype == USB_VENDOR_REQUEST_IN) ?
  49             usb_rcvctrlpipe(usb_dev, 0) : usb_sndctrlpipe(usb_dev, 0);
  50
  51         if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
  52                 return -ENODEV;
  53
  54         for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
  55                 status = usb_control_msg(usb_dev, pipe, request, requesttype,
  56                                          value, offset, buffer, buffer_length,
  57                                          timeout);
  58                 if (status >= 0)
  59                         return 0;
  60
  61                 /*
  62                  * Check for errors
  63                  * -ENODEV: Device has disappeared, no point continuing.
  64                  * All other errors: Try again.
  65                  */
  66                 else if (status == -ENODEV) {
  67                         clear_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags);
  68                         break;
  69                 }
  70         }
  71
  72         ERROR(rt2x00dev,
  73               "Vendor Request 0x%02x failed for offset 0x%04x with error %d.\n",
  74               request, offset, status);
  75
  76         return status;
  77 }
  78 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request);
  79
  80 int rt2x00usb_vendor_req_buff_lock(struct rt2x00_dev *rt2x00dev,
  81                                    const u8 request, const u8 requesttype,
  82                                    const u16 offset, void *buffer,
  83                                    const u16 buffer_length, const int timeout)
  84 {
  85         int status;
  86
  87         BUG_ON(!mutex_is_locked(&rt2x00dev->csr_mutex));
  88
  89         /*
  90          * Check for Cache availability.
  91          */
  92         if (unlikely(!rt2x00dev->csr.cache || buffer_length > CSR_CACHE_SIZE)) {
  93                 ERROR(rt2x00dev, "CSR cache not available.\n");
  94                 return -ENOMEM;
  95         }
  96
  97         if (requesttype == USB_VENDOR_REQUEST_OUT)
  98                 memcpy(rt2x00dev->csr.cache, buffer, buffer_length);
  99
 100         status = rt2x00usb_vendor_request(rt2x00dev, request, requesttype,
 101                                           offset, 0, rt2x00dev->csr.cache,
 102                                           buffer_length, timeout);
 103
 104         if (!status && requesttype == USB_VENDOR_REQUEST_IN)
 105                 memcpy(buffer, rt2x00dev->csr.cache, buffer_length);
 106
 107         return status;
 108 }
 109 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_req_buff_lock);
 110
 111 int rt2x00usb_vendor_request_buff(struct rt2x00_dev *rt2x00dev,
 112                                   const u8 request, const u8 requesttype,
 113                                   const u16 offset, void *buffer,
 114                                   const u16 buffer_length, const int timeout)
 115 {
 116         int status;
 117
 118         mutex_lock(&rt2x00dev->csr_mutex);
 119
 120         status = rt2x00usb_vendor_req_buff_lock(rt2x00dev, request,
 121                                                 requesttype, offset, buffer,
 122                                                 buffer_length, timeout);
 123
 124         mutex_unlock(&rt2x00dev->csr_mutex);
 125
 126         return status;
 127 }
 128 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_buff);
 129
 130 int rt2x00usb_vendor_request_large_buff(struct rt2x00_dev *rt2x00dev,
 131                                         const u8 request, const u8 requesttype,
 132                                         const u16 offset, const void *buffer,
 133                                         const u16 buffer_length,
 134                                         const int timeout)
 135 {
 136         int status = 0;
 137         unsigned char *tb;
 138         u16 off, len, bsize;
 139
 140         mutex_lock(&rt2x00dev->csr_mutex);
 141
 142         tb  = (char *)buffer;
 143         off = offset;
 144         len = buffer_length;
 145         while (len && !status) {
 146                 bsize = min_t(u16, CSR_CACHE_SIZE, len);
 147                 status = rt2x00usb_vendor_req_buff_lock(rt2x00dev, request,
 148                                                         requesttype, off, tb,
 149                                                         bsize, timeout);
 150
 151                 tb  += bsize;
 152                 len -= bsize;
 153                 off += bsize;
 154         }
 155
 156         mutex_unlock(&rt2x00dev->csr_mutex);
 157
 158         return status;
 159 }
 160 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_large_buff);
 161
 162 int rt2x00usb_regbusy_read(struct rt2x00_dev *rt2x00dev,
 163                            const unsigned int offset,
 164                            const struct rt2x00_field32 field,
 165                            u32 *reg)
 166 {
 167         unsigned int i;
 168
 169         if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
 170                 return -ENODEV;
 171
 172         for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
 173                 rt2x00usb_register_read_lock(rt2x00dev, offset, reg);
 174                 if (!rt2x00_get_field32(*reg, field))
 175                         return 1;
 176                 udelay(REGISTER_BUSY_DELAY);
 177         }
 178
 179         ERROR(rt2x00dev, "Indirect register access failed: "
 180               "offset=0x%.08x, value=0x%.08x\n", offset, *reg);
 181         *reg = ~0;
 182
 183         return 0;
 184 }
 185 EXPORT_SYMBOL_GPL(rt2x00usb_regbusy_read);
 186
 187 /*
 188  * TX data handlers.
 189  */
 190 static void rt2x00usb_interrupt_txdone(struct urb *urb)
 191 {
 192         struct queue_entry *entry = (struct queue_entry *)urb->context;
 193         struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
 194         struct txdone_entry_desc txdesc;
 195
 196         if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags) ||
 197             !test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
 198                 return;
 199
 200         /*
 201          * Obtain the status about this packet.
 202          * Note that when the status is 0 it does not mean the
 203          * frame was send out correctly. It only means the frame
 204          * was succesfully pushed to the hardware, we have no
 205          * way to determine the transmission status right now.
 206          * (Only indirectly by looking at the failed TX counters
 207          * in the register).
 208          */
 209         txdesc.flags = 0;
 210         if (!urb->status)
 211                 __set_bit(TXDONE_UNKNOWN, &txdesc.flags);
 212         else
 213                 __set_bit(TXDONE_FAILURE, &txdesc.flags);
 214         txdesc.retry = 0;
 215
 216         rt2x00lib_txdone(entry, &txdesc);
 217 }
 218
 219 int rt2x00usb_write_tx_data(struct queue_entry *entry,
 220                             struct txentry_desc *txdesc)
 221 {
 222         struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
 223         struct usb_device *usb_dev = to_usb_device_intf(rt2x00dev->dev);
 224         struct queue_entry_priv_usb *entry_priv = entry->priv_data;
 225         struct skb_frame_desc *skbdesc;
 226         u32 length;
 227
 228         /*
 229          * Add the descriptor in front of the skb.
 230          */
 231         skb_push(entry->skb, entry->queue->desc_size);
 232         memset(entry->skb->data, 0, entry->queue->desc_size);
 233
 234         /*
 235          * Fill in skb descriptor
 236          */
 237         skbdesc = get_skb_frame_desc(entry->skb);
 238         skbdesc->desc = entry->skb->data;
 239         skbdesc->desc_len = entry->queue->desc_size;
 240
 241         /*
 242          * USB devices cannot blindly pass the skb->len as the
 243          * length of the data to usb_fill_bulk_urb. Pass the skb
 244          * to the driver to determine what the length should be.
 245          */
 246         length = rt2x00dev->ops->lib->get_tx_data_len(entry);
 247
 248         usb_fill_bulk_urb(entry_priv->urb, usb_dev,
 249                           usb_sndbulkpipe(usb_dev, entry->queue->usb_endpoint),
 250                           entry->skb->data, length,
 251                           rt2x00usb_interrupt_txdone, entry);
 252
 253         /*
 254          * Make sure the skb->data pointer points to the frame, not the
 255          * descriptor.
 256          */
 257         skb_pull(entry->skb, entry->queue->desc_size);
 258
 259         return 0;
 260 }
 261 EXPORT_SYMBOL_GPL(rt2x00usb_write_tx_data);
 262
 263 static inline void rt2x00usb_kick_tx_entry(struct queue_entry *entry)
 264 {
 265         struct queue_entry_priv_usb *entry_priv = entry->priv_data;
 266
 267         if (test_and_clear_bit(ENTRY_DATA_PENDING, &entry->flags))
 268                 usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
 269 }
 270
 271 void rt2x00usb_kick_tx_queue(struct rt2x00_dev *rt2x00dev,
 272                              const enum data_queue_qid qid)
 273 {
 274         struct data_queue *queue = rt2x00queue_get_queue(rt2x00dev, qid);
 275         unsigned long irqflags;
 276         unsigned int index;
 277         unsigned int index_done;
 278         unsigned int i;
 279
 280         /*
 281          * Only protect the range we are going to loop over,
 282          * if during our loop a extra entry is set to pending
 283          * it should not be kicked during this run, since it
 284          * is part of another TX operation.
 285          */
 286         spin_lock_irqsave(&queue->lock, irqflags);
 287         index = queue->index[Q_INDEX];
 288         index_done = queue->index[Q_INDEX_DONE];
 289         spin_unlock_irqrestore(&queue->lock, irqflags);
 290
 291         /*
 292          * Start from the TX done pointer, this guarentees that we will
 293          * send out all frames in the correct order.
 294          */
 295         if (index_done < index) {
 296                 for (i = index_done; i < index; i++)
 297                         rt2x00usb_kick_tx_entry(&queue->entries[i]);
 298         } else {
 299                 for (i = index_done; i < queue->limit; i++)
 300                         rt2x00usb_kick_tx_entry(&queue->entries[i]);
 301
 302                 for (i = 0; i < index; i++)
 303                         rt2x00usb_kick_tx_entry(&queue->entries[i]);
 304         }
 305 }
 306 EXPORT_SYMBOL_GPL(rt2x00usb_kick_tx_queue);
 307
 308 void rt2x00usb_kill_tx_queue(struct rt2x00_dev *rt2x00dev,
 309                              const enum data_queue_qid qid)
 310 {
 311         struct data_queue *queue = rt2x00queue_get_queue(rt2x00dev, qid);
 312         struct queue_entry_priv_usb *entry_priv;
 313         struct queue_entry_priv_usb_bcn *bcn_priv;
 314         unsigned int i;
 315         bool kill_guard;
 316
 317         /*
 318          * When killing the beacon queue, we must also kill
 319          * the beacon guard byte.
 320          */
 321         kill_guard =
 322             (qid == QID_BEACON) &&
 323             (test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags));
 324
 325         /*
 326          * Cancel all entries.
 327          */
 328         for (i = 0; i < queue->limit; i++) {
 329                 entry_priv = queue->entries[i].priv_data;
 330                 usb_kill_urb(entry_priv->urb);
 331
 332                 /*
 333                  * Kill guardian urb (if required by driver).
 334                  */
 335                 if (kill_guard) {
 336                         bcn_priv = queue->entries[i].priv_data;
 337                         usb_kill_urb(bcn_priv->guardian_urb);
 338                 }
 339         }
 340 }
 341 EXPORT_SYMBOL_GPL(rt2x00usb_kill_tx_queue);
 342
 343 /*
 344  * RX data handlers.
 345  */
 346 static void rt2x00usb_interrupt_rxdone(struct urb *urb)
 347 {
 348         struct queue_entry *entry = (struct queue_entry *)urb->context;
 349         struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
 350         struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
 351         u8 rxd[32];
 352
 353         if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags) ||
 354             !test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
 355                 return;
 356
 357         /*
 358          * Check if the received data is simply too small
 359          * to be actually valid, or if the urb is signaling
 360          * a problem.
 361          */
 362         if (urb->actual_length < entry->queue->desc_size || urb->status) {
 363                 set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
 364                 usb_submit_urb(urb, GFP_ATOMIC);
 365                 return;
 366         }
 367
 368         /*
 369          * Fill in desc fields of the skb descriptor
 370          */
 371         skbdesc->desc = rxd;
 372         skbdesc->desc_len = entry->queue->desc_size;
 373
 374         /*
 375          * Send the frame to rt2x00lib for further processing.
 376          */
 377         rt2x00lib_rxdone(rt2x00dev, entry);
 378 }
 379
 380 /*
 381  * Radio handlers
 382  */
 383 void rt2x00usb_disable_radio(struct rt2x00_dev *rt2x00dev)
 384 {
 385         rt2x00usb_vendor_request_sw(rt2x00dev, USB_RX_CONTROL, 0, 0,
 386                                     REGISTER_TIMEOUT);
 387
 388         /*
 389          * The USB version of kill_tx_queue also works
 390          * on the RX queue.
 391          */
 392         rt2x00dev->ops->lib->kill_tx_queue(rt2x00dev, QID_RX);
 393 }
 394 EXPORT_SYMBOL_GPL(rt2x00usb_disable_radio);
 395
 396 /*
 397  * Device initialization handlers.
 398  */
 399 void rt2x00usb_clear_entry(struct queue_entry *entry)
 400 {
 401         struct usb_device *usb_dev =
 402             to_usb_device_intf(entry->queue->rt2x00dev->dev);
 403         struct queue_entry_priv_usb *entry_priv = entry->priv_data;
 404         int pipe;
 405
 406         if (entry->queue->qid == QID_RX) {
 407                 pipe = usb_rcvbulkpipe(usb_dev, entry->queue->usb_endpoint);
 408                 usb_fill_bulk_urb(entry_priv->urb, usb_dev, pipe,
 409                                 entry->skb->data, entry->skb->len,
 410                                 rt2x00usb_interrupt_rxdone, entry);
 411
 412                 set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
 413                 usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
 414         } else {
 415                 entry->flags = 0;
 416         }
 417 }
 418 EXPORT_SYMBOL_GPL(rt2x00usb_clear_entry);
 419
 420 static void rt2x00usb_assign_endpoint(struct data_queue *queue,
 421                                       struct usb_endpoint_descriptor *ep_desc)
 422 {
 423         struct usb_device *usb_dev = to_usb_device_intf(queue->rt2x00dev->dev);
 424         int pipe;
 425
 426         queue->usb_endpoint = usb_endpoint_num(ep_desc);
 427
 428         if (queue->qid == QID_RX) {
 429                 pipe = usb_rcvbulkpipe(usb_dev, queue->usb_endpoint);
 430                 queue->usb_maxpacket = usb_maxpacket(usb_dev, pipe, 0);
 431         } else {
 432                 pipe = usb_sndbulkpipe(usb_dev, queue->usb_endpoint);
 433                 queue->usb_maxpacket = usb_maxpacket(usb_dev, pipe, 1);
 434         }
 435
 436         if (!queue->usb_maxpacket)
 437                 queue->usb_maxpacket = 1;
 438 }
 439
 440 static int rt2x00usb_find_endpoints(struct rt2x00_dev *rt2x00dev)
 441 {
 442         struct usb_interface *intf = to_usb_interface(rt2x00dev->dev);
 443         struct usb_host_interface *intf_desc = intf->cur_altsetting;
 444         struct usb_endpoint_descriptor *ep_desc;
 445         struct data_queue *queue = rt2x00dev->tx;
 446         struct usb_endpoint_descriptor *tx_ep_desc = NULL;
 447         unsigned int i;
 448
 449         /*
 450          * Walk through all available endpoints to search for "bulk in"
 451          * and "bulk out" endpoints. When we find such endpoints collect
 452          * the information we need from the descriptor and assign it
 453          * to the queue.
 454          */
 455         for (i = 0; i < intf_desc->desc.bNumEndpoints; i++) {
 456                 ep_desc = &intf_desc->endpoint[i].desc;
 457
 458                 if (usb_endpoint_is_bulk_in(ep_desc)) {
 459                         rt2x00usb_assign_endpoint(rt2x00dev->rx, ep_desc);
 460                 } else if (usb_endpoint_is_bulk_out(ep_desc) &&
 461                            (queue != queue_end(rt2x00dev))) {
 462                         rt2x00usb_assign_endpoint(queue, ep_desc);
 463                         queue = queue_next(queue);
 464
 465                         tx_ep_desc = ep_desc;
 466                 }
 467         }
 468
 469         /*
 470          * At least 1 endpoint for RX and 1 endpoint for TX must be available.
 471          */
 472         if (!rt2x00dev->rx->usb_endpoint || !rt2x00dev->tx->usb_endpoint) {
 473                 ERROR(rt2x00dev, "Bulk-in/Bulk-out endpoints not found\n");
 474                 return -EPIPE;
 475         }
 476
 477         /*
 478          * It might be possible not all queues have a dedicated endpoint.
 479          * Loop through all TX queues and copy the endpoint information
 480          * which we have gathered from already assigned endpoints.
 481          */
 482         txall_queue_for_each(rt2x00dev, queue) {
 483                 if (!queue->usb_endpoint)
 484                         rt2x00usb_assign_endpoint(queue, tx_ep_desc);
 485         }
 486
 487         return 0;
 488 }
 489
 490 static int rt2x00usb_alloc_urb(struct rt2x00_dev *rt2x00dev,
 491                                struct data_queue *queue)
 492 {
 493         struct queue_entry_priv_usb *entry_priv;
 494         struct queue_entry_priv_usb_bcn *bcn_priv;
 495         unsigned int i;
 496
 497         for (i = 0; i < queue->limit; i++) {
 498                 entry_priv = queue->entries[i].priv_data;
 499                 entry_priv->urb = usb_alloc_urb(0, GFP_KERNEL);
 500                 if (!entry_priv->urb)
 501                         return -ENOMEM;
 502         }
 503
 504         /*
 505          * If this is not the beacon queue or
 506          * no guardian byte was required for the beacon,
 507          * then we are done.
 508          */
 509         if (rt2x00dev->bcn != queue ||
 510             !test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
 511                 return 0;
 512
 513         for (i = 0; i < queue->limit; i++) {
 514                 bcn_priv = queue->entries[i].priv_data;
 515                 bcn_priv->guardian_urb = usb_alloc_urb(0, GFP_KERNEL);
 516                 if (!bcn_priv->guardian_urb)
 517                         return -ENOMEM;
 518         }
 519
 520         return 0;
 521 }
 522
 523 static void rt2x00usb_free_urb(struct rt2x00_dev *rt2x00dev,
 524                                struct data_queue *queue)
 525 {
 526         struct queue_entry_priv_usb *entry_priv;
 527         struct queue_entry_priv_usb_bcn *bcn_priv;
 528         unsigned int i;
 529
 530         if (!queue->entries)
 531                 return;
 532
 533         for (i = 0; i < queue->limit; i++) {
 534                 entry_priv = queue->entries[i].priv_data;
 535                 usb_kill_urb(entry_priv->urb);
 536                 usb_free_urb(entry_priv->urb);
 537         }
 538
 539         /*
 540          * If this is not the beacon queue or
 541          * no guardian byte was required for the beacon,
 542          * then we are done.
 543          */
 544         if (rt2x00dev->bcn != queue ||
 545             !test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
 546                 return;
 547
 548         for (i = 0; i < queue->limit; i++) {
 549                 bcn_priv = queue->entries[i].priv_data;
 550                 usb_kill_urb(bcn_priv->guardian_urb);
 551                 usb_free_urb(bcn_priv->guardian_urb);
 552         }
 553 }
 554
 555 int rt2x00usb_initialize(struct rt2x00_dev *rt2x00dev)
 556 {
 557         struct data_queue *queue;
 558         int status;
 559
 560         /*
 561          * Find endpoints for each queue
 562          */
 563         status = rt2x00usb_find_endpoints(rt2x00dev);
 564         if (status)
 565                 goto exit;
 566
 567         /*
 568          * Allocate DMA
 569          */
 570         queue_for_each(rt2x00dev, queue) {
 571                 status = rt2x00usb_alloc_urb(rt2x00dev, queue);
 572                 if (status)
 573                         goto exit;
 574         }
 575
 576         return 0;
 577
 578 exit:
 579         rt2x00usb_uninitialize(rt2x00dev);
 580
 581         return status;
 582 }
 583 EXPORT_SYMBOL_GPL(rt2x00usb_initialize);
 584
 585 void rt2x00usb_uninitialize(struct rt2x00_dev *rt2x00dev)
 586 {
 587         struct data_queue *queue;
 588
 589         queue_for_each(rt2x00dev, queue)
 590                 rt2x00usb_free_urb(rt2x00dev, queue);
 591 }
 592 EXPORT_SYMBOL_GPL(rt2x00usb_uninitialize);
 593
 594 /*
 595  * USB driver handlers.
 596  */
 597 static void rt2x00usb_free_reg(struct rt2x00_dev *rt2x00dev)
 598 {
 599         kfree(rt2x00dev->rf);
 600         rt2x00dev->rf = NULL;
 601
 602         kfree(rt2x00dev->eeprom);
 603         rt2x00dev->eeprom = NULL;
 604
 605         kfree(rt2x00dev->csr.cache);
 606         rt2x00dev->csr.cache = NULL;
 607 }
 608
 609 static int rt2x00usb_alloc_reg(struct rt2x00_dev *rt2x00dev)
 610 {
 611         rt2x00dev->csr.cache = kzalloc(CSR_CACHE_SIZE, GFP_KERNEL);
 612         if (!rt2x00dev->csr.cache)
 613                 goto exit;
 614
 615         rt2x00dev->eeprom = kzalloc(rt2x00dev->ops->eeprom_size, GFP_KERNEL);
 616         if (!rt2x00dev->eeprom)
 617                 goto exit;
 618
 619         rt2x00dev->rf = kzalloc(rt2x00dev->ops->rf_size, GFP_KERNEL);
 620         if (!rt2x00dev->rf)
 621                 goto exit;
 622
 623         return 0;
 624
 625 exit:
 626         ERROR_PROBE("Failed to allocate registers.\n");
 627
 628         rt2x00usb_free_reg(rt2x00dev);
 629
 630         return -ENOMEM;
 631 }
 632
 633 int rt2x00usb_probe(struct usb_interface *usb_intf,
 634                     const struct usb_device_id *id)
 635 {
 636         struct usb_device *usb_dev = interface_to_usbdev(usb_intf);
 637         struct rt2x00_ops *ops = (struct rt2x00_ops *)id->driver_info;
 638         struct ieee80211_hw *hw;
 639         struct rt2x00_dev *rt2x00dev;
 640         int retval;
 641
 642         usb_dev = usb_get_dev(usb_dev);
 643
 644         hw = ieee80211_alloc_hw(sizeof(struct rt2x00_dev), ops->hw);
 645         if (!hw) {
 646                 ERROR_PROBE("Failed to allocate hardware.\n");
 647                 retval = -ENOMEM;
 648                 goto exit_put_device;
 649         }
 650
 651         usb_set_intfdata(usb_intf, hw);
 652
 653         rt2x00dev = hw->priv;
 654         rt2x00dev->dev = &usb_intf->dev;
 655         rt2x00dev->ops = ops;
 656         rt2x00dev->hw = hw;
 657
 658         rt2x00_set_chip_intf(rt2x00dev, RT2X00_CHIP_INTF_USB);
 659
 660         retval = rt2x00usb_alloc_reg(rt2x00dev);
 661         if (retval)
 662                 goto exit_free_device;
 663
 664         retval = rt2x00lib_probe_dev(rt2x00dev);
 665         if (retval)
 666                 goto exit_free_reg;
 667
 668         return 0;
 669
 670 exit_free_reg:
 671         rt2x00usb_free_reg(rt2x00dev);
 672
 673 exit_free_device:
 674         ieee80211_free_hw(hw);
 675
 676 exit_put_device:
 677         usb_put_dev(usb_dev);
 678
 679         usb_set_intfdata(usb_intf, NULL);
 680
 681         return retval;
 682 }
 683 EXPORT_SYMBOL_GPL(rt2x00usb_probe);
 684
 685 void rt2x00usb_disconnect(struct usb_interface *usb_intf)
 686 {
 687         struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
 688         struct rt2x00_dev *rt2x00dev = hw->priv;
 689
 690         /*
 691          * Free all allocated data.
 692          */
 693         rt2x00lib_remove_dev(rt2x00dev);
 694         rt2x00usb_free_reg(rt2x00dev);
 695         ieee80211_free_hw(hw);
 696
 697         /*
 698          * Free the USB device data.
 699          */
 700         usb_set_intfdata(usb_intf, NULL);
 701         usb_put_dev(interface_to_usbdev(usb_intf));
 702 }
 703 EXPORT_SYMBOL_GPL(rt2x00usb_disconnect);
 704
 705 #ifdef CONFIG_PM
 706 int rt2x00usb_suspend(struct usb_interface *usb_intf, pm_message_t state)
 707 {
 708         struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
 709         struct rt2x00_dev *rt2x00dev = hw->priv;
 710         int retval;
 711
 712         retval = rt2x00lib_suspend(rt2x00dev, state);
 713         if (retval)
 714                 return retval;
 715
 716         /*
 717          * Decrease usbdev refcount.
 718          */
 719         usb_put_dev(interface_to_usbdev(usb_intf));
 720
 721         return 0;
 722 }
 723 EXPORT_SYMBOL_GPL(rt2x00usb_suspend);
 724
 725 int rt2x00usb_resume(struct usb_interface *usb_intf)
 726 {
 727         struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
 728         struct rt2x00_dev *rt2x00dev = hw->priv;
 729
 730         usb_get_dev(interface_to_usbdev(usb_intf));
 731
 732         return rt2x00lib_resume(rt2x00dev);
 733 }
 734 EXPORT_SYMBOL_GPL(rt2x00usb_resume);
 735 #endif /* CONFIG_PM */
 736
 737 /*
 738  * rt2x00usb module information.
 739  */
 740 MODULE_AUTHOR(DRV_PROJECT);
 741 MODULE_VERSION(DRV_VERSION);
 742 MODULE_DESCRIPTION("rt2x00 usb library");
 743 MODULE_LICENSE("GPL");