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, see <http://www.gnu.org/licenses/>.
22 Abstract: rt2x00 generic usb device routines.
25 #include <linux/kernel.h>
26 #include <linux/module.h>
27 #include <linux/slab.h>
28 #include <linux/usb.h>
29 #include <linux/bug.h>
32 #include "rt2x00usb.h"
35 * Interfacing with the HW.
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
,
43 struct usb_device
*usb_dev
= to_usb_device_intf(rt2x00dev
->dev
);
46 (requesttype
== USB_VENDOR_REQUEST_IN
) ?
47 usb_rcvctrlpipe(usb_dev
, 0) : usb_sndctrlpipe(usb_dev
, 0);
48 unsigned long expire
= jiffies
+ msecs_to_jiffies(timeout
);
50 if (!test_bit(DEVICE_STATE_PRESENT
, &rt2x00dev
->flags
))
54 status
= usb_control_msg(usb_dev
, pipe
, request
, requesttype
,
55 value
, offset
, buffer
, buffer_length
,
60 if (status
== -ENODEV
) {
61 /* Device has disappeared. */
62 clear_bit(DEVICE_STATE_PRESENT
, &rt2x00dev
->flags
);
65 } while (time_before(jiffies
, expire
));
68 "Vendor Request 0x%02x failed for offset 0x%04x with error %d\n",
69 request
, offset
, status
);
73 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request
);
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
)
82 BUG_ON(!mutex_is_locked(&rt2x00dev
->csr_mutex
));
85 * Check for Cache availability.
87 if (unlikely(!rt2x00dev
->csr
.cache
|| buffer_length
> CSR_CACHE_SIZE
)) {
88 rt2x00_err(rt2x00dev
, "CSR cache not available\n");
92 if (requesttype
== USB_VENDOR_REQUEST_OUT
)
93 memcpy(rt2x00dev
->csr
.cache
, buffer
, buffer_length
);
95 status
= rt2x00usb_vendor_request(rt2x00dev
, request
, requesttype
,
96 offset
, 0, rt2x00dev
->csr
.cache
,
97 buffer_length
, timeout
);
99 if (!status
&& requesttype
== USB_VENDOR_REQUEST_IN
)
100 memcpy(buffer
, rt2x00dev
->csr
.cache
, buffer_length
);
104 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_req_buff_lock
);
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
)
115 mutex_lock(&rt2x00dev
->csr_mutex
);
120 while (len
&& !status
) {
121 bsize
= min_t(u16
, CSR_CACHE_SIZE
, len
);
122 status
= rt2x00usb_vendor_req_buff_lock(rt2x00dev
, request
,
123 requesttype
, off
, tb
,
124 bsize
, REGISTER_TIMEOUT
);
131 mutex_unlock(&rt2x00dev
->csr_mutex
);
135 EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_buff
);
137 int rt2x00usb_regbusy_read(struct rt2x00_dev
*rt2x00dev
,
138 const unsigned int offset
,
139 const struct rt2x00_field32 field
,
144 if (!test_bit(DEVICE_STATE_PRESENT
, &rt2x00dev
->flags
))
147 for (i
= 0; i
< REGISTER_USB_BUSY_COUNT
; i
++) {
148 rt2x00usb_register_read_lock(rt2x00dev
, offset
, reg
);
149 if (!rt2x00_get_field32(*reg
, field
))
151 udelay(REGISTER_BUSY_DELAY
);
154 rt2x00_err(rt2x00dev
, "Indirect register access failed: offset=0x%.08x, value=0x%.08x\n",
160 EXPORT_SYMBOL_GPL(rt2x00usb_regbusy_read
);
163 struct rt2x00_async_read_data
{
165 struct usb_ctrlrequest cr
;
166 struct rt2x00_dev
*rt2x00dev
;
167 bool (*callback
)(struct rt2x00_dev
*, int, u32
);
170 static void rt2x00usb_register_read_async_cb(struct urb
*urb
)
172 struct rt2x00_async_read_data
*rd
= urb
->context
;
173 if (rd
->callback(rd
->rt2x00dev
, urb
->status
, le32_to_cpu(rd
->reg
))) {
174 usb_anchor_urb(urb
, rd
->rt2x00dev
->anchor
);
175 if (usb_submit_urb(urb
, GFP_ATOMIC
) < 0) {
176 usb_unanchor_urb(urb
);
183 void rt2x00usb_register_read_async(struct rt2x00_dev
*rt2x00dev
,
184 const unsigned int offset
,
185 bool (*callback
)(struct rt2x00_dev
*, int, u32
))
187 struct usb_device
*usb_dev
= to_usb_device_intf(rt2x00dev
->dev
);
189 struct rt2x00_async_read_data
*rd
;
191 rd
= kmalloc(sizeof(*rd
), GFP_ATOMIC
);
195 urb
= usb_alloc_urb(0, GFP_ATOMIC
);
201 rd
->rt2x00dev
= rt2x00dev
;
202 rd
->callback
= callback
;
203 rd
->cr
.bRequestType
= USB_VENDOR_REQUEST_IN
;
204 rd
->cr
.bRequest
= USB_MULTI_READ
;
206 rd
->cr
.wIndex
= cpu_to_le16(offset
);
207 rd
->cr
.wLength
= cpu_to_le16(sizeof(u32
));
209 usb_fill_control_urb(urb
, usb_dev
, usb_rcvctrlpipe(usb_dev
, 0),
210 (unsigned char *)(&rd
->cr
), &rd
->reg
, sizeof(rd
->reg
),
211 rt2x00usb_register_read_async_cb
, rd
);
212 usb_anchor_urb(urb
, rt2x00dev
->anchor
);
213 if (usb_submit_urb(urb
, GFP_ATOMIC
) < 0) {
214 usb_unanchor_urb(urb
);
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 (!rt2x00_has_cap_flag(rt2x00dev
, REQUIRE_TXSTATUS_FIFO
) ||
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 require certain padding at the end of each frame
302 * and urb. Those paddings are not included in skbs. Pass entry
303 * to the driver to determine what the overall length should be.
305 length
= rt2x00dev
->ops
->lib
->get_tx_data_len(entry
);
307 status
= skb_padto(entry
->skb
, length
);
308 if (unlikely(status
)) {
309 /* TODO: report something more appropriate than IO_FAILED. */
310 rt2x00_warn(rt2x00dev
, "TX SKB padding error, out of memory\n");
311 set_bit(ENTRY_DATA_IO_FAILED
, &entry
->flags
);
312 rt2x00lib_dmadone(entry
);
317 usb_fill_bulk_urb(entry_priv
->urb
, usb_dev
,
318 usb_sndbulkpipe(usb_dev
, entry
->queue
->usb_endpoint
),
319 entry
->skb
->data
, length
,
320 rt2x00usb_interrupt_txdone
, entry
);
322 usb_anchor_urb(entry_priv
->urb
, rt2x00dev
->anchor
);
323 status
= usb_submit_urb(entry_priv
->urb
, GFP_ATOMIC
);
325 usb_unanchor_urb(entry_priv
->urb
);
326 if (status
== -ENODEV
)
327 clear_bit(DEVICE_STATE_PRESENT
, &rt2x00dev
->flags
);
328 set_bit(ENTRY_DATA_IO_FAILED
, &entry
->flags
);
329 rt2x00lib_dmadone(entry
);
338 static void rt2x00usb_work_rxdone(struct work_struct
*work
)
340 struct rt2x00_dev
*rt2x00dev
=
341 container_of(work
, struct rt2x00_dev
, rxdone_work
);
342 struct queue_entry
*entry
;
343 struct skb_frame_desc
*skbdesc
;
346 while (!rt2x00queue_empty(rt2x00dev
->rx
)) {
347 entry
= rt2x00queue_get_entry(rt2x00dev
->rx
, Q_INDEX_DONE
);
349 if (test_bit(ENTRY_OWNER_DEVICE_DATA
, &entry
->flags
) ||
350 !test_bit(ENTRY_DATA_STATUS_PENDING
, &entry
->flags
))
354 * Fill in desc fields of the skb descriptor
356 skbdesc
= get_skb_frame_desc(entry
->skb
);
358 skbdesc
->desc_len
= entry
->queue
->desc_size
;
361 * Send the frame to rt2x00lib for further processing.
363 rt2x00lib_rxdone(entry
, GFP_KERNEL
);
367 static void rt2x00usb_interrupt_rxdone(struct urb
*urb
)
369 struct queue_entry
*entry
= (struct queue_entry
*)urb
->context
;
370 struct rt2x00_dev
*rt2x00dev
= entry
->queue
->rt2x00dev
;
372 if (!test_and_clear_bit(ENTRY_OWNER_DEVICE_DATA
, &entry
->flags
))
376 * Report the frame as DMA done
378 rt2x00lib_dmadone(entry
);
381 * Check if the received data is simply too small
382 * to be actually valid, or if the urb is signaling
385 if (urb
->actual_length
< entry
->queue
->desc_size
|| urb
->status
)
386 set_bit(ENTRY_DATA_IO_FAILED
, &entry
->flags
);
389 * Schedule the delayed work for reading the RX status
392 queue_work(rt2x00dev
->workqueue
, &rt2x00dev
->rxdone_work
);
395 static bool rt2x00usb_kick_rx_entry(struct queue_entry
*entry
, void *data
)
397 struct rt2x00_dev
*rt2x00dev
= entry
->queue
->rt2x00dev
;
398 struct usb_device
*usb_dev
= to_usb_device_intf(rt2x00dev
->dev
);
399 struct queue_entry_priv_usb
*entry_priv
= entry
->priv_data
;
402 if (test_and_set_bit(ENTRY_OWNER_DEVICE_DATA
, &entry
->flags
) ||
403 test_bit(ENTRY_DATA_STATUS_PENDING
, &entry
->flags
))
406 rt2x00lib_dmastart(entry
);
408 usb_fill_bulk_urb(entry_priv
->urb
, usb_dev
,
409 usb_rcvbulkpipe(usb_dev
, entry
->queue
->usb_endpoint
),
410 entry
->skb
->data
, entry
->skb
->len
,
411 rt2x00usb_interrupt_rxdone
, entry
);
413 usb_anchor_urb(entry_priv
->urb
, rt2x00dev
->anchor
);
414 status
= usb_submit_urb(entry_priv
->urb
, GFP_ATOMIC
);
416 usb_unanchor_urb(entry_priv
->urb
);
417 if (status
== -ENODEV
)
418 clear_bit(DEVICE_STATE_PRESENT
, &rt2x00dev
->flags
);
419 set_bit(ENTRY_DATA_IO_FAILED
, &entry
->flags
);
420 rt2x00lib_dmadone(entry
);
426 void rt2x00usb_kick_queue(struct data_queue
*queue
)
428 switch (queue
->qid
) {
433 if (!rt2x00queue_empty(queue
))
434 rt2x00queue_for_each_entry(queue
,
438 rt2x00usb_kick_tx_entry
);
441 if (!rt2x00queue_full(queue
))
442 rt2x00queue_for_each_entry(queue
,
446 rt2x00usb_kick_rx_entry
);
452 EXPORT_SYMBOL_GPL(rt2x00usb_kick_queue
);
454 static bool rt2x00usb_flush_entry(struct queue_entry
*entry
, void *data
)
456 struct rt2x00_dev
*rt2x00dev
= entry
->queue
->rt2x00dev
;
457 struct queue_entry_priv_usb
*entry_priv
= entry
->priv_data
;
458 struct queue_entry_priv_usb_bcn
*bcn_priv
= entry
->priv_data
;
460 if (!test_bit(ENTRY_OWNER_DEVICE_DATA
, &entry
->flags
))
463 usb_kill_urb(entry_priv
->urb
);
466 * Kill guardian urb (if required by driver).
468 if ((entry
->queue
->qid
== QID_BEACON
) &&
469 (rt2x00_has_cap_flag(rt2x00dev
, REQUIRE_BEACON_GUARD
)))
470 usb_kill_urb(bcn_priv
->guardian_urb
);
475 void rt2x00usb_flush_queue(struct data_queue
*queue
, bool drop
)
477 struct work_struct
*completion
;
481 rt2x00queue_for_each_entry(queue
, Q_INDEX_DONE
, Q_INDEX
, NULL
,
482 rt2x00usb_flush_entry
);
485 * Obtain the queue completion handler
487 switch (queue
->qid
) {
492 completion
= &queue
->rt2x00dev
->txdone_work
;
495 completion
= &queue
->rt2x00dev
->rxdone_work
;
501 for (i
= 0; i
< 10; i
++) {
503 * Check if the driver is already done, otherwise we
504 * have to sleep a little while to give the driver/hw
505 * the oppurtunity to complete interrupt process itself.
507 if (rt2x00queue_empty(queue
))
511 * Schedule the completion handler manually, when this
512 * worker function runs, it should cleanup the queue.
514 queue_work(queue
->rt2x00dev
->workqueue
, completion
);
517 * Wait for a little while to give the driver
518 * the oppurtunity to recover itself.
523 EXPORT_SYMBOL_GPL(rt2x00usb_flush_queue
);
525 static void rt2x00usb_watchdog_tx_dma(struct data_queue
*queue
)
527 rt2x00_warn(queue
->rt2x00dev
, "TX queue %d DMA timed out, invoke forced forced reset\n",
530 rt2x00queue_stop_queue(queue
);
531 rt2x00queue_flush_queue(queue
, true);
532 rt2x00queue_start_queue(queue
);
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
);
554 EXPORT_SYMBOL_GPL(rt2x00usb_watchdog
);
559 void rt2x00usb_disable_radio(struct rt2x00_dev
*rt2x00dev
)
561 rt2x00usb_vendor_request_sw(rt2x00dev
, USB_RX_CONTROL
, 0, 0,
564 EXPORT_SYMBOL_GPL(rt2x00usb_disable_radio
);
567 * Device initialization handlers.
569 void rt2x00usb_clear_entry(struct queue_entry
*entry
)
573 if (entry
->queue
->qid
== QID_RX
)
574 rt2x00usb_kick_rx_entry(entry
, NULL
);
576 EXPORT_SYMBOL_GPL(rt2x00usb_clear_entry
);
578 static void rt2x00usb_assign_endpoint(struct data_queue
*queue
,
579 struct usb_endpoint_descriptor
*ep_desc
)
581 struct usb_device
*usb_dev
= to_usb_device_intf(queue
->rt2x00dev
->dev
);
584 queue
->usb_endpoint
= usb_endpoint_num(ep_desc
);
586 if (queue
->qid
== QID_RX
) {
587 pipe
= usb_rcvbulkpipe(usb_dev
, queue
->usb_endpoint
);
588 queue
->usb_maxpacket
= usb_maxpacket(usb_dev
, pipe
, 0);
590 pipe
= usb_sndbulkpipe(usb_dev
, queue
->usb_endpoint
);
591 queue
->usb_maxpacket
= usb_maxpacket(usb_dev
, pipe
, 1);
594 if (!queue
->usb_maxpacket
)
595 queue
->usb_maxpacket
= 1;
598 static int rt2x00usb_find_endpoints(struct rt2x00_dev
*rt2x00dev
)
600 struct usb_interface
*intf
= to_usb_interface(rt2x00dev
->dev
);
601 struct usb_host_interface
*intf_desc
= intf
->cur_altsetting
;
602 struct usb_endpoint_descriptor
*ep_desc
;
603 struct data_queue
*queue
= rt2x00dev
->tx
;
604 struct usb_endpoint_descriptor
*tx_ep_desc
= NULL
;
608 * Walk through all available endpoints to search for "bulk in"
609 * and "bulk out" endpoints. When we find such endpoints collect
610 * the information we need from the descriptor and assign it
613 for (i
= 0; i
< intf_desc
->desc
.bNumEndpoints
; i
++) {
614 ep_desc
= &intf_desc
->endpoint
[i
].desc
;
616 if (usb_endpoint_is_bulk_in(ep_desc
)) {
617 rt2x00usb_assign_endpoint(rt2x00dev
->rx
, ep_desc
);
618 } else if (usb_endpoint_is_bulk_out(ep_desc
) &&
619 (queue
!= queue_end(rt2x00dev
))) {
620 rt2x00usb_assign_endpoint(queue
, ep_desc
);
621 queue
= queue_next(queue
);
623 tx_ep_desc
= ep_desc
;
628 * At least 1 endpoint for RX and 1 endpoint for TX must be available.
630 if (!rt2x00dev
->rx
->usb_endpoint
|| !rt2x00dev
->tx
->usb_endpoint
) {
631 rt2x00_err(rt2x00dev
, "Bulk-in/Bulk-out endpoints not found\n");
636 * It might be possible not all queues have a dedicated endpoint.
637 * Loop through all TX queues and copy the endpoint information
638 * which we have gathered from already assigned endpoints.
640 txall_queue_for_each(rt2x00dev
, queue
) {
641 if (!queue
->usb_endpoint
)
642 rt2x00usb_assign_endpoint(queue
, tx_ep_desc
);
648 static int rt2x00usb_alloc_entries(struct data_queue
*queue
)
650 struct rt2x00_dev
*rt2x00dev
= queue
->rt2x00dev
;
651 struct queue_entry_priv_usb
*entry_priv
;
652 struct queue_entry_priv_usb_bcn
*bcn_priv
;
655 for (i
= 0; i
< queue
->limit
; i
++) {
656 entry_priv
= queue
->entries
[i
].priv_data
;
657 entry_priv
->urb
= usb_alloc_urb(0, GFP_KERNEL
);
658 if (!entry_priv
->urb
)
663 * If this is not the beacon queue or
664 * no guardian byte was required for the beacon,
667 if (queue
->qid
!= QID_BEACON
||
668 !rt2x00_has_cap_flag(rt2x00dev
, REQUIRE_BEACON_GUARD
))
671 for (i
= 0; i
< queue
->limit
; i
++) {
672 bcn_priv
= queue
->entries
[i
].priv_data
;
673 bcn_priv
->guardian_urb
= usb_alloc_urb(0, GFP_KERNEL
);
674 if (!bcn_priv
->guardian_urb
)
681 static void rt2x00usb_free_entries(struct data_queue
*queue
)
683 struct rt2x00_dev
*rt2x00dev
= queue
->rt2x00dev
;
684 struct queue_entry_priv_usb
*entry_priv
;
685 struct queue_entry_priv_usb_bcn
*bcn_priv
;
691 for (i
= 0; i
< queue
->limit
; i
++) {
692 entry_priv
= queue
->entries
[i
].priv_data
;
693 usb_kill_urb(entry_priv
->urb
);
694 usb_free_urb(entry_priv
->urb
);
698 * If this is not the beacon queue or
699 * no guardian byte was required for the beacon,
702 if (queue
->qid
!= QID_BEACON
||
703 !rt2x00_has_cap_flag(rt2x00dev
, REQUIRE_BEACON_GUARD
))
706 for (i
= 0; i
< queue
->limit
; i
++) {
707 bcn_priv
= queue
->entries
[i
].priv_data
;
708 usb_kill_urb(bcn_priv
->guardian_urb
);
709 usb_free_urb(bcn_priv
->guardian_urb
);
713 int rt2x00usb_initialize(struct rt2x00_dev
*rt2x00dev
)
715 struct data_queue
*queue
;
719 * Find endpoints for each queue
721 status
= rt2x00usb_find_endpoints(rt2x00dev
);
728 queue_for_each(rt2x00dev
, queue
) {
729 status
= rt2x00usb_alloc_entries(queue
);
737 rt2x00usb_uninitialize(rt2x00dev
);
741 EXPORT_SYMBOL_GPL(rt2x00usb_initialize
);
743 void rt2x00usb_uninitialize(struct rt2x00_dev
*rt2x00dev
)
745 struct data_queue
*queue
;
747 queue_for_each(rt2x00dev
, queue
)
748 rt2x00usb_free_entries(queue
);
750 EXPORT_SYMBOL_GPL(rt2x00usb_uninitialize
);
753 * USB driver handlers.
755 static void rt2x00usb_free_reg(struct rt2x00_dev
*rt2x00dev
)
757 kfree(rt2x00dev
->rf
);
758 rt2x00dev
->rf
= NULL
;
760 kfree(rt2x00dev
->eeprom
);
761 rt2x00dev
->eeprom
= NULL
;
763 kfree(rt2x00dev
->csr
.cache
);
764 rt2x00dev
->csr
.cache
= NULL
;
767 static int rt2x00usb_alloc_reg(struct rt2x00_dev
*rt2x00dev
)
769 rt2x00dev
->csr
.cache
= kzalloc(CSR_CACHE_SIZE
, GFP_KERNEL
);
770 if (!rt2x00dev
->csr
.cache
)
773 rt2x00dev
->eeprom
= kzalloc(rt2x00dev
->ops
->eeprom_size
, GFP_KERNEL
);
774 if (!rt2x00dev
->eeprom
)
777 rt2x00dev
->rf
= kzalloc(rt2x00dev
->ops
->rf_size
, GFP_KERNEL
);
784 rt2x00_probe_err("Failed to allocate registers\n");
786 rt2x00usb_free_reg(rt2x00dev
);
791 int rt2x00usb_probe(struct usb_interface
*usb_intf
,
792 const struct rt2x00_ops
*ops
)
794 struct usb_device
*usb_dev
= interface_to_usbdev(usb_intf
);
795 struct ieee80211_hw
*hw
;
796 struct rt2x00_dev
*rt2x00dev
;
799 usb_dev
= usb_get_dev(usb_dev
);
800 usb_reset_device(usb_dev
);
802 hw
= ieee80211_alloc_hw(sizeof(struct rt2x00_dev
), ops
->hw
);
804 rt2x00_probe_err("Failed to allocate hardware\n");
806 goto exit_put_device
;
809 usb_set_intfdata(usb_intf
, hw
);
811 rt2x00dev
= hw
->priv
;
812 rt2x00dev
->dev
= &usb_intf
->dev
;
813 rt2x00dev
->ops
= ops
;
816 rt2x00_set_chip_intf(rt2x00dev
, RT2X00_CHIP_INTF_USB
);
818 INIT_WORK(&rt2x00dev
->rxdone_work
, rt2x00usb_work_rxdone
);
819 INIT_WORK(&rt2x00dev
->txdone_work
, rt2x00usb_work_txdone
);
820 hrtimer_init(&rt2x00dev
->txstatus_timer
, CLOCK_MONOTONIC
,
823 retval
= rt2x00usb_alloc_reg(rt2x00dev
);
825 goto exit_free_device
;
827 retval
= rt2x00lib_probe_dev(rt2x00dev
);
831 rt2x00dev
->anchor
= devm_kmalloc(&usb_dev
->dev
,
832 sizeof(struct usb_anchor
),
834 if (!rt2x00dev
->anchor
)
837 init_usb_anchor(rt2x00dev
->anchor
);
841 rt2x00usb_free_reg(rt2x00dev
);
844 ieee80211_free_hw(hw
);
847 usb_put_dev(usb_dev
);
849 usb_set_intfdata(usb_intf
, NULL
);
853 EXPORT_SYMBOL_GPL(rt2x00usb_probe
);
855 void rt2x00usb_disconnect(struct usb_interface
*usb_intf
)
857 struct ieee80211_hw
*hw
= usb_get_intfdata(usb_intf
);
858 struct rt2x00_dev
*rt2x00dev
= hw
->priv
;
861 * Free all allocated data.
863 rt2x00lib_remove_dev(rt2x00dev
);
864 rt2x00usb_free_reg(rt2x00dev
);
865 ieee80211_free_hw(hw
);
868 * Free the USB device data.
870 usb_set_intfdata(usb_intf
, NULL
);
871 usb_put_dev(interface_to_usbdev(usb_intf
));
873 EXPORT_SYMBOL_GPL(rt2x00usb_disconnect
);
876 int rt2x00usb_suspend(struct usb_interface
*usb_intf
, pm_message_t state
)
878 struct ieee80211_hw
*hw
= usb_get_intfdata(usb_intf
);
879 struct rt2x00_dev
*rt2x00dev
= hw
->priv
;
881 return rt2x00lib_suspend(rt2x00dev
, state
);
883 EXPORT_SYMBOL_GPL(rt2x00usb_suspend
);
885 int rt2x00usb_resume(struct usb_interface
*usb_intf
)
887 struct ieee80211_hw
*hw
= usb_get_intfdata(usb_intf
);
888 struct rt2x00_dev
*rt2x00dev
= hw
->priv
;
890 return rt2x00lib_resume(rt2x00dev
);
892 EXPORT_SYMBOL_GPL(rt2x00usb_resume
);
893 #endif /* CONFIG_PM */
896 * rt2x00usb module information.
898 MODULE_AUTHOR(DRV_PROJECT
);
899 MODULE_VERSION(DRV_VERSION
);
900 MODULE_DESCRIPTION("rt2x00 usb library");
901 MODULE_LICENSE("GPL");