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 =
  44                 interface_to_usbdev(to_usb_interface(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
  52         for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
  53                 status = usb_control_msg(usb_dev, pipe, request, requesttype,
  54                                          value, offset, buffer, buffer_length,
  55                                          timeout);
  56                 if (status >= 0)
  57                         return 0;
  58
  59                 /*
  60                  * Check for errors
  61                  * -ENODEV: Device has disappeared, no point continuing.
  62                  * All other errors: Try again.
  63                  */
  64                 else if (status == -ENODEV)
  65                         break;
  66         }
  67
  68         ERROR(rt2x00dev,
  69               "Vendor Request 0x%02x failed for offset 0x%04x with error %d.\n",
  70               request, offset, status);
  71
  72         return status;
  73 }
  74 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request);
  75
  76 int rt2x00usb_vendor_req_buff_lock(struct rt2x00_dev *rt2x00dev,
  77                                    const u8 request, const u8 requesttype,
  78                                    const u16 offset, void *buffer,
  79                                    const u16 buffer_length, const int timeout)
  80 {
  81         int status;
  82
  83         BUG_ON(!mutex_is_locked(&rt2x00dev->usb_cache_mutex));
  84
  85         /*
  86          * Check for Cache availability.
  87          */
  88         if (unlikely(!rt2x00dev->csr.cache || buffer_length > CSR_CACHE_SIZE)) {
  89                 ERROR(rt2x00dev, "CSR cache not available.\n");
  90                 return -ENOMEM;
  91         }
  92
  93         if (requesttype == USB_VENDOR_REQUEST_OUT)
  94                 memcpy(rt2x00dev->csr.cache, buffer, buffer_length);
  95
  96         status = rt2x00usb_vendor_request(rt2x00dev, request, requesttype,
  97                                           offset, 0, rt2x00dev->csr.cache,
  98                                           buffer_length, timeout);
  99
 100         if (!status && requesttype == USB_VENDOR_REQUEST_IN)
 101                 memcpy(buffer, rt2x00dev->csr.cache, buffer_length);
 102
 103         return status;
 104 }
 105 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_req_buff_lock);
 106
 107 int rt2x00usb_vendor_request_buff(struct rt2x00_dev *rt2x00dev,
 108                                   const u8 request, const u8 requesttype,
 109                                   const u16 offset, void *buffer,
 110                                   const u16 buffer_length, const int timeout)
 111 {
 112         int status;
 113
 114         mutex_lock(&rt2x00dev->usb_cache_mutex);
 115
 116         status = rt2x00usb_vendor_req_buff_lock(rt2x00dev, request,
 117                                                 requesttype, offset, buffer,
 118                                                 buffer_length, timeout);
 119
 120         mutex_unlock(&rt2x00dev->usb_cache_mutex);
 121
 122         return status;
 123 }
 124 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_buff);
 125
 126 /*
 127  * TX data handlers.
 128  */
 129 static void rt2x00usb_interrupt_txdone(struct urb *urb)
 130 {
 131         struct queue_entry *entry = (struct queue_entry *)urb->context;
 132         struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
 133         struct txdone_entry_desc txdesc;
 134
 135         if (!test_bit(DEVICE_ENABLED_RADIO, &rt2x00dev->flags) ||
 136             !test_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 int rt2x00usb_write_tx_data(struct queue_entry *entry)
 163 {
 164         struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
 165         struct usb_device *usb_dev =
 166                 interface_to_usbdev(to_usb_interface(rt2x00dev->dev));
 167         struct queue_entry_priv_usb *entry_priv = entry->priv_data;
 168         struct skb_frame_desc *skbdesc;
 169         u32 length;
 170
 171         /*
 172          * Add the descriptor in front of the skb.
 173          */
 174         skb_push(entry->skb, entry->queue->desc_size);
 175         memset(entry->skb->data, 0, entry->queue->desc_size);
 176
 177         /*
 178          * Fill in skb descriptor
 179          */
 180         skbdesc = get_skb_frame_desc(entry->skb);
 181         skbdesc->desc = entry->skb->data;
 182         skbdesc->desc_len = entry->queue->desc_size;
 183
 184         /*
 185          * USB devices cannot blindly pass the skb->len as the
 186          * length of the data to usb_fill_bulk_urb. Pass the skb
 187          * to the driver to determine what the length should be.
 188          */
 189         length = rt2x00dev->ops->lib->get_tx_data_len(rt2x00dev, entry->skb);
 190
 191         usb_fill_bulk_urb(entry_priv->urb, usb_dev,
 192                           usb_sndbulkpipe(usb_dev, 1),
 193                           entry->skb->data, length,
 194                           rt2x00usb_interrupt_txdone, entry);
 195
 196         return 0;
 197 }
 198 EXPORT_SYMBOL_GPL(rt2x00usb_write_tx_data);
 199
 200 static inline void rt2x00usb_kick_tx_entry(struct queue_entry *entry)
 201 {
 202         struct queue_entry_priv_usb *entry_priv = entry->priv_data;
 203
 204         if (__test_and_clear_bit(ENTRY_DATA_PENDING, &entry->flags))
 205                 usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
 206 }
 207
 208 void rt2x00usb_kick_tx_queue(struct rt2x00_dev *rt2x00dev,
 209                              const enum data_queue_qid qid)
 210 {
 211         struct data_queue *queue = rt2x00queue_get_queue(rt2x00dev, qid);
 212         unsigned long irqflags;
 213         unsigned int index;
 214         unsigned int index_done;
 215         unsigned int i;
 216
 217         /*
 218          * Only protect the range we are going to loop over,
 219          * if during our loop a extra entry is set to pending
 220          * it should not be kicked during this run, since it
 221          * is part of another TX operation.
 222          */
 223         spin_lock_irqsave(&queue->lock, irqflags);
 224         index = queue->index[Q_INDEX];
 225         index_done = queue->index[Q_INDEX_DONE];
 226         spin_unlock_irqrestore(&queue->lock, irqflags);
 227
 228         /*
 229          * Start from the TX done pointer, this guarentees that we will
 230          * send out all frames in the correct order.
 231          */
 232         if (index_done < index) {
 233                 for (i = index_done; i < index; i++)
 234                         rt2x00usb_kick_tx_entry(&queue->entries[i]);
 235         } else {
 236                 for (i = index_done; i < queue->limit; i++)
 237                         rt2x00usb_kick_tx_entry(&queue->entries[i]);
 238
 239                 for (i = 0; i < index; i++)
 240                         rt2x00usb_kick_tx_entry(&queue->entries[i]);
 241         }
 242 }
 243 EXPORT_SYMBOL_GPL(rt2x00usb_kick_tx_queue);
 244
 245 /*
 246  * RX data handlers.
 247  */
 248 static void rt2x00usb_interrupt_rxdone(struct urb *urb)
 249 {
 250         struct queue_entry *entry = (struct queue_entry *)urb->context;
 251         struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
 252         struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
 253         u8 rxd[32];
 254
 255         if (!test_bit(DEVICE_ENABLED_RADIO, &rt2x00dev->flags) ||
 256             !test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
 257                 return;
 258
 259         /*
 260          * Check if the received data is simply too small
 261          * to be actually valid, or if the urb is signaling
 262          * a problem.
 263          */
 264         if (urb->actual_length < entry->queue->desc_size || urb->status) {
 265                 __set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
 266                 usb_submit_urb(urb, GFP_ATOMIC);
 267                 return;
 268         }
 269
 270         /*
 271          * Fill in desc fields of the skb descriptor
 272          */
 273         skbdesc->desc = rxd;
 274         skbdesc->desc_len = entry->queue->desc_size;
 275
 276         /*
 277          * Send the frame to rt2x00lib for further processing.
 278          */
 279         rt2x00lib_rxdone(rt2x00dev, entry);
 280 }
 281
 282 /*
 283  * Radio handlers
 284  */
 285 void rt2x00usb_disable_radio(struct rt2x00_dev *rt2x00dev)
 286 {
 287         struct queue_entry_priv_usb *entry_priv;
 288         struct queue_entry_priv_usb_bcn *bcn_priv;
 289         unsigned int i;
 290
 291         rt2x00usb_vendor_request_sw(rt2x00dev, USB_RX_CONTROL, 0, 0,
 292                                     REGISTER_TIMEOUT);
 293
 294         /*
 295          * Cancel all queues.
 296          */
 297         for (i = 0; i < rt2x00dev->rx->limit; i++) {
 298                 entry_priv = rt2x00dev->rx->entries[i].priv_data;
 299                 usb_kill_urb(entry_priv->urb);
 300         }
 301
 302         /*
 303          * Kill guardian urb (if required by driver).
 304          */
 305         if (!test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
 306                 return;
 307
 308         for (i = 0; i < rt2x00dev->bcn->limit; i++) {
 309                 bcn_priv = rt2x00dev->bcn->entries[i].priv_data;
 310                 if (bcn_priv->guardian_urb)
 311                         usb_kill_urb(bcn_priv->guardian_urb);
 312         }
 313 }
 314 EXPORT_SYMBOL_GPL(rt2x00usb_disable_radio);
 315
 316 /*
 317  * Device initialization handlers.
 318  */
 319 void rt2x00usb_init_rxentry(struct rt2x00_dev *rt2x00dev,
 320                             struct queue_entry *entry)
 321 {
 322         struct usb_device *usb_dev =
 323                 interface_to_usbdev(to_usb_interface(rt2x00dev->dev));
 324         struct queue_entry_priv_usb *entry_priv = entry->priv_data;
 325
 326         usb_fill_bulk_urb(entry_priv->urb, usb_dev,
 327                           usb_rcvbulkpipe(usb_dev, 1),
 328                           entry->skb->data, entry->skb->len,
 329                           rt2x00usb_interrupt_rxdone, entry);
 330
 331         __set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
 332         usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
 333 }
 334 EXPORT_SYMBOL_GPL(rt2x00usb_init_rxentry);
 335
 336 void rt2x00usb_init_txentry(struct rt2x00_dev *rt2x00dev,
 337                             struct queue_entry *entry)
 338 {
 339         entry->flags = 0;
 340 }
 341 EXPORT_SYMBOL_GPL(rt2x00usb_init_txentry);
 342
 343 static int rt2x00usb_alloc_urb(struct rt2x00_dev *rt2x00dev,
 344                                struct data_queue *queue)
 345 {
 346         struct queue_entry_priv_usb *entry_priv;
 347         struct queue_entry_priv_usb_bcn *bcn_priv;
 348         unsigned int i;
 349
 350         for (i = 0; i < queue->limit; i++) {
 351                 entry_priv = queue->entries[i].priv_data;
 352                 entry_priv->urb = usb_alloc_urb(0, GFP_KERNEL);
 353                 if (!entry_priv->urb)
 354                         return -ENOMEM;
 355         }
 356
 357         /*
 358          * If this is not the beacon queue or
 359          * no guardian byte was required for the beacon,
 360          * then we are done.
 361          */
 362         if (rt2x00dev->bcn != queue ||
 363             !test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
 364                 return 0;
 365
 366         for (i = 0; i < queue->limit; i++) {
 367                 bcn_priv = queue->entries[i].priv_data;
 368                 bcn_priv->guardian_urb = usb_alloc_urb(0, GFP_KERNEL);
 369                 if (!bcn_priv->guardian_urb)
 370                         return -ENOMEM;
 371         }
 372
 373         return 0;
 374 }
 375
 376 static void rt2x00usb_free_urb(struct rt2x00_dev *rt2x00dev,
 377                                struct data_queue *queue)
 378 {
 379         struct queue_entry_priv_usb *entry_priv;
 380         struct queue_entry_priv_usb_bcn *bcn_priv;
 381         unsigned int i;
 382
 383         if (!queue->entries)
 384                 return;
 385
 386         for (i = 0; i < queue->limit; i++) {
 387                 entry_priv = queue->entries[i].priv_data;
 388                 usb_kill_urb(entry_priv->urb);
 389                 usb_free_urb(entry_priv->urb);
 390         }
 391
 392         /*
 393          * If this is not the beacon queue or
 394          * no guardian byte was required for the beacon,
 395          * then we are done.
 396          */
 397         if (rt2x00dev->bcn != queue ||
 398             !test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
 399                 return;
 400
 401         for (i = 0; i < queue->limit; i++) {
 402                 bcn_priv = queue->entries[i].priv_data;
 403                 usb_kill_urb(bcn_priv->guardian_urb);
 404                 usb_free_urb(bcn_priv->guardian_urb);
 405         }
 406 }
 407
 408 int rt2x00usb_initialize(struct rt2x00_dev *rt2x00dev)
 409 {
 410         struct data_queue *queue;
 411         int status;
 412
 413         /*
 414          * Allocate DMA
 415          */
 416         queue_for_each(rt2x00dev, queue) {
 417                 status = rt2x00usb_alloc_urb(rt2x00dev, queue);
 418                 if (status)
 419                         goto exit;
 420         }
 421
 422         return 0;
 423
 424 exit:
 425         rt2x00usb_uninitialize(rt2x00dev);
 426
 427         return status;
 428 }
 429 EXPORT_SYMBOL_GPL(rt2x00usb_initialize);
 430
 431 void rt2x00usb_uninitialize(struct rt2x00_dev *rt2x00dev)
 432 {
 433         struct data_queue *queue;
 434
 435         queue_for_each(rt2x00dev, queue)
 436                 rt2x00usb_free_urb(rt2x00dev, queue);
 437 }
 438 EXPORT_SYMBOL_GPL(rt2x00usb_uninitialize);
 439
 440 /*
 441  * USB driver handlers.
 442  */
 443 static void rt2x00usb_free_reg(struct rt2x00_dev *rt2x00dev)
 444 {
 445         kfree(rt2x00dev->rf);
 446         rt2x00dev->rf = NULL;
 447
 448         kfree(rt2x00dev->eeprom);
 449         rt2x00dev->eeprom = NULL;
 450
 451         kfree(rt2x00dev->csr.cache);
 452         rt2x00dev->csr.cache = NULL;
 453 }
 454
 455 static int rt2x00usb_alloc_reg(struct rt2x00_dev *rt2x00dev)
 456 {
 457         rt2x00dev->csr.cache = kzalloc(CSR_CACHE_SIZE, GFP_KERNEL);
 458         if (!rt2x00dev->csr.cache)
 459                 goto exit;
 460
 461         rt2x00dev->eeprom = kzalloc(rt2x00dev->ops->eeprom_size, GFP_KERNEL);
 462         if (!rt2x00dev->eeprom)
 463                 goto exit;
 464
 465         rt2x00dev->rf = kzalloc(rt2x00dev->ops->rf_size, GFP_KERNEL);
 466         if (!rt2x00dev->rf)
 467                 goto exit;
 468
 469         return 0;
 470
 471 exit:
 472         ERROR_PROBE("Failed to allocate registers.\n");
 473
 474         rt2x00usb_free_reg(rt2x00dev);
 475
 476         return -ENOMEM;
 477 }
 478
 479 int rt2x00usb_probe(struct usb_interface *usb_intf,
 480                     const struct usb_device_id *id)
 481 {
 482         struct usb_device *usb_dev = interface_to_usbdev(usb_intf);
 483         struct rt2x00_ops *ops = (struct rt2x00_ops *)id->driver_info;
 484         struct ieee80211_hw *hw;
 485         struct rt2x00_dev *rt2x00dev;
 486         int retval;
 487
 488         usb_dev = usb_get_dev(usb_dev);
 489
 490         hw = ieee80211_alloc_hw(sizeof(struct rt2x00_dev), ops->hw);
 491         if (!hw) {
 492                 ERROR_PROBE("Failed to allocate hardware.\n");
 493                 retval = -ENOMEM;
 494                 goto exit_put_device;
 495         }
 496
 497         usb_set_intfdata(usb_intf, hw);
 498
 499         rt2x00dev = hw->priv;
 500         rt2x00dev->dev = &usb_intf->dev;
 501         rt2x00dev->ops = ops;
 502         rt2x00dev->hw = hw;
 503         mutex_init(&rt2x00dev->usb_cache_mutex);
 504
 505         rt2x00dev->usb_maxpacket =
 506             usb_maxpacket(usb_dev, usb_sndbulkpipe(usb_dev, 1), 1);
 507         if (!rt2x00dev->usb_maxpacket)
 508                 rt2x00dev->usb_maxpacket = 1;
 509
 510         retval = rt2x00usb_alloc_reg(rt2x00dev);
 511         if (retval)
 512                 goto exit_free_device;
 513
 514         retval = rt2x00lib_probe_dev(rt2x00dev);
 515         if (retval)
 516                 goto exit_free_reg;
 517
 518         return 0;
 519
 520 exit_free_reg:
 521         rt2x00usb_free_reg(rt2x00dev);
 522
 523 exit_free_device:
 524         ieee80211_free_hw(hw);
 525
 526 exit_put_device:
 527         usb_put_dev(usb_dev);
 528
 529         usb_set_intfdata(usb_intf, NULL);
 530
 531         return retval;
 532 }
 533 EXPORT_SYMBOL_GPL(rt2x00usb_probe);
 534
 535 void rt2x00usb_disconnect(struct usb_interface *usb_intf)
 536 {
 537         struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
 538         struct rt2x00_dev *rt2x00dev = hw->priv;
 539
 540         /*
 541          * Free all allocated data.
 542          */
 543         rt2x00lib_remove_dev(rt2x00dev);
 544         rt2x00usb_free_reg(rt2x00dev);
 545         ieee80211_free_hw(hw);
 546
 547         /*
 548          * Free the USB device data.
 549          */
 550         usb_set_intfdata(usb_intf, NULL);
 551         usb_put_dev(interface_to_usbdev(usb_intf));
 552 }
 553 EXPORT_SYMBOL_GPL(rt2x00usb_disconnect);
 554
 555 #ifdef CONFIG_PM
 556 int rt2x00usb_suspend(struct usb_interface *usb_intf, pm_message_t state)
 557 {
 558         struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
 559         struct rt2x00_dev *rt2x00dev = hw->priv;
 560         int retval;
 561
 562         retval = rt2x00lib_suspend(rt2x00dev, state);
 563         if (retval)
 564                 return retval;
 565
 566         rt2x00usb_free_reg(rt2x00dev);
 567
 568         /*
 569          * Decrease usbdev refcount.
 570          */
 571         usb_put_dev(interface_to_usbdev(usb_intf));
 572
 573         return 0;
 574 }
 575 EXPORT_SYMBOL_GPL(rt2x00usb_suspend);
 576
 577 int rt2x00usb_resume(struct usb_interface *usb_intf)
 578 {
 579         struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
 580         struct rt2x00_dev *rt2x00dev = hw->priv;
 581         int retval;
 582
 583         usb_get_dev(interface_to_usbdev(usb_intf));
 584
 585         retval = rt2x00usb_alloc_reg(rt2x00dev);
 586         if (retval)
 587                 return retval;
 588
 589         retval = rt2x00lib_resume(rt2x00dev);
 590         if (retval)
 591                 goto exit_free_reg;
 592
 593         return 0;
 594
 595 exit_free_reg:
 596         rt2x00usb_free_reg(rt2x00dev);
 597
 598         return retval;
 599 }
 600 EXPORT_SYMBOL_GPL(rt2x00usb_resume);
 601 #endif /* CONFIG_PM */
 602
 603 /*
 604  * rt2x00usb module information.
 605  */
 606 MODULE_AUTHOR(DRV_PROJECT);
 607 MODULE_VERSION(DRV_VERSION);
 608 MODULE_DESCRIPTION("rt2x00 usb library");
 609 MODULE_LICENSE("GPL");