blob: cdac9280fe4286f213b03f0624de8d54ce9a24a2 [file] [log] [blame]
Ivo van Doorn95ea3622007-09-25 17:57:13 -07001/*
Ivo van Doorn811aa9c2008-02-03 15:42:53 +01002 Copyright (C) 2004 - 2008 rt2x00 SourceForge Project
Ivo van Doorn95ea3622007-09-25 17:57:13 -07003 <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
Ivo van Doorn95ea3622007-09-25 17:57:13 -070026#include <linux/kernel.h>
27#include <linux/module.h>
28#include <linux/usb.h>
Adam Baker3d823462007-10-27 13:43:29 +020029#include <linux/bug.h>
Ivo van Doorn95ea3622007-09-25 17:57:13 -070030
31#include "rt2x00.h"
32#include "rt2x00usb.h"
33
34/*
35 * Interfacing with the HW.
36 */
Adam Baker0e14f6d2007-10-27 13:41:25 +020037int rt2x00usb_vendor_request(struct rt2x00_dev *rt2x00dev,
Ivo van Doorn95ea3622007-09-25 17:57:13 -070038 const u8 request, const u8 requesttype,
39 const u16 offset, const u16 value,
40 void *buffer, const u16 buffer_length,
Ivo van Doorne9136552007-09-25 20:54:20 +020041 const int timeout)
Ivo van Doorn95ea3622007-09-25 17:57:13 -070042{
Ivo van Doorn181d6902008-02-05 16:42:23 -050043 struct usb_device *usb_dev = rt2x00dev_usb_dev(rt2x00dev);
Ivo van Doorn95ea3622007-09-25 17:57:13 -070044 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
Adam Baker3d823462007-10-27 13:43:29 +020050
Ivo van Doorn95ea3622007-09-25 17:57:13 -070051 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 /*
Ivo van Doorne9136552007-09-25 20:54:20 +020059 * Check for errors
Ivo van Doorn95ea3622007-09-25 17:57:13 -070060 * -ENODEV: Device has disappeared, no point continuing.
Ivo van Doorne9136552007-09-25 20:54:20 +020061 * All other errors: Try again.
Ivo van Doorn95ea3622007-09-25 17:57:13 -070062 */
Ivo van Doorn95ea3622007-09-25 17:57:13 -070063 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}
73EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request);
74
Adam Baker3d823462007-10-27 13:43:29 +020075int 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)
Ivo van Doorn95ea3622007-09-25 17:57:13 -070079{
80 int status;
81
Adam Baker3d823462007-10-27 13:43:29 +020082 BUG_ON(!mutex_is_locked(&rt2x00dev->usb_cache_mutex));
83
Ivo van Doorn95ea3622007-09-25 17:57:13 -070084 /*
85 * Check for Cache availability.
86 */
Ivo van Doorn21795092008-02-10 22:49:13 +010087 if (unlikely(!rt2x00dev->csr.cache || buffer_length > CSR_CACHE_SIZE)) {
Ivo van Doorn95ea3622007-09-25 17:57:13 -070088 ERROR(rt2x00dev, "CSR cache not available.\n");
89 return -ENOMEM;
90 }
91
92 if (requesttype == USB_VENDOR_REQUEST_OUT)
Ivo van Doorn21795092008-02-10 22:49:13 +010093 memcpy(rt2x00dev->csr.cache, buffer, buffer_length);
Ivo van Doorn95ea3622007-09-25 17:57:13 -070094
95 status = rt2x00usb_vendor_request(rt2x00dev, request, requesttype,
Ivo van Doorn21795092008-02-10 22:49:13 +010096 offset, 0, rt2x00dev->csr.cache,
Ivo van Doorn95ea3622007-09-25 17:57:13 -070097 buffer_length, timeout);
98
99 if (!status && requesttype == USB_VENDOR_REQUEST_IN)
Ivo van Doorn21795092008-02-10 22:49:13 +0100100 memcpy(buffer, rt2x00dev->csr.cache, buffer_length);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700101
102 return status;
103}
Adam Baker3d823462007-10-27 13:43:29 +0200104EXPORT_SYMBOL_GPL(rt2x00usb_vendor_req_buff_lock);
105
106int 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}
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700123EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_buff);
124
125/*
126 * TX data handlers.
127 */
128static void rt2x00usb_interrupt_txdone(struct urb *urb)
129{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500130 struct queue_entry *entry = (struct queue_entry *)urb->context;
131 struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500132 struct txdone_entry_desc txdesc;
Johannes Berge039fa42008-05-15 12:55:29 +0200133 enum data_queue_qid qid = skb_get_queue_mapping(entry->skb);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700134
135 if (!test_bit(DEVICE_ENABLED_RADIO, &rt2x00dev->flags) ||
Ivo van Doorn181d6902008-02-05 16:42:23 -0500136 !__test_and_clear_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700137 return;
138
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700139 /*
140 * Remove the descriptor data from the buffer.
141 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500142 skb_pull(entry->skb, entry->queue->desc_size);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700143
144 /*
145 * Obtain the status about this packet.
Ivo van Doornfb55f4d12008-05-10 13:42:06 +0200146 * 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).
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700152 */
Ivo van Doornfb55f4d12008-05-10 13:42:06 +0200153 if (!urb->status)
154 __set_bit(TXDONE_UNKNOWN, &txdesc.flags);
155 else
156 __set_bit(TXDONE_FAILURE, &txdesc.flags);
Ivo van Doorn181d6902008-02-05 16:42:23 -0500157 txdesc.retry = 0;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700158
Ivo van Doorn181d6902008-02-05 16:42:23 -0500159 rt2x00lib_txdone(entry, &txdesc);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700160
161 /*
162 * Make this entry available for reuse.
163 */
164 entry->flags = 0;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500165 rt2x00queue_index_inc(entry->queue, Q_INDEX_DONE);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700166
167 /*
Ivo van Doorn181d6902008-02-05 16:42:23 -0500168 * If the data queue was full before the txdone handler
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700169 * we must make sure the packet queue in the mac80211 stack
170 * is reenabled when the txdone handler has finished.
171 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500172 if (!rt2x00queue_full(entry->queue))
Johannes Berge039fa42008-05-15 12:55:29 +0200173 ieee80211_wake_queue(rt2x00dev->hw, qid);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700174}
175
176int rt2x00usb_write_tx_data(struct rt2x00_dev *rt2x00dev,
Johannes Berge039fa42008-05-15 12:55:29 +0200177 struct data_queue *queue, struct sk_buff *skb)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700178{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500179 struct usb_device *usb_dev = rt2x00dev_usb_dev(rt2x00dev);
180 struct queue_entry *entry = rt2x00queue_get_entry(queue, Q_INDEX);
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200181 struct queue_entry_priv_usb *entry_priv = entry->priv_data;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500182 struct skb_frame_desc *skbdesc;
Ivo van Doorn7050ec82008-05-10 13:46:13 +0200183 struct txentry_desc txdesc;
Ivo van Doorndd9fa2d2007-10-06 14:15:46 +0200184 u32 length;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700185
Ivo van Doorn181d6902008-02-05 16:42:23 -0500186 if (rt2x00queue_full(queue))
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700187 return -EINVAL;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700188
Ivo van Doorn181d6902008-02-05 16:42:23 -0500189 if (test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags)) {
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700190 ERROR(rt2x00dev,
191 "Arrived at non-free entry in the non-full queue %d.\n"
192 "Please file bug report to %s.\n",
Ivo van Doorne58c6ac2008-04-21 19:00:47 +0200193 entry->queue->qid, DRV_PROJECT);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700194 return -EINVAL;
195 }
196
197 /*
Ivo van Doorn7050ec82008-05-10 13:46:13 +0200198 * 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;
Johannes Berge039fa42008-05-15 12:55:29 +0200203 rt2x00queue_create_tx_descriptor(entry, &txdesc);
Ivo van Doorn7050ec82008-05-10 13:46:13 +0200204
205 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700206 * Add the descriptor in front of the skb.
207 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500208 skb_push(skb, queue->desc_size);
209 memset(skb->data, 0, queue->desc_size);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700210
Ivo van Doorn08992f72008-01-24 01:56:25 -0800211 /*
212 * Fill in skb descriptor
213 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500214 skbdesc = get_skb_frame_desc(skb);
Johannes Berge039fa42008-05-15 12:55:29 +0200215 memset(skbdesc, 0, sizeof(*skbdesc));
Ivo van Doorn181d6902008-02-05 16:42:23 -0500216 skbdesc->data = skb->data + queue->desc_size;
Ivo van Doorn647d0ca2008-02-10 22:51:21 +0100217 skbdesc->data_len = skb->len - queue->desc_size;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500218 skbdesc->desc = skb->data;
219 skbdesc->desc_len = queue->desc_size;
220 skbdesc->entry = entry;
Ivo van Doorn08992f72008-01-24 01:56:25 -0800221
Ivo van Doorn7050ec82008-05-10 13:46:13 +0200222 rt2x00queue_write_tx_descriptor(entry, &txdesc);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700223
224 /*
Ivo van Doorndd9fa2d2007-10-06 14:15:46 +0200225 * 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.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700228 */
Ivo van Doornb242e892007-11-15 23:41:31 +0100229 length = rt2x00dev->ops->lib->get_tx_data_len(rt2x00dev, skb);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700230
Ivo van Doorndd9fa2d2007-10-06 14:15:46 +0200231 /*
232 * Initialize URB and send the frame to the device.
233 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500234 __set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
Ivo van Doornf019d512008-06-06 22:47:39 +0200235 __set_bit(ENTRY_DATA_PENDING, &entry->flags);
236
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200237 usb_fill_bulk_urb(entry_priv->urb, usb_dev, usb_sndbulkpipe(usb_dev, 1),
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700238 skb->data, length, rt2x00usb_interrupt_txdone, entry);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700239
Ivo van Doorn181d6902008-02-05 16:42:23 -0500240 rt2x00queue_index_inc(queue, Q_INDEX);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700241
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700242 return 0;
243}
244EXPORT_SYMBOL_GPL(rt2x00usb_write_tx_data);
245
Ivo van Doornf019d512008-06-06 22:47:39 +0200246static 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
254void 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}
289EXPORT_SYMBOL_GPL(rt2x00usb_kick_tx_queue);
290
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700291/*
292 * RX data handlers.
293 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500294static struct sk_buff* rt2x00usb_alloc_rxskb(struct data_queue *queue)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700295{
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700296 struct sk_buff *skb;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500297 unsigned int frame_size;
Ivo van Doorn70a96102008-05-10 13:43:38 +0200298 unsigned int reserved_size;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700299
300 /*
Ivo van Doorn70a96102008-05-10 13:43:38 +0200301 * The frame size includes descriptor size, because the
302 * hardware directly receive the frame into the skbuffer.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700303 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500304 frame_size = queue->data_size + queue->desc_size;
Ivo van Doorn70a96102008-05-10 13:43:38 +0200305
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);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700323 if (!skb)
Ivo van Doorn181d6902008-02-05 16:42:23 -0500324 return NULL;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700325
Ivo van Doorn70a96102008-05-10 13:43:38 +0200326 skb_reserve(skb, reserved_size);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700327 skb_put(skb, frame_size);
328
Ivo van Doorn181d6902008-02-05 16:42:23 -0500329 return skb;
330}
Ivo van Doornc5d0dc52008-01-06 23:40:27 +0100331
Ivo van Doorn181d6902008-02-05 16:42:23 -0500332static 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;
Ivo van Doorn70a96102008-05-10 13:43:38 +0200339 unsigned int header_size;
340 unsigned int align;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500341
342 if (!test_bit(DEVICE_ENABLED_RADIO, &rt2x00dev->flags) ||
343 !test_and_clear_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
344 return;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700345
346 /*
Ivo van Doorn181d6902008-02-05 16:42:23 -0500347 * Check if the received data is simply too small
348 * to be actually valid, or if the urb is signaling
349 * a problem.
Ivo van Doorn08992f72008-01-24 01:56:25 -0800350 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500351 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
Ivo van Doorn70a96102008-05-10 13:43:38 +0200364 header_size = ieee80211_get_hdrlen_from_skb(entry->skb);
365
Ivo van Doorn181d6902008-02-05 16:42:23 -0500366 /*
Ivo van Doornf855c102008-03-09 22:38:18 +0100367 * The data behind the ieee80211 header must be
Ivo van Doorn70a96102008-05-10 13:43:38 +0200368 * 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.
Ivo van Doornf855c102008-03-09 22:38:18 +0100373 */
Ivo van Doorn70a96102008-05-10 13:43:38 +0200374 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);
Ivo van Doornf855c102008-03-09 22:38:18 +0100381 }
382
Ivo van Doorn70a96102008-05-10 13:43:38 +0200383 /* Update data pointers, trim buffer to correct size */
384 skbdesc->data = entry->skb->data;
385 skb_trim(entry->skb, rxdesc.size);
386
Ivo van Doornf855c102008-03-09 22:38:18 +0100387 /*
Ivo van Doorn181d6902008-02-05 16:42:23 -0500388 * 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;
Ivo van Doorn08992f72008-01-24 01:56:25 -0800395
396 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700397 * Send the frame to rt2x00lib for further processing.
398 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500399 rt2x00lib_rxdone(entry, &rxdesc);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700400
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
409skip_entry:
Ivo van Doorn181d6902008-02-05 16:42:23 -0500410 if (test_bit(DEVICE_ENABLED_RADIO, &entry->queue->rt2x00dev->flags)) {
411 __set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700412 usb_submit_urb(urb, GFP_ATOMIC);
413 }
414
Ivo van Doorn181d6902008-02-05 16:42:23 -0500415 rt2x00queue_index_inc(entry->queue, Q_INDEX);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700416}
417
418/*
419 * Radio handlers
420 */
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700421void rt2x00usb_disable_radio(struct rt2x00_dev *rt2x00dev)
422{
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200423 struct queue_entry_priv_usb *entry_priv;
424 struct queue_entry_priv_usb_bcn *bcn_priv;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700425 unsigned int i;
426
Ivo van Doornbd394a72008-04-21 19:01:58 +0200427 rt2x00usb_vendor_request_sw(rt2x00dev, USB_RX_CONTROL, 0, 0,
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700428 REGISTER_TIMEOUT);
429
430 /*
Ivo van Doorn181d6902008-02-05 16:42:23 -0500431 * Cancel all queues.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700432 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500433 for (i = 0; i < rt2x00dev->rx->limit; i++) {
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200434 entry_priv = rt2x00dev->rx->entries[i].priv_data;
435 usb_kill_urb(entry_priv->urb);
Ivo van Doorn181d6902008-02-05 16:42:23 -0500436 }
437
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200438 /*
439 * Kill guardian urb.
440 */
Ivo van Doorn330e3f92008-02-10 22:52:36 +0100441 for (i = 0; i < rt2x00dev->bcn->limit; i++) {
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200442 bcn_priv = rt2x00dev->bcn->entries[i].priv_data;
443 if (bcn_priv->guardian_urb)
444 usb_kill_urb(bcn_priv->guardian_urb);
Ivo van Doorn330e3f92008-02-10 22:52:36 +0100445 }
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700446}
447EXPORT_SYMBOL_GPL(rt2x00usb_disable_radio);
448
449/*
450 * Device initialization handlers.
451 */
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100452void rt2x00usb_init_rxentry(struct rt2x00_dev *rt2x00dev,
Ivo van Doorn181d6902008-02-05 16:42:23 -0500453 struct queue_entry *entry)
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100454{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500455 struct usb_device *usb_dev = rt2x00dev_usb_dev(rt2x00dev);
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200456 struct queue_entry_priv_usb *entry_priv = entry->priv_data;
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100457
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200458 usb_fill_bulk_urb(entry_priv->urb, usb_dev,
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100459 usb_rcvbulkpipe(usb_dev, 1),
460 entry->skb->data, entry->skb->len,
461 rt2x00usb_interrupt_rxdone, entry);
462
Ivo van Doorn181d6902008-02-05 16:42:23 -0500463 __set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200464 usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100465}
466EXPORT_SYMBOL_GPL(rt2x00usb_init_rxentry);
467
468void rt2x00usb_init_txentry(struct rt2x00_dev *rt2x00dev,
Ivo van Doorn181d6902008-02-05 16:42:23 -0500469 struct queue_entry *entry)
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100470{
471 entry->flags = 0;
472}
473EXPORT_SYMBOL_GPL(rt2x00usb_init_txentry);
474
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700475static int rt2x00usb_alloc_urb(struct rt2x00_dev *rt2x00dev,
Ivo van Doorn181d6902008-02-05 16:42:23 -0500476 struct data_queue *queue)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700477{
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200478 struct queue_entry_priv_usb *entry_priv;
479 struct queue_entry_priv_usb_bcn *bcn_priv;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700480 unsigned int i;
481
Ivo van Doorn181d6902008-02-05 16:42:23 -0500482 for (i = 0; i < queue->limit; i++) {
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200483 entry_priv = queue->entries[i].priv_data;
484 entry_priv->urb = usb_alloc_urb(0, GFP_KERNEL);
485 if (!entry_priv->urb)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700486 return -ENOMEM;
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200487 }
Ivo van Doorn181d6902008-02-05 16:42:23 -0500488
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200489 /*
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;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500497
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200498 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;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700503 }
504
505 return 0;
506}
507
508static void rt2x00usb_free_urb(struct rt2x00_dev *rt2x00dev,
Ivo van Doorn181d6902008-02-05 16:42:23 -0500509 struct data_queue *queue)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700510{
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200511 struct queue_entry_priv_usb *entry_priv;
512 struct queue_entry_priv_usb_bcn *bcn_priv;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700513 unsigned int i;
514
Ivo van Doorn181d6902008-02-05 16:42:23 -0500515 if (!queue->entries)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700516 return;
517
Ivo van Doorn181d6902008-02-05 16:42:23 -0500518 for (i = 0; i < queue->limit; i++) {
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200519 entry_priv = queue->entries[i].priv_data;
520 usb_kill_urb(entry_priv->urb);
521 usb_free_urb(entry_priv->urb);
Ivo van Doorn181d6902008-02-05 16:42:23 -0500522 if (queue->entries[i].skb)
523 kfree_skb(queue->entries[i].skb);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700524 }
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200525
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 }
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700540}
541
542int rt2x00usb_initialize(struct rt2x00_dev *rt2x00dev)
543{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500544 struct data_queue *queue;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700545 struct sk_buff *skb;
546 unsigned int entry_size;
547 unsigned int i;
Andrew Morton73738002008-01-16 02:58:24 -0800548 int uninitialized_var(status);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700549
550 /*
551 * Allocate DMA
552 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500553 queue_for_each(rt2x00dev, queue) {
554 status = rt2x00usb_alloc_urb(rt2x00dev, queue);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700555 if (status)
556 goto exit;
557 }
558
559 /*
Ivo van Doorn181d6902008-02-05 16:42:23 -0500560 * For the RX queue, skb's should be allocated.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700561 */
562 entry_size = rt2x00dev->rx->data_size + rt2x00dev->rx->desc_size;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500563 for (i = 0; i < rt2x00dev->rx->limit; i++) {
564 skb = rt2x00usb_alloc_rxskb(rt2x00dev->rx);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700565 if (!skb)
566 goto exit;
567
Ivo van Doorn181d6902008-02-05 16:42:23 -0500568 rt2x00dev->rx->entries[i].skb = skb;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700569 }
570
571 return 0;
572
573exit:
574 rt2x00usb_uninitialize(rt2x00dev);
575
576 return status;
577}
578EXPORT_SYMBOL_GPL(rt2x00usb_initialize);
579
580void rt2x00usb_uninitialize(struct rt2x00_dev *rt2x00dev)
581{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500582 struct data_queue *queue;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700583
Ivo van Doorn181d6902008-02-05 16:42:23 -0500584 queue_for_each(rt2x00dev, queue)
585 rt2x00usb_free_urb(rt2x00dev, queue);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700586}
587EXPORT_SYMBOL_GPL(rt2x00usb_uninitialize);
588
589/*
590 * USB driver handlers.
591 */
592static 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
Ivo van Doorn21795092008-02-10 22:49:13 +0100600 kfree(rt2x00dev->csr.cache);
601 rt2x00dev->csr.cache = NULL;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700602}
603
604static int rt2x00usb_alloc_reg(struct rt2x00_dev *rt2x00dev)
605{
Ivo van Doorn21795092008-02-10 22:49:13 +0100606 rt2x00dev->csr.cache = kzalloc(CSR_CACHE_SIZE, GFP_KERNEL);
607 if (!rt2x00dev->csr.cache)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700608 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
620exit:
621 ERROR_PROBE("Failed to allocate registers.\n");
622
623 rt2x00usb_free_reg(rt2x00dev);
624
625 return -ENOMEM;
626}
627
628int 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;
Adam Baker3d823462007-10-27 13:43:29 +0200652 mutex_init(&rt2x00dev->usb_cache_mutex);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700653
Ivo van Doornb242e892007-11-15 23:41:31 +0100654 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
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700659 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
669exit_free_reg:
670 rt2x00usb_free_reg(rt2x00dev);
671
672exit_free_device:
673 ieee80211_free_hw(hw);
674
675exit_put_device:
676 usb_put_dev(usb_dev);
677
678 usb_set_intfdata(usb_intf, NULL);
679
680 return retval;
681}
682EXPORT_SYMBOL_GPL(rt2x00usb_probe);
683
684void 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}
702EXPORT_SYMBOL_GPL(rt2x00usb_disconnect);
703
704#ifdef CONFIG_PM
705int 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}
724EXPORT_SYMBOL_GPL(rt2x00usb_suspend);
725
726int 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
744exit_free_reg:
745 rt2x00usb_free_reg(rt2x00dev);
746
747 return retval;
748}
749EXPORT_SYMBOL_GPL(rt2x00usb_resume);
750#endif /* CONFIG_PM */
751
752/*
Ivo van Doorn181d6902008-02-05 16:42:23 -0500753 * rt2x00usb module information.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700754 */
755MODULE_AUTHOR(DRV_PROJECT);
756MODULE_VERSION(DRV_VERSION);
Ivo van Doorn181d6902008-02-05 16:42:23 -0500757MODULE_DESCRIPTION("rt2x00 usb library");
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700758MODULE_LICENSE("GPL");