err.no Git - linux-2.6/blob - drivers/net/wireless/rt2x00/rt2x00usb.c

   1 /*
   2         Copyright (C) 2004 - 2008 rt2x00 SourceForge Project
   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/usb.h>
  29 #include <linux/bug.h>
  30
  31 #include "rt2x00.h"
  32 #include "rt2x00usb.h"
  33
  34 /*
  35  * Interfacing with the HW.
  36  */
  37 int rt2x00usb_vendor_request(struct rt2x00_dev *rt2x00dev,
  38                              const u8 request, const u8 requesttype,
  39                              const u16 offset, const u16 value,
  40                              void *buffer, const u16 buffer_length,
  41                              const int timeout)
  42 {
  43         struct usb_device *usb_dev = rt2x00dev_usb_dev(rt2x00dev);
  44         int status;
  45         unsigned int i;
  46         unsigned int pipe =
  47             (requesttype == USB_VENDOR_REQUEST_IN) ?
  48             usb_rcvctrlpipe(usb_dev, 0) : usb_sndctrlpipe(usb_dev, 0);
  49
  50
  51         for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
  52                 status = usb_control_msg(usb_dev, pipe, request, requesttype,
  53                                          value, offset, buffer, buffer_length,
  54                                          timeout);
  55                 if (status >= 0)
  56                         return 0;
  57
  58                 /*
  59                  * Check for errors
  60                  * -ENODEV: Device has disappeared, no point continuing.
  61                  * All other errors: Try again.
  62                  */
  63                 else if (status == -ENODEV)
  64                         break;
  65         }
  66
  67         ERROR(rt2x00dev,
  68               "Vendor Request 0x%02x failed for offset 0x%04x with error %d.\n",
  69               request, offset, status);
  70
  71         return status;
  72 }
  73 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request);
  74
  75 int rt2x00usb_vendor_req_buff_lock(struct rt2x00_dev *rt2x00dev,
  76                                    const u8 request, const u8 requesttype,
  77                                    const u16 offset, void *buffer,
  78                                    const u16 buffer_length, const int timeout)
  79 {
  80         int status;
  81
  82         BUG_ON(!mutex_is_locked(&rt2x00dev->usb_cache_mutex));
  83
  84         /*
  85          * Check for Cache availability.
  86          */
  87         if (unlikely(!rt2x00dev->csr.cache || buffer_length > CSR_CACHE_SIZE)) {
  88                 ERROR(rt2x00dev, "CSR cache not available.\n");
  89                 return -ENOMEM;
  90         }
  91
  92         if (requesttype == USB_VENDOR_REQUEST_OUT)
  93                 memcpy(rt2x00dev->csr.cache, buffer, buffer_length);
  94
  95         status = rt2x00usb_vendor_request(rt2x00dev, request, requesttype,
  96                                           offset, 0, rt2x00dev->csr.cache,
  97                                           buffer_length, timeout);
  98
  99         if (!status && requesttype == USB_VENDOR_REQUEST_IN)
 100                 memcpy(buffer, rt2x00dev->csr.cache, buffer_length);
 101
 102         return status;
 103 }
 104 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_req_buff_lock);
 105
 106 int rt2x00usb_vendor_request_buff(struct rt2x00_dev *rt2x00dev,
 107                                   const u8 request, const u8 requesttype,
 108                                   const u16 offset, void *buffer,
 109                                   const u16 buffer_length, const int timeout)
 110 {
 111         int status;
 112
 113         mutex_lock(&rt2x00dev->usb_cache_mutex);
 114
 115         status = rt2x00usb_vendor_req_buff_lock(rt2x00dev, request,
 116                                                 requesttype, offset, buffer,
 117                                                 buffer_length, timeout);
 118
 119         mutex_unlock(&rt2x00dev->usb_cache_mutex);
 120
 121         return status;
 122 }
 123 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_buff);
 124
 125 /*
 126  * TX data handlers.
 127  */
 128 static void rt2x00usb_interrupt_txdone(struct urb *urb)
 129 {
 130         struct queue_entry *entry = (struct queue_entry *)urb->context;
 131         struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
 132         struct txdone_entry_desc txdesc;
 133         enum data_queue_qid qid = skb_get_queue_mapping(entry->skb);
 134
 135         if (!test_bit(DEVICE_ENABLED_RADIO, &rt2x00dev->flags) ||
 136             !__test_and_clear_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
 137                 return;
 138
 139         /*
 140          * Remove the descriptor data from the buffer.
 141          */
 142         skb_pull(entry->skb, entry->queue->desc_size);
 143
 144         /*
 145          * Obtain the status about this packet.
 146          * Note that when the status is 0 it does not mean the
 147          * frame was send out correctly. It only means the frame
 148          * was succesfully pushed to the hardware, we have no
 149          * way to determine the transmission status right now.
 150          * (Only indirectly by looking at the failed TX counters
 151          * in the register).
 152          */
 153         if (!urb->status)
 154                 __set_bit(TXDONE_UNKNOWN, &txdesc.flags);
 155         else
 156                 __set_bit(TXDONE_FAILURE, &txdesc.flags);
 157         txdesc.retry = 0;
 158
 159         rt2x00lib_txdone(entry, &txdesc);
 160
 161         /*
 162          * Make this entry available for reuse.
 163          */
 164         entry->flags = 0;
 165         rt2x00queue_index_inc(entry->queue, Q_INDEX_DONE);
 166
 167         /*
 168          * If the data queue was full before the txdone handler
 169          * we must make sure the packet queue in the mac80211 stack
 170          * is reenabled when the txdone handler has finished.
 171          */
 172         if (!rt2x00queue_full(entry->queue))
 173                 ieee80211_wake_queue(rt2x00dev->hw, qid);
 174 }
 175
 176 int rt2x00usb_write_tx_data(struct rt2x00_dev *rt2x00dev,
 177                             struct data_queue *queue, struct sk_buff *skb)
 178 {
 179         struct usb_device *usb_dev = rt2x00dev_usb_dev(rt2x00dev);
 180         struct queue_entry *entry = rt2x00queue_get_entry(queue, Q_INDEX);
 181         struct queue_entry_priv_usb *entry_priv = entry->priv_data;
 182         struct skb_frame_desc *skbdesc;
 183         struct txentry_desc txdesc;
 184         u32 length;
 185
 186         if (rt2x00queue_full(queue))
 187                 return -EINVAL;
 188
 189         if (test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags)) {
 190                 ERROR(rt2x00dev,
 191                       "Arrived at non-free entry in the non-full queue %d.\n"
 192                       "Please file bug report to %s.\n",
 193                       entry->queue->qid, DRV_PROJECT);
 194                 return -EINVAL;
 195         }
 196
 197         /*
 198          * Copy all TX descriptor information into txdesc,
 199          * after that we are free to use the skb->cb array
 200          * for our information.
 201          */
 202         entry->skb = skb;
 203         rt2x00queue_create_tx_descriptor(entry, &txdesc);
 204
 205         /*
 206          * Add the descriptor in front of the skb.
 207          */
 208         skb_push(skb, queue->desc_size);
 209         memset(skb->data, 0, queue->desc_size);
 210
 211         /*
 212          * Fill in skb descriptor
 213          */
 214         skbdesc = get_skb_frame_desc(skb);
 215         memset(skbdesc, 0, sizeof(*skbdesc));
 216         skbdesc->data = skb->data + queue->desc_size;
 217         skbdesc->data_len = skb->len - queue->desc_size;
 218         skbdesc->desc = skb->data;
 219         skbdesc->desc_len = queue->desc_size;
 220         skbdesc->entry = entry;
 221
 222         rt2x00queue_write_tx_descriptor(entry, &txdesc);
 223
 224         /*
 225          * USB devices cannot blindly pass the skb->len as the
 226          * length of the data to usb_fill_bulk_urb. Pass the skb
 227          * to the driver to determine what the length should be.
 228          */
 229         length = rt2x00dev->ops->lib->get_tx_data_len(rt2x00dev, skb);
 230
 231         /*
 232          * Initialize URB and send the frame to the device.
 233          */
 234         __set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
 235         __set_bit(ENTRY_DATA_PENDING, &entry->flags);
 236
 237         usb_fill_bulk_urb(entry_priv->urb, usb_dev, usb_sndbulkpipe(usb_dev, 1),
 238                           skb->data, length, rt2x00usb_interrupt_txdone, entry);
 239
 240         rt2x00queue_index_inc(queue, Q_INDEX);
 241
 242         return 0;
 243 }
 244 EXPORT_SYMBOL_GPL(rt2x00usb_write_tx_data);
 245
 246 static inline void rt2x00usb_kick_tx_entry(struct queue_entry *entry)
 247 {
 248         struct queue_entry_priv_usb *entry_priv = entry->priv_data;
 249
 250         if (__test_and_clear_bit(ENTRY_DATA_PENDING, &entry->flags))
 251                 usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
 252 }
 253
 254 void rt2x00usb_kick_tx_queue(struct rt2x00_dev *rt2x00dev,
 255                              const enum data_queue_qid qid)
 256 {
 257         struct data_queue *queue = rt2x00queue_get_queue(rt2x00dev, qid);
 258         unsigned long irqflags;
 259         unsigned int index;
 260         unsigned int index_done;
 261         unsigned int i;
 262
 263         /*
 264          * Only protect the range we are going to loop over,
 265          * if during our loop a extra entry is set to pending
 266          * it should not be kicked during this run, since it
 267          * is part of another TX operation.
 268          */
 269         spin_lock_irqsave(&queue->lock, irqflags);
 270         index = queue->index[Q_INDEX];
 271         index_done = queue->index[Q_INDEX_DONE];
 272         spin_unlock_irqrestore(&queue->lock, irqflags);
 273
 274         /*
 275          * Start from the TX done pointer, this guarentees that we will
 276          * send out all frames in the correct order.
 277          */
 278         if (index_done < index) {
 279                 for (i = index_done; i < index; i++)
 280                         rt2x00usb_kick_tx_entry(&queue->entries[i]);
 281         } else {
 282                 for (i = index_done; i < queue->limit; i++)
 283                         rt2x00usb_kick_tx_entry(&queue->entries[i]);
 284
 285                 for (i = 0; i < index; i++)
 286                         rt2x00usb_kick_tx_entry(&queue->entries[i]);
 287         }
 288 }
 289 EXPORT_SYMBOL_GPL(rt2x00usb_kick_tx_queue);
 290
 291 /*
 292  * RX data handlers.
 293  */
 294 static struct sk_buff* rt2x00usb_alloc_rxskb(struct data_queue *queue)
 295 {
 296         struct sk_buff *skb;
 297         unsigned int frame_size;
 298         unsigned int reserved_size;
 299
 300         /*
 301          * The frame size includes descriptor size, because the
 302          * hardware directly receive the frame into the skbuffer.
 303          */
 304         frame_size = queue->data_size + queue->desc_size;
 305
 306         /*
 307          * For the allocation we should keep a few things in mind:
 308          * 1) 4byte alignment of 802.11 payload
 309          *
 310          * For (1) we need at most 4 bytes to guarentee the correct
 311          * alignment. We are going to optimize the fact that the chance
 312          * that the 802.11 header_size % 4 == 2 is much bigger then
 313          * anything else. However since we need to move the frame up
 314          * to 3 bytes to the front, which means we need to preallocate
 315          * 6 bytes.
 316          */
 317         reserved_size = 6;
 318
 319         /*
 320          * Allocate skbuffer.
 321          */
 322         skb = dev_alloc_skb(frame_size + reserved_size);
 323         if (!skb)
 324                 return NULL;
 325
 326         skb_reserve(skb, reserved_size);
 327         skb_put(skb, frame_size);
 328
 329         return skb;
 330 }
 331
 332 static void rt2x00usb_interrupt_rxdone(struct urb *urb)
 333 {
 334         struct queue_entry *entry = (struct queue_entry *)urb->context;
 335         struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
 336         struct sk_buff *skb;
 337         struct skb_frame_desc *skbdesc;
 338         struct rxdone_entry_desc rxdesc;
 339         unsigned int header_size;
 340         unsigned int align;
 341
 342         if (!test_bit(DEVICE_ENABLED_RADIO, &rt2x00dev->flags) ||
 343             !test_and_clear_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
 344                 return;
 345
 346         /*
 347          * Check if the received data is simply too small
 348          * to be actually valid, or if the urb is signaling
 349          * a problem.
 350          */
 351         if (urb->actual_length < entry->queue->desc_size || urb->status)
 352                 goto skip_entry;
 353
 354         /*
 355          * Fill in skb descriptor
 356          */
 357         skbdesc = get_skb_frame_desc(entry->skb);
 358         memset(skbdesc, 0, sizeof(*skbdesc));
 359         skbdesc->entry = entry;
 360
 361         memset(&rxdesc, 0, sizeof(rxdesc));
 362         rt2x00dev->ops->lib->fill_rxdone(entry, &rxdesc);
 363
 364         header_size = ieee80211_get_hdrlen_from_skb(entry->skb);
 365
 366         /*
 367          * The data behind the ieee80211 header must be
 368          * aligned on a 4 byte boundary. We already reserved
 369          * 2 bytes for header_size % 4 == 2 optimization.
 370          * To determine the number of bytes which the data
 371          * should be moved to the left, we must add these
 372          * 2 bytes to the header_size.
 373          */
 374         align = (header_size + 2) % 4;
 375
 376         if (align) {
 377                 skb_push(entry->skb, align);
 378                 /* Move entire frame in 1 command */
 379                 memmove(entry->skb->data, entry->skb->data + align,
 380                         rxdesc.size);
 381         }
 382
 383         /* Update data pointers, trim buffer to correct size */
 384         skbdesc->data = entry->skb->data;
 385         skb_trim(entry->skb, rxdesc.size);
 386
 387         /*
 388          * Allocate a new sk buffer to replace the current one.
 389          * If allocation fails, we should drop the current frame
 390          * so we can recycle the existing sk buffer for the new frame.
 391          */
 392         skb = rt2x00usb_alloc_rxskb(entry->queue);
 393         if (!skb)
 394                 goto skip_entry;
 395
 396         /*
 397          * Send the frame to rt2x00lib for further processing.
 398          */
 399         rt2x00lib_rxdone(entry, &rxdesc);
 400
 401         /*
 402          * Replace current entry's skb with the newly allocated one,
 403          * and reinitialize the urb.
 404          */
 405         entry->skb = skb;
 406         urb->transfer_buffer = entry->skb->data;
 407         urb->transfer_buffer_length = entry->skb->len;
 408
 409 skip_entry:
 410         if (test_bit(DEVICE_ENABLED_RADIO, &entry->queue->rt2x00dev->flags)) {
 411                 __set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
 412                 usb_submit_urb(urb, GFP_ATOMIC);
 413         }
 414
 415         rt2x00queue_index_inc(entry->queue, Q_INDEX);
 416 }
 417
 418 /*
 419  * Radio handlers
 420  */
 421 void rt2x00usb_disable_radio(struct rt2x00_dev *rt2x00dev)
 422 {
 423         struct queue_entry_priv_usb *entry_priv;
 424         struct queue_entry_priv_usb_bcn *bcn_priv;
 425         unsigned int i;
 426
 427         rt2x00usb_vendor_request_sw(rt2x00dev, USB_RX_CONTROL, 0, 0,
 428                                     REGISTER_TIMEOUT);
 429
 430         /*
 431          * Cancel all queues.
 432          */
 433         for (i = 0; i < rt2x00dev->rx->limit; i++) {
 434                 entry_priv = rt2x00dev->rx->entries[i].priv_data;
 435                 usb_kill_urb(entry_priv->urb);
 436         }
 437
 438         /*
 439          * Kill guardian urb.
 440          */
 441         for (i = 0; i < rt2x00dev->bcn->limit; i++) {
 442                 bcn_priv = rt2x00dev->bcn->entries[i].priv_data;
 443                 if (bcn_priv->guardian_urb)
 444                         usb_kill_urb(bcn_priv->guardian_urb);
 445         }
 446 }
 447 EXPORT_SYMBOL_GPL(rt2x00usb_disable_radio);
 448
 449 /*
 450  * Device initialization handlers.
 451  */
 452 void rt2x00usb_init_rxentry(struct rt2x00_dev *rt2x00dev,
 453                             struct queue_entry *entry)
 454 {
 455         struct usb_device *usb_dev = rt2x00dev_usb_dev(rt2x00dev);
 456         struct queue_entry_priv_usb *entry_priv = entry->priv_data;
 457
 458         usb_fill_bulk_urb(entry_priv->urb, usb_dev,
 459                           usb_rcvbulkpipe(usb_dev, 1),
 460                           entry->skb->data, entry->skb->len,
 461                           rt2x00usb_interrupt_rxdone, entry);
 462
 463         __set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
 464         usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
 465 }
 466 EXPORT_SYMBOL_GPL(rt2x00usb_init_rxentry);
 467
 468 void rt2x00usb_init_txentry(struct rt2x00_dev *rt2x00dev,
 469                             struct queue_entry *entry)
 470 {
 471         entry->flags = 0;
 472 }
 473 EXPORT_SYMBOL_GPL(rt2x00usb_init_txentry);
 474
 475 static int rt2x00usb_alloc_urb(struct rt2x00_dev *rt2x00dev,
 476                                struct data_queue *queue)
 477 {
 478         struct queue_entry_priv_usb *entry_priv;
 479         struct queue_entry_priv_usb_bcn *bcn_priv;
 480         unsigned int i;
 481
 482         for (i = 0; i < queue->limit; i++) {
 483                 entry_priv = queue->entries[i].priv_data;
 484                 entry_priv->urb = usb_alloc_urb(0, GFP_KERNEL);
 485                 if (!entry_priv->urb)
 486                         return -ENOMEM;
 487         }
 488
 489         /*
 490          * If this is not the beacon queue or
 491          * no guardian byte was required for the beacon,
 492          * then we are done.
 493          */
 494         if (rt2x00dev->bcn != queue ||
 495             !test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
 496                 return 0;
 497
 498         for (i = 0; i < queue->limit; i++) {
 499                 bcn_priv = queue->entries[i].priv_data;
 500                 bcn_priv->guardian_urb = usb_alloc_urb(0, GFP_KERNEL);
 501                 if (!bcn_priv->guardian_urb)
 502                         return -ENOMEM;
 503         }
 504
 505         return 0;
 506 }
 507
 508 static void rt2x00usb_free_urb(struct rt2x00_dev *rt2x00dev,
 509                                struct data_queue *queue)
 510 {
 511         struct queue_entry_priv_usb *entry_priv;
 512         struct queue_entry_priv_usb_bcn *bcn_priv;
 513         unsigned int i;
 514
 515         if (!queue->entries)
 516                 return;
 517
 518         for (i = 0; i < queue->limit; i++) {
 519                 entry_priv = queue->entries[i].priv_data;
 520                 usb_kill_urb(entry_priv->urb);
 521                 usb_free_urb(entry_priv->urb);
 522                 if (queue->entries[i].skb)
 523                         kfree_skb(queue->entries[i].skb);
 524         }
 525
 526         /*
 527          * If this is not the beacon queue or
 528          * no guardian byte was required for the beacon,
 529          * then we are done.
 530          */
 531         if (rt2x00dev->bcn != queue ||
 532             !test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
 533                 return;
 534
 535         for (i = 0; i < queue->limit; i++) {
 536                 bcn_priv = queue->entries[i].priv_data;
 537                 usb_kill_urb(bcn_priv->guardian_urb);
 538                 usb_free_urb(bcn_priv->guardian_urb);
 539         }
 540 }
 541
 542 int rt2x00usb_initialize(struct rt2x00_dev *rt2x00dev)
 543 {
 544         struct data_queue *queue;
 545         struct sk_buff *skb;
 546         unsigned int entry_size;
 547         unsigned int i;
 548         int uninitialized_var(status);
 549
 550         /*
 551          * Allocate DMA
 552          */
 553         queue_for_each(rt2x00dev, queue) {
 554                 status = rt2x00usb_alloc_urb(rt2x00dev, queue);
 555                 if (status)
 556                         goto exit;
 557         }
 558
 559         /*
 560          * For the RX queue, skb's should be allocated.
 561          */
 562         entry_size = rt2x00dev->rx->data_size + rt2x00dev->rx->desc_size;
 563         for (i = 0; i < rt2x00dev->rx->limit; i++) {
 564                 skb = rt2x00usb_alloc_rxskb(rt2x00dev->rx);
 565                 if (!skb)
 566                         goto exit;
 567
 568                 rt2x00dev->rx->entries[i].skb = skb;
 569         }
 570
 571         return 0;
 572
 573 exit:
 574         rt2x00usb_uninitialize(rt2x00dev);
 575
 576         return status;
 577 }
 578 EXPORT_SYMBOL_GPL(rt2x00usb_initialize);
 579
 580 void rt2x00usb_uninitialize(struct rt2x00_dev *rt2x00dev)
 581 {
 582         struct data_queue *queue;
 583
 584         queue_for_each(rt2x00dev, queue)
 585                 rt2x00usb_free_urb(rt2x00dev, queue);
 586 }
 587 EXPORT_SYMBOL_GPL(rt2x00usb_uninitialize);
 588
 589 /*
 590  * USB driver handlers.
 591  */
 592 static void rt2x00usb_free_reg(struct rt2x00_dev *rt2x00dev)
 593 {
 594         kfree(rt2x00dev->rf);
 595         rt2x00dev->rf = NULL;
 596
 597         kfree(rt2x00dev->eeprom);
 598         rt2x00dev->eeprom = NULL;
 599
 600         kfree(rt2x00dev->csr.cache);
 601         rt2x00dev->csr.cache = NULL;
 602 }
 603
 604 static int rt2x00usb_alloc_reg(struct rt2x00_dev *rt2x00dev)
 605 {
 606         rt2x00dev->csr.cache = kzalloc(CSR_CACHE_SIZE, GFP_KERNEL);
 607         if (!rt2x00dev->csr.cache)
 608                 goto exit;
 609
 610         rt2x00dev->eeprom = kzalloc(rt2x00dev->ops->eeprom_size, GFP_KERNEL);
 611         if (!rt2x00dev->eeprom)
 612                 goto exit;
 613
 614         rt2x00dev->rf = kzalloc(rt2x00dev->ops->rf_size, GFP_KERNEL);
 615         if (!rt2x00dev->rf)
 616                 goto exit;
 617
 618         return 0;
 619
 620 exit:
 621         ERROR_PROBE("Failed to allocate registers.\n");
 622
 623         rt2x00usb_free_reg(rt2x00dev);
 624
 625         return -ENOMEM;
 626 }
 627
 628 int rt2x00usb_probe(struct usb_interface *usb_intf,
 629                     const struct usb_device_id *id)
 630 {
 631         struct usb_device *usb_dev = interface_to_usbdev(usb_intf);
 632         struct rt2x00_ops *ops = (struct rt2x00_ops *)id->driver_info;
 633         struct ieee80211_hw *hw;
 634         struct rt2x00_dev *rt2x00dev;
 635         int retval;
 636
 637         usb_dev = usb_get_dev(usb_dev);
 638
 639         hw = ieee80211_alloc_hw(sizeof(struct rt2x00_dev), ops->hw);
 640         if (!hw) {
 641                 ERROR_PROBE("Failed to allocate hardware.\n");
 642                 retval = -ENOMEM;
 643                 goto exit_put_device;
 644         }
 645
 646         usb_set_intfdata(usb_intf, hw);
 647
 648         rt2x00dev = hw->priv;
 649         rt2x00dev->dev = usb_intf;
 650         rt2x00dev->ops = ops;
 651         rt2x00dev->hw = hw;
 652         mutex_init(&rt2x00dev->usb_cache_mutex);
 653
 654         rt2x00dev->usb_maxpacket =
 655             usb_maxpacket(usb_dev, usb_sndbulkpipe(usb_dev, 1), 1);
 656         if (!rt2x00dev->usb_maxpacket)
 657                 rt2x00dev->usb_maxpacket = 1;
 658
 659         retval = rt2x00usb_alloc_reg(rt2x00dev);
 660         if (retval)
 661                 goto exit_free_device;
 662
 663         retval = rt2x00lib_probe_dev(rt2x00dev);
 664         if (retval)
 665                 goto exit_free_reg;
 666
 667         return 0;
 668
 669 exit_free_reg:
 670         rt2x00usb_free_reg(rt2x00dev);
 671
 672 exit_free_device:
 673         ieee80211_free_hw(hw);
 674
 675 exit_put_device:
 676         usb_put_dev(usb_dev);
 677
 678         usb_set_intfdata(usb_intf, NULL);
 679
 680         return retval;
 681 }
 682 EXPORT_SYMBOL_GPL(rt2x00usb_probe);
 683
 684 void rt2x00usb_disconnect(struct usb_interface *usb_intf)
 685 {
 686         struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
 687         struct rt2x00_dev *rt2x00dev = hw->priv;
 688
 689         /*
 690          * Free all allocated data.
 691          */
 692         rt2x00lib_remove_dev(rt2x00dev);
 693         rt2x00usb_free_reg(rt2x00dev);
 694         ieee80211_free_hw(hw);
 695
 696         /*
 697          * Free the USB device data.
 698          */
 699         usb_set_intfdata(usb_intf, NULL);
 700         usb_put_dev(interface_to_usbdev(usb_intf));
 701 }
 702 EXPORT_SYMBOL_GPL(rt2x00usb_disconnect);
 703
 704 #ifdef CONFIG_PM
 705 int rt2x00usb_suspend(struct usb_interface *usb_intf, pm_message_t state)
 706 {
 707         struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
 708         struct rt2x00_dev *rt2x00dev = hw->priv;
 709         int retval;
 710
 711         retval = rt2x00lib_suspend(rt2x00dev, state);
 712         if (retval)
 713                 return retval;
 714
 715         rt2x00usb_free_reg(rt2x00dev);
 716
 717         /*
 718          * Decrease usbdev refcount.
 719          */
 720         usb_put_dev(interface_to_usbdev(usb_intf));
 721
 722         return 0;
 723 }
 724 EXPORT_SYMBOL_GPL(rt2x00usb_suspend);
 725
 726 int rt2x00usb_resume(struct usb_interface *usb_intf)
 727 {
 728         struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
 729         struct rt2x00_dev *rt2x00dev = hw->priv;
 730         int retval;
 731
 732         usb_get_dev(interface_to_usbdev(usb_intf));
 733
 734         retval = rt2x00usb_alloc_reg(rt2x00dev);
 735         if (retval)
 736                 return retval;
 737
 738         retval = rt2x00lib_resume(rt2x00dev);
 739         if (retval)
 740                 goto exit_free_reg;
 741
 742         return 0;
 743
 744 exit_free_reg:
 745         rt2x00usb_free_reg(rt2x00dev);
 746
 747         return retval;
 748 }
 749 EXPORT_SYMBOL_GPL(rt2x00usb_resume);
 750 #endif /* CONFIG_PM */
 751
 752 /*
 753  * rt2x00usb module information.
 754  */
 755 MODULE_AUTHOR(DRV_PROJECT);
 756 MODULE_VERSION(DRV_VERSION);
 757 MODULE_DESCRIPTION("rt2x00 usb library");
 758 MODULE_LICENSE("GPL");