2 Copyright (C) 2010 Willow Garage <http://www.willowgarage.com>
3 Copyright (C) 2004 - 2010 Ivo van Doorn <IvDoorn@gmail.com>
4 <http://rt2x00.serialmonkey.com>
6 This program is free software; you can redistribute it and/or modify
7 it under the terms of the GNU General Public License as published by
8 the Free Software Foundation; either version 2 of the License, or
9 (at your option) any later version.
11 This program is distributed in the hope that it will be useful,
12 but WITHOUT ANY WARRANTY; without even the implied warranty of
13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 GNU General Public License for more details.
16 You should have received a copy of the GNU General Public License
17 along with this program; if not, write to the
18 Free Software Foundation, Inc.,
19 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
24 Abstract: rt2x00 generic usb device routines.
27 #include <linux/kernel.h>
28 #include <linux/module.h>
29 #include <linux/slab.h>
30 #include <linux/usb.h>
31 #include <linux/bug.h>
34 #include "rt2x00usb.h"
37 * Interfacing with the HW.
39 int rt2x00usb_vendor_request(struct rt2x00_dev
*rt2x00dev
,
40 const u8 request
, const u8 requesttype
,
41 const u16 offset
, const u16 value
,
42 void *buffer
, const u16 buffer_length
,
45 struct usb_device
*usb_dev
= to_usb_device_intf(rt2x00dev
->dev
);
49 (requesttype
== USB_VENDOR_REQUEST_IN
) ?
50 usb_rcvctrlpipe(usb_dev
, 0) : usb_sndctrlpipe(usb_dev
, 0);
52 if (!test_bit(DEVICE_STATE_PRESENT
, &rt2x00dev
->flags
))
55 for (i
= 0; i
< REGISTER_BUSY_COUNT
; i
++) {
56 status
= usb_control_msg(usb_dev
, pipe
, request
, requesttype
,
57 value
, offset
, buffer
, buffer_length
,
64 * -ENODEV: Device has disappeared, no point continuing.
65 * All other errors: Try again.
67 else if (status
== -ENODEV
) {
68 clear_bit(DEVICE_STATE_PRESENT
, &rt2x00dev
->flags
);
74 "Vendor Request 0x%02x failed for offset 0x%04x with error %d.\n",
75 request
, offset
, status
);
79 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request
);
81 int rt2x00usb_vendor_req_buff_lock(struct rt2x00_dev
*rt2x00dev
,
82 const u8 request
, const u8 requesttype
,
83 const u16 offset
, void *buffer
,
84 const u16 buffer_length
, const int timeout
)
88 BUG_ON(!mutex_is_locked(&rt2x00dev
->csr_mutex
));
91 * Check for Cache availability.
93 if (unlikely(!rt2x00dev
->csr
.cache
|| buffer_length
> CSR_CACHE_SIZE
)) {
94 ERROR(rt2x00dev
, "CSR cache not available.\n");
98 if (requesttype
== USB_VENDOR_REQUEST_OUT
)
99 memcpy(rt2x00dev
->csr
.cache
, buffer
, buffer_length
);
101 status
= rt2x00usb_vendor_request(rt2x00dev
, request
, requesttype
,
102 offset
, 0, rt2x00dev
->csr
.cache
,
103 buffer_length
, timeout
);
105 if (!status
&& requesttype
== USB_VENDOR_REQUEST_IN
)
106 memcpy(buffer
, rt2x00dev
->csr
.cache
, buffer_length
);
110 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_req_buff_lock
);
112 int rt2x00usb_vendor_request_buff(struct rt2x00_dev
*rt2x00dev
,
113 const u8 request
, const u8 requesttype
,
114 const u16 offset
, void *buffer
,
115 const u16 buffer_length
, const int timeout
)
121 mutex_lock(&rt2x00dev
->csr_mutex
);
126 while (len
&& !status
) {
127 bsize
= min_t(u16
, CSR_CACHE_SIZE
, len
);
128 status
= rt2x00usb_vendor_req_buff_lock(rt2x00dev
, request
,
129 requesttype
, off
, tb
,
137 mutex_unlock(&rt2x00dev
->csr_mutex
);
141 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_buff
);
143 int rt2x00usb_regbusy_read(struct rt2x00_dev
*rt2x00dev
,
144 const unsigned int offset
,
145 const struct rt2x00_field32 field
,
150 if (!test_bit(DEVICE_STATE_PRESENT
, &rt2x00dev
->flags
))
153 for (i
= 0; i
< REGISTER_BUSY_COUNT
; i
++) {
154 rt2x00usb_register_read_lock(rt2x00dev
, offset
, reg
);
155 if (!rt2x00_get_field32(*reg
, field
))
157 udelay(REGISTER_BUSY_DELAY
);
160 ERROR(rt2x00dev
, "Indirect register access failed: "
161 "offset=0x%.08x, value=0x%.08x\n", offset
, *reg
);
166 EXPORT_SYMBOL_GPL(rt2x00usb_regbusy_read
);
169 struct rt2x00_async_read_data
{
171 struct usb_ctrlrequest cr
;
172 struct rt2x00_dev
*rt2x00dev
;
173 bool (*callback
)(struct rt2x00_dev
*, int, u32
);
176 static void rt2x00usb_register_read_async_cb(struct urb
*urb
)
178 struct rt2x00_async_read_data
*rd
= urb
->context
;
179 if (rd
->callback(rd
->rt2x00dev
, urb
->status
, le32_to_cpu(rd
->reg
))) {
180 if (usb_submit_urb(urb
, GFP_ATOMIC
) < 0)
186 void rt2x00usb_register_read_async(struct rt2x00_dev
*rt2x00dev
,
187 const unsigned int offset
,
188 bool (*callback
)(struct rt2x00_dev
*, int, u32
))
190 struct usb_device
*usb_dev
= to_usb_device_intf(rt2x00dev
->dev
);
192 struct rt2x00_async_read_data
*rd
;
194 rd
= kmalloc(sizeof(*rd
), GFP_ATOMIC
);
198 urb
= usb_alloc_urb(0, GFP_ATOMIC
);
204 rd
->rt2x00dev
= rt2x00dev
;
205 rd
->callback
= callback
;
206 rd
->cr
.bRequestType
= USB_VENDOR_REQUEST_IN
;
207 rd
->cr
.bRequest
= USB_MULTI_READ
;
209 rd
->cr
.wIndex
= cpu_to_le16(offset
);
210 rd
->cr
.wLength
= cpu_to_le16(sizeof(u32
));
212 usb_fill_control_urb(urb
, usb_dev
, usb_rcvctrlpipe(usb_dev
, 0),
213 (unsigned char *)(&rd
->cr
), &rd
->reg
, sizeof(rd
->reg
),
214 rt2x00usb_register_read_async_cb
, rd
);
215 if (usb_submit_urb(urb
, GFP_ATOMIC
) < 0)
219 EXPORT_SYMBOL_GPL(rt2x00usb_register_read_async
);
224 static void rt2x00usb_work_txdone_entry(struct queue_entry
*entry
)
227 * If the transfer to hardware succeeded, it does not mean the
228 * frame was send out correctly. It only means the frame
229 * was successfully pushed to the hardware, we have no
230 * way to determine the transmission status right now.
231 * (Only indirectly by looking at the failed TX counters
234 if (test_bit(ENTRY_DATA_IO_FAILED
, &entry
->flags
))
235 rt2x00lib_txdone_noinfo(entry
, TXDONE_FAILURE
);
237 rt2x00lib_txdone_noinfo(entry
, TXDONE_UNKNOWN
);
240 static void rt2x00usb_work_txdone(struct work_struct
*work
)
242 struct rt2x00_dev
*rt2x00dev
=
243 container_of(work
, struct rt2x00_dev
, txdone_work
);
244 struct data_queue
*queue
;
245 struct queue_entry
*entry
;
247 tx_queue_for_each(rt2x00dev
, queue
) {
248 while (!rt2x00queue_empty(queue
)) {
249 entry
= rt2x00queue_get_entry(queue
, Q_INDEX_DONE
);
251 if (test_bit(ENTRY_OWNER_DEVICE_DATA
, &entry
->flags
) ||
252 !test_bit(ENTRY_DATA_STATUS_PENDING
, &entry
->flags
))
255 rt2x00usb_work_txdone_entry(entry
);
260 static void rt2x00usb_interrupt_txdone(struct urb
*urb
)
262 struct queue_entry
*entry
= (struct queue_entry
*)urb
->context
;
263 struct rt2x00_dev
*rt2x00dev
= entry
->queue
->rt2x00dev
;
265 if (!test_bit(ENTRY_OWNER_DEVICE_DATA
, &entry
->flags
))
268 * Check if the frame was correctly uploaded
271 set_bit(ENTRY_DATA_IO_FAILED
, &entry
->flags
);
273 * Report the frame as DMA done
275 rt2x00lib_dmadone(entry
);
277 if (rt2x00dev
->ops
->lib
->tx_dma_done
)
278 rt2x00dev
->ops
->lib
->tx_dma_done(entry
);
280 * Schedule the delayed work for reading the TX status
283 if (!test_bit(REQUIRE_TXSTATUS_FIFO
, &rt2x00dev
->cap_flags
) ||
284 !kfifo_is_empty(&rt2x00dev
->txstatus_fifo
))
285 queue_work(rt2x00dev
->workqueue
, &rt2x00dev
->txdone_work
);
288 static bool rt2x00usb_kick_tx_entry(struct queue_entry
*entry
, void* data
)
290 struct rt2x00_dev
*rt2x00dev
= entry
->queue
->rt2x00dev
;
291 struct usb_device
*usb_dev
= to_usb_device_intf(rt2x00dev
->dev
);
292 struct queue_entry_priv_usb
*entry_priv
= entry
->priv_data
;
296 if (!test_and_clear_bit(ENTRY_DATA_PENDING
, &entry
->flags
) ||
297 test_bit(ENTRY_DATA_STATUS_PENDING
, &entry
->flags
))
301 * USB devices cannot blindly pass the skb->len as the
302 * length of the data to usb_fill_bulk_urb. Pass the skb
303 * to the driver to determine what the length should be.
305 length
= rt2x00dev
->ops
->lib
->get_tx_data_len(entry
);
307 usb_fill_bulk_urb(entry_priv
->urb
, usb_dev
,
308 usb_sndbulkpipe(usb_dev
, entry
->queue
->usb_endpoint
),
309 entry
->skb
->data
, length
,
310 rt2x00usb_interrupt_txdone
, entry
);
312 status
= usb_submit_urb(entry_priv
->urb
, GFP_ATOMIC
);
314 if (status
== -ENODEV
)
315 clear_bit(DEVICE_STATE_PRESENT
, &rt2x00dev
->flags
);
316 set_bit(ENTRY_DATA_IO_FAILED
, &entry
->flags
);
317 rt2x00lib_dmadone(entry
);
326 static void rt2x00usb_work_rxdone(struct work_struct
*work
)
328 struct rt2x00_dev
*rt2x00dev
=
329 container_of(work
, struct rt2x00_dev
, rxdone_work
);
330 struct queue_entry
*entry
;
331 struct skb_frame_desc
*skbdesc
;
334 while (!rt2x00queue_empty(rt2x00dev
->rx
)) {
335 entry
= rt2x00queue_get_entry(rt2x00dev
->rx
, Q_INDEX_DONE
);
337 if (test_bit(ENTRY_OWNER_DEVICE_DATA
, &entry
->flags
) ||
338 !test_bit(ENTRY_DATA_STATUS_PENDING
, &entry
->flags
))
342 * Fill in desc fields of the skb descriptor
344 skbdesc
= get_skb_frame_desc(entry
->skb
);
346 skbdesc
->desc_len
= entry
->queue
->desc_size
;
349 * Send the frame to rt2x00lib for further processing.
351 rt2x00lib_rxdone(entry
);
355 static void rt2x00usb_interrupt_rxdone(struct urb
*urb
)
357 struct queue_entry
*entry
= (struct queue_entry
*)urb
->context
;
358 struct rt2x00_dev
*rt2x00dev
= entry
->queue
->rt2x00dev
;
360 if (!test_and_clear_bit(ENTRY_OWNER_DEVICE_DATA
, &entry
->flags
))
364 * Report the frame as DMA done
366 rt2x00lib_dmadone(entry
);
369 * Check if the received data is simply too small
370 * to be actually valid, or if the urb is signaling
373 if (urb
->actual_length
< entry
->queue
->desc_size
|| urb
->status
)
374 set_bit(ENTRY_DATA_IO_FAILED
, &entry
->flags
);
377 * Schedule the delayed work for reading the RX status
380 queue_work(rt2x00dev
->workqueue
, &rt2x00dev
->rxdone_work
);
383 static bool rt2x00usb_kick_rx_entry(struct queue_entry
*entry
, void* data
)
385 struct rt2x00_dev
*rt2x00dev
= entry
->queue
->rt2x00dev
;
386 struct usb_device
*usb_dev
= to_usb_device_intf(rt2x00dev
->dev
);
387 struct queue_entry_priv_usb
*entry_priv
= entry
->priv_data
;
390 if (test_and_set_bit(ENTRY_OWNER_DEVICE_DATA
, &entry
->flags
) ||
391 test_bit(ENTRY_DATA_STATUS_PENDING
, &entry
->flags
))
394 rt2x00lib_dmastart(entry
);
396 usb_fill_bulk_urb(entry_priv
->urb
, usb_dev
,
397 usb_rcvbulkpipe(usb_dev
, entry
->queue
->usb_endpoint
),
398 entry
->skb
->data
, entry
->skb
->len
,
399 rt2x00usb_interrupt_rxdone
, entry
);
401 status
= usb_submit_urb(entry_priv
->urb
, GFP_ATOMIC
);
403 if (status
== -ENODEV
)
404 clear_bit(DEVICE_STATE_PRESENT
, &rt2x00dev
->flags
);
405 set_bit(ENTRY_DATA_IO_FAILED
, &entry
->flags
);
406 rt2x00lib_dmadone(entry
);
412 void rt2x00usb_kick_queue(struct data_queue
*queue
)
414 switch (queue
->qid
) {
419 if (!rt2x00queue_empty(queue
))
420 rt2x00queue_for_each_entry(queue
,
424 rt2x00usb_kick_tx_entry
);
427 if (!rt2x00queue_full(queue
))
428 rt2x00queue_for_each_entry(queue
,
432 rt2x00usb_kick_rx_entry
);
438 EXPORT_SYMBOL_GPL(rt2x00usb_kick_queue
);
440 static bool rt2x00usb_flush_entry(struct queue_entry
*entry
, void* data
)
442 struct rt2x00_dev
*rt2x00dev
= entry
->queue
->rt2x00dev
;
443 struct queue_entry_priv_usb
*entry_priv
= entry
->priv_data
;
444 struct queue_entry_priv_usb_bcn
*bcn_priv
= entry
->priv_data
;
446 if (!test_bit(ENTRY_OWNER_DEVICE_DATA
, &entry
->flags
))
449 usb_kill_urb(entry_priv
->urb
);
452 * Kill guardian urb (if required by driver).
454 if ((entry
->queue
->qid
== QID_BEACON
) &&
455 (test_bit(REQUIRE_BEACON_GUARD
, &rt2x00dev
->cap_flags
)))
456 usb_kill_urb(bcn_priv
->guardian_urb
);
461 void rt2x00usb_flush_queue(struct data_queue
*queue
, bool drop
)
463 struct work_struct
*completion
;
467 rt2x00queue_for_each_entry(queue
, Q_INDEX_DONE
, Q_INDEX
, NULL
,
468 rt2x00usb_flush_entry
);
471 * Obtain the queue completion handler
473 switch (queue
->qid
) {
478 completion
= &queue
->rt2x00dev
->txdone_work
;
481 completion
= &queue
->rt2x00dev
->rxdone_work
;
487 for (i
= 0; i
< 10; i
++) {
489 * Check if the driver is already done, otherwise we
490 * have to sleep a little while to give the driver/hw
491 * the oppurtunity to complete interrupt process itself.
493 if (rt2x00queue_empty(queue
))
497 * Schedule the completion handler manually, when this
498 * worker function runs, it should cleanup the queue.
500 queue_work(queue
->rt2x00dev
->workqueue
, completion
);
503 * Wait for a little while to give the driver
504 * the oppurtunity to recover itself.
509 EXPORT_SYMBOL_GPL(rt2x00usb_flush_queue
);
511 static void rt2x00usb_watchdog_tx_dma(struct data_queue
*queue
)
513 WARNING(queue
->rt2x00dev
, "TX queue %d DMA timed out,"
514 " invoke forced forced reset\n", queue
->qid
);
516 rt2x00queue_flush_queue(queue
, true);
519 static void rt2x00usb_watchdog_tx_status(struct data_queue
*queue
)
521 WARNING(queue
->rt2x00dev
, "TX queue %d status timed out,"
522 " invoke forced tx handler\n", queue
->qid
);
524 queue_work(queue
->rt2x00dev
->workqueue
, &queue
->rt2x00dev
->txdone_work
);
527 static int rt2x00usb_status_timeout(struct data_queue
*queue
)
529 struct queue_entry
*entry
;
531 entry
= rt2x00queue_get_entry(queue
, Q_INDEX_DONE
);
532 return rt2x00queue_status_timeout(entry
);
535 static int rt2x00usb_dma_timeout(struct data_queue
*queue
)
537 struct queue_entry
*entry
;
539 entry
= rt2x00queue_get_entry(queue
, Q_INDEX_DMA_DONE
);
540 return rt2x00queue_dma_timeout(entry
);
543 void rt2x00usb_watchdog(struct rt2x00_dev
*rt2x00dev
)
545 struct data_queue
*queue
;
547 tx_queue_for_each(rt2x00dev
, queue
) {
548 if (!rt2x00queue_empty(queue
)) {
549 if (rt2x00usb_dma_timeout(queue
))
550 rt2x00usb_watchdog_tx_dma(queue
);
551 if (rt2x00usb_status_timeout(queue
))
552 rt2x00usb_watchdog_tx_status(queue
);
556 EXPORT_SYMBOL_GPL(rt2x00usb_watchdog
);
561 void rt2x00usb_disable_radio(struct rt2x00_dev
*rt2x00dev
)
563 rt2x00usb_vendor_request_sw(rt2x00dev
, USB_RX_CONTROL
, 0, 0,
566 EXPORT_SYMBOL_GPL(rt2x00usb_disable_radio
);
569 * Device initialization handlers.
571 void rt2x00usb_clear_entry(struct queue_entry
*entry
)
575 if (entry
->queue
->qid
== QID_RX
)
576 rt2x00usb_kick_rx_entry(entry
, NULL
);
578 EXPORT_SYMBOL_GPL(rt2x00usb_clear_entry
);
580 static void rt2x00usb_assign_endpoint(struct data_queue
*queue
,
581 struct usb_endpoint_descriptor
*ep_desc
)
583 struct usb_device
*usb_dev
= to_usb_device_intf(queue
->rt2x00dev
->dev
);
586 queue
->usb_endpoint
= usb_endpoint_num(ep_desc
);
588 if (queue
->qid
== QID_RX
) {
589 pipe
= usb_rcvbulkpipe(usb_dev
, queue
->usb_endpoint
);
590 queue
->usb_maxpacket
= usb_maxpacket(usb_dev
, pipe
, 0);
592 pipe
= usb_sndbulkpipe(usb_dev
, queue
->usb_endpoint
);
593 queue
->usb_maxpacket
= usb_maxpacket(usb_dev
, pipe
, 1);
596 if (!queue
->usb_maxpacket
)
597 queue
->usb_maxpacket
= 1;
600 static int rt2x00usb_find_endpoints(struct rt2x00_dev
*rt2x00dev
)
602 struct usb_interface
*intf
= to_usb_interface(rt2x00dev
->dev
);
603 struct usb_host_interface
*intf_desc
= intf
->cur_altsetting
;
604 struct usb_endpoint_descriptor
*ep_desc
;
605 struct data_queue
*queue
= rt2x00dev
->tx
;
606 struct usb_endpoint_descriptor
*tx_ep_desc
= NULL
;
610 * Walk through all available endpoints to search for "bulk in"
611 * and "bulk out" endpoints. When we find such endpoints collect
612 * the information we need from the descriptor and assign it
615 for (i
= 0; i
< intf_desc
->desc
.bNumEndpoints
; i
++) {
616 ep_desc
= &intf_desc
->endpoint
[i
].desc
;
618 if (usb_endpoint_is_bulk_in(ep_desc
)) {
619 rt2x00usb_assign_endpoint(rt2x00dev
->rx
, ep_desc
);
620 } else if (usb_endpoint_is_bulk_out(ep_desc
) &&
621 (queue
!= queue_end(rt2x00dev
))) {
622 rt2x00usb_assign_endpoint(queue
, ep_desc
);
623 queue
= queue_next(queue
);
625 tx_ep_desc
= ep_desc
;
630 * At least 1 endpoint for RX and 1 endpoint for TX must be available.
632 if (!rt2x00dev
->rx
->usb_endpoint
|| !rt2x00dev
->tx
->usb_endpoint
) {
633 ERROR(rt2x00dev
, "Bulk-in/Bulk-out endpoints not found\n");
638 * It might be possible not all queues have a dedicated endpoint.
639 * Loop through all TX queues and copy the endpoint information
640 * which we have gathered from already assigned endpoints.
642 txall_queue_for_each(rt2x00dev
, queue
) {
643 if (!queue
->usb_endpoint
)
644 rt2x00usb_assign_endpoint(queue
, tx_ep_desc
);
650 static int rt2x00usb_alloc_entries(struct data_queue
*queue
)
652 struct rt2x00_dev
*rt2x00dev
= queue
->rt2x00dev
;
653 struct queue_entry_priv_usb
*entry_priv
;
654 struct queue_entry_priv_usb_bcn
*bcn_priv
;
657 for (i
= 0; i
< queue
->limit
; i
++) {
658 entry_priv
= queue
->entries
[i
].priv_data
;
659 entry_priv
->urb
= usb_alloc_urb(0, GFP_KERNEL
);
660 if (!entry_priv
->urb
)
665 * If this is not the beacon queue or
666 * no guardian byte was required for the beacon,
669 if (queue
->qid
!= QID_BEACON
||
670 !test_bit(REQUIRE_BEACON_GUARD
, &rt2x00dev
->cap_flags
))
673 for (i
= 0; i
< queue
->limit
; i
++) {
674 bcn_priv
= queue
->entries
[i
].priv_data
;
675 bcn_priv
->guardian_urb
= usb_alloc_urb(0, GFP_KERNEL
);
676 if (!bcn_priv
->guardian_urb
)
683 static void rt2x00usb_free_entries(struct data_queue
*queue
)
685 struct rt2x00_dev
*rt2x00dev
= queue
->rt2x00dev
;
686 struct queue_entry_priv_usb
*entry_priv
;
687 struct queue_entry_priv_usb_bcn
*bcn_priv
;
693 for (i
= 0; i
< queue
->limit
; i
++) {
694 entry_priv
= queue
->entries
[i
].priv_data
;
695 usb_kill_urb(entry_priv
->urb
);
696 usb_free_urb(entry_priv
->urb
);
700 * If this is not the beacon queue or
701 * no guardian byte was required for the beacon,
704 if (queue
->qid
!= QID_BEACON
||
705 !test_bit(REQUIRE_BEACON_GUARD
, &rt2x00dev
->cap_flags
))
708 for (i
= 0; i
< queue
->limit
; i
++) {
709 bcn_priv
= queue
->entries
[i
].priv_data
;
710 usb_kill_urb(bcn_priv
->guardian_urb
);
711 usb_free_urb(bcn_priv
->guardian_urb
);
715 int rt2x00usb_initialize(struct rt2x00_dev
*rt2x00dev
)
717 struct data_queue
*queue
;
721 * Find endpoints for each queue
723 status
= rt2x00usb_find_endpoints(rt2x00dev
);
730 queue_for_each(rt2x00dev
, queue
) {
731 status
= rt2x00usb_alloc_entries(queue
);
739 rt2x00usb_uninitialize(rt2x00dev
);
743 EXPORT_SYMBOL_GPL(rt2x00usb_initialize
);
745 void rt2x00usb_uninitialize(struct rt2x00_dev
*rt2x00dev
)
747 struct data_queue
*queue
;
749 queue_for_each(rt2x00dev
, queue
)
750 rt2x00usb_free_entries(queue
);
752 EXPORT_SYMBOL_GPL(rt2x00usb_uninitialize
);
755 * USB driver handlers.
757 static void rt2x00usb_free_reg(struct rt2x00_dev
*rt2x00dev
)
759 kfree(rt2x00dev
->rf
);
760 rt2x00dev
->rf
= NULL
;
762 kfree(rt2x00dev
->eeprom
);
763 rt2x00dev
->eeprom
= NULL
;
765 kfree(rt2x00dev
->csr
.cache
);
766 rt2x00dev
->csr
.cache
= NULL
;
769 static int rt2x00usb_alloc_reg(struct rt2x00_dev
*rt2x00dev
)
771 rt2x00dev
->csr
.cache
= kzalloc(CSR_CACHE_SIZE
, GFP_KERNEL
);
772 if (!rt2x00dev
->csr
.cache
)
775 rt2x00dev
->eeprom
= kzalloc(rt2x00dev
->ops
->eeprom_size
, GFP_KERNEL
);
776 if (!rt2x00dev
->eeprom
)
779 rt2x00dev
->rf
= kzalloc(rt2x00dev
->ops
->rf_size
, GFP_KERNEL
);
786 ERROR_PROBE("Failed to allocate registers.\n");
788 rt2x00usb_free_reg(rt2x00dev
);
793 int rt2x00usb_probe(struct usb_interface
*usb_intf
,
794 const struct rt2x00_ops
*ops
)
796 struct usb_device
*usb_dev
= interface_to_usbdev(usb_intf
);
797 struct ieee80211_hw
*hw
;
798 struct rt2x00_dev
*rt2x00dev
;
801 usb_dev
= usb_get_dev(usb_dev
);
802 usb_reset_device(usb_dev
);
804 hw
= ieee80211_alloc_hw(sizeof(struct rt2x00_dev
), ops
->hw
);
806 ERROR_PROBE("Failed to allocate hardware.\n");
808 goto exit_put_device
;
811 usb_set_intfdata(usb_intf
, hw
);
813 rt2x00dev
= hw
->priv
;
814 rt2x00dev
->dev
= &usb_intf
->dev
;
815 rt2x00dev
->ops
= ops
;
818 rt2x00_set_chip_intf(rt2x00dev
, RT2X00_CHIP_INTF_USB
);
820 INIT_WORK(&rt2x00dev
->rxdone_work
, rt2x00usb_work_rxdone
);
821 INIT_WORK(&rt2x00dev
->txdone_work
, rt2x00usb_work_txdone
);
822 init_timer(&rt2x00dev
->txstatus_timer
);
824 retval
= rt2x00usb_alloc_reg(rt2x00dev
);
826 goto exit_free_device
;
828 retval
= rt2x00lib_probe_dev(rt2x00dev
);
835 rt2x00usb_free_reg(rt2x00dev
);
838 ieee80211_free_hw(hw
);
841 usb_put_dev(usb_dev
);
843 usb_set_intfdata(usb_intf
, NULL
);
847 EXPORT_SYMBOL_GPL(rt2x00usb_probe
);
849 void rt2x00usb_disconnect(struct usb_interface
*usb_intf
)
851 struct ieee80211_hw
*hw
= usb_get_intfdata(usb_intf
);
852 struct rt2x00_dev
*rt2x00dev
= hw
->priv
;
855 * Free all allocated data.
857 rt2x00lib_remove_dev(rt2x00dev
);
858 rt2x00usb_free_reg(rt2x00dev
);
859 ieee80211_free_hw(hw
);
862 * Free the USB device data.
864 usb_set_intfdata(usb_intf
, NULL
);
865 usb_put_dev(interface_to_usbdev(usb_intf
));
867 EXPORT_SYMBOL_GPL(rt2x00usb_disconnect
);
870 int rt2x00usb_suspend(struct usb_interface
*usb_intf
, pm_message_t state
)
872 struct ieee80211_hw
*hw
= usb_get_intfdata(usb_intf
);
873 struct rt2x00_dev
*rt2x00dev
= hw
->priv
;
876 retval
= rt2x00lib_suspend(rt2x00dev
, state
);
881 * Decrease usbdev refcount.
883 usb_put_dev(interface_to_usbdev(usb_intf
));
887 EXPORT_SYMBOL_GPL(rt2x00usb_suspend
);
889 int rt2x00usb_resume(struct usb_interface
*usb_intf
)
891 struct ieee80211_hw
*hw
= usb_get_intfdata(usb_intf
);
892 struct rt2x00_dev
*rt2x00dev
= hw
->priv
;
894 usb_get_dev(interface_to_usbdev(usb_intf
));
896 return rt2x00lib_resume(rt2x00dev
);
898 EXPORT_SYMBOL_GPL(rt2x00usb_resume
);
899 #endif /* CONFIG_PM */
902 * rt2x00usb module information.
904 MODULE_AUTHOR(DRV_PROJECT
);
905 MODULE_VERSION(DRV_VERSION
);
906 MODULE_DESCRIPTION("rt2x00 usb library");
907 MODULE_LICENSE("GPL");