blob: 5e123519f8cb589bb5d4292374cf3522059282ff [file] [log] [blame]
Ivo van Doorn95ea3622007-09-25 17:57:13 -07001/*
Gertjan van Wingerde9c9a0d12009-11-08 16:39:55 +01002 Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com>
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>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090028#include <linux/slab.h>
Ivo van Doorn95ea3622007-09-25 17:57:13 -070029#include <linux/usb.h>
Adam Baker3d823462007-10-27 13:43:29 +020030#include <linux/bug.h>
Ivo van Doorn95ea3622007-09-25 17:57:13 -070031
32#include "rt2x00.h"
33#include "rt2x00usb.h"
34
35/*
36 * Interfacing with the HW.
37 */
Adam Baker0e14f6d2007-10-27 13:41:25 +020038int rt2x00usb_vendor_request(struct rt2x00_dev *rt2x00dev,
Ivo van Doorn95ea3622007-09-25 17:57:13 -070039 const u8 request, const u8 requesttype,
40 const u16 offset, const u16 value,
41 void *buffer, const u16 buffer_length,
Ivo van Doorne9136552007-09-25 20:54:20 +020042 const int timeout)
Ivo van Doorn95ea3622007-09-25 17:57:13 -070043{
Ivo van Doornc1d35df2008-06-16 19:57:11 +020044 struct usb_device *usb_dev = to_usb_device_intf(rt2x00dev->dev);
Ivo van Doorn95ea3622007-09-25 17:57:13 -070045 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
Sean Cross66f84d62009-11-05 20:22:03 +010051 if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
52 return -ENODEV;
Adam Baker3d823462007-10-27 13:43:29 +020053
Ivo van Doorn95ea3622007-09-25 17:57:13 -070054 for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
55 status = usb_control_msg(usb_dev, pipe, request, requesttype,
56 value, offset, buffer, buffer_length,
57 timeout);
58 if (status >= 0)
59 return 0;
60
61 /*
Ivo van Doorne9136552007-09-25 20:54:20 +020062 * Check for errors
Ivo van Doorn95ea3622007-09-25 17:57:13 -070063 * -ENODEV: Device has disappeared, no point continuing.
Ivo van Doorne9136552007-09-25 20:54:20 +020064 * All other errors: Try again.
Ivo van Doorn95ea3622007-09-25 17:57:13 -070065 */
Sean Cross66f84d62009-11-05 20:22:03 +010066 else if (status == -ENODEV) {
67 clear_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags);
Ivo van Doorn95ea3622007-09-25 17:57:13 -070068 break;
Sean Cross66f84d62009-11-05 20:22:03 +010069 }
Ivo van Doorn95ea3622007-09-25 17:57:13 -070070 }
71
72 ERROR(rt2x00dev,
73 "Vendor Request 0x%02x failed for offset 0x%04x with error %d.\n",
74 request, offset, status);
75
76 return status;
77}
78EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request);
79
Adam Baker3d823462007-10-27 13:43:29 +020080int rt2x00usb_vendor_req_buff_lock(struct rt2x00_dev *rt2x00dev,
81 const u8 request, const u8 requesttype,
82 const u16 offset, void *buffer,
83 const u16 buffer_length, const int timeout)
Ivo van Doorn95ea3622007-09-25 17:57:13 -070084{
85 int status;
86
Ivo van Doorn8ff48a82008-11-09 23:40:46 +010087 BUG_ON(!mutex_is_locked(&rt2x00dev->csr_mutex));
Adam Baker3d823462007-10-27 13:43:29 +020088
Ivo van Doorn95ea3622007-09-25 17:57:13 -070089 /*
90 * Check for Cache availability.
91 */
Ivo van Doorn21795092008-02-10 22:49:13 +010092 if (unlikely(!rt2x00dev->csr.cache || buffer_length > CSR_CACHE_SIZE)) {
Ivo van Doorn95ea3622007-09-25 17:57:13 -070093 ERROR(rt2x00dev, "CSR cache not available.\n");
94 return -ENOMEM;
95 }
96
97 if (requesttype == USB_VENDOR_REQUEST_OUT)
Ivo van Doorn21795092008-02-10 22:49:13 +010098 memcpy(rt2x00dev->csr.cache, buffer, buffer_length);
Ivo van Doorn95ea3622007-09-25 17:57:13 -070099
100 status = rt2x00usb_vendor_request(rt2x00dev, request, requesttype,
Ivo van Doorn21795092008-02-10 22:49:13 +0100101 offset, 0, rt2x00dev->csr.cache,
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700102 buffer_length, timeout);
103
104 if (!status && requesttype == USB_VENDOR_REQUEST_IN)
Ivo van Doorn21795092008-02-10 22:49:13 +0100105 memcpy(buffer, rt2x00dev->csr.cache, buffer_length);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700106
107 return status;
108}
Adam Baker3d823462007-10-27 13:43:29 +0200109EXPORT_SYMBOL_GPL(rt2x00usb_vendor_req_buff_lock);
110
111int rt2x00usb_vendor_request_buff(struct rt2x00_dev *rt2x00dev,
112 const u8 request, const u8 requesttype,
113 const u16 offset, void *buffer,
114 const u16 buffer_length, const int timeout)
115{
116 int status;
117
Ivo van Doorn8ff48a82008-11-09 23:40:46 +0100118 mutex_lock(&rt2x00dev->csr_mutex);
Adam Baker3d823462007-10-27 13:43:29 +0200119
120 status = rt2x00usb_vendor_req_buff_lock(rt2x00dev, request,
121 requesttype, offset, buffer,
122 buffer_length, timeout);
123
Ivo van Doorn8ff48a82008-11-09 23:40:46 +0100124 mutex_unlock(&rt2x00dev->csr_mutex);
Adam Baker3d823462007-10-27 13:43:29 +0200125
126 return status;
127}
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700128EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_buff);
129
Iwo Merglered0dbee2008-07-19 16:16:54 +0200130int rt2x00usb_vendor_request_large_buff(struct rt2x00_dev *rt2x00dev,
131 const u8 request, const u8 requesttype,
Ivo van Doorn82f97b82008-08-02 01:31:09 -0700132 const u16 offset, const void *buffer,
Iwo Merglered0dbee2008-07-19 16:16:54 +0200133 const u16 buffer_length,
134 const int timeout)
135{
136 int status = 0;
137 unsigned char *tb;
138 u16 off, len, bsize;
139
Ivo van Doorn8ff48a82008-11-09 23:40:46 +0100140 mutex_lock(&rt2x00dev->csr_mutex);
Iwo Merglered0dbee2008-07-19 16:16:54 +0200141
Ivo van Doorn82f97b82008-08-02 01:31:09 -0700142 tb = (char *)buffer;
Iwo Merglered0dbee2008-07-19 16:16:54 +0200143 off = offset;
144 len = buffer_length;
145 while (len && !status) {
146 bsize = min_t(u16, CSR_CACHE_SIZE, len);
147 status = rt2x00usb_vendor_req_buff_lock(rt2x00dev, request,
148 requesttype, off, tb,
149 bsize, timeout);
150
151 tb += bsize;
152 len -= bsize;
153 off += bsize;
154 }
155
Ivo van Doorn8ff48a82008-11-09 23:40:46 +0100156 mutex_unlock(&rt2x00dev->csr_mutex);
Iwo Merglered0dbee2008-07-19 16:16:54 +0200157
158 return status;
159}
160EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_large_buff);
161
Ivo van Doorn0f829b12008-11-10 19:42:18 +0100162int rt2x00usb_regbusy_read(struct rt2x00_dev *rt2x00dev,
163 const unsigned int offset,
Bartlomiej Zolnierkiewiczf255b922009-11-04 18:35:18 +0100164 const struct rt2x00_field32 field,
Ivo van Doorn0f829b12008-11-10 19:42:18 +0100165 u32 *reg)
166{
167 unsigned int i;
168
Sean Cross66f84d62009-11-05 20:22:03 +0100169 if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
170 return -ENODEV;
171
Ivo van Doorn0f829b12008-11-10 19:42:18 +0100172 for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
173 rt2x00usb_register_read_lock(rt2x00dev, offset, reg);
174 if (!rt2x00_get_field32(*reg, field))
175 return 1;
176 udelay(REGISTER_BUSY_DELAY);
177 }
178
179 ERROR(rt2x00dev, "Indirect register access failed: "
180 "offset=0x%.08x, value=0x%.08x\n", offset, *reg);
181 *reg = ~0;
182
183 return 0;
184}
185EXPORT_SYMBOL_GPL(rt2x00usb_regbusy_read);
186
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700187/*
188 * TX data handlers.
189 */
190static void rt2x00usb_interrupt_txdone(struct urb *urb)
191{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500192 struct queue_entry *entry = (struct queue_entry *)urb->context;
193 struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500194 struct txdone_entry_desc txdesc;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700195
Ivo van Doorn0262ab02008-08-29 21:04:26 +0200196 if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags) ||
Ivo van Doornd74f5ba2008-06-16 19:56:54 +0200197 !test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700198 return;
199
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700200 /*
Gertjan van Wingerde0b8004a2010-06-03 10:51:45 +0200201 * Remove the descriptor from the front of the skb.
202 */
203 skb_pull(entry->skb, entry->queue->desc_size);
204
205 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700206 * Obtain the status about this packet.
Ivo van Doornfb55f4d12008-05-10 13:42:06 +0200207 * Note that when the status is 0 it does not mean the
208 * frame was send out correctly. It only means the frame
209 * was succesfully pushed to the hardware, we have no
210 * way to determine the transmission status right now.
211 * (Only indirectly by looking at the failed TX counters
212 * in the register).
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700213 */
Jochen Friedrichf126cba2008-08-15 14:47:46 +0200214 txdesc.flags = 0;
Ivo van Doornfb55f4d12008-05-10 13:42:06 +0200215 if (!urb->status)
216 __set_bit(TXDONE_UNKNOWN, &txdesc.flags);
217 else
218 __set_bit(TXDONE_FAILURE, &txdesc.flags);
Ivo van Doorn181d6902008-02-05 16:42:23 -0500219 txdesc.retry = 0;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700220
Ivo van Doorn181d6902008-02-05 16:42:23 -0500221 rt2x00lib_txdone(entry, &txdesc);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700222}
223
Helmut Schaa41086692010-04-15 09:13:13 +0200224int rt2x00usb_write_tx_data(struct queue_entry *entry,
225 struct txentry_desc *txdesc)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700226{
Ivo van Doorn6db37862008-06-06 22:50:28 +0200227 struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
Ivo van Doornc1d35df2008-06-16 19:57:11 +0200228 struct usb_device *usb_dev = to_usb_device_intf(rt2x00dev->dev);
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200229 struct queue_entry_priv_usb *entry_priv = entry->priv_data;
Ivo van Doorndd9fa2d2007-10-06 14:15:46 +0200230 u32 length;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700231
Ivo van Doorn7050ec82008-05-10 13:46:13 +0200232 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700233 * Add the descriptor in front of the skb.
234 */
Ivo van Doorn6db37862008-06-06 22:50:28 +0200235 skb_push(entry->skb, entry->queue->desc_size);
236 memset(entry->skb->data, 0, entry->queue->desc_size);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700237
Ivo van Doorn08992f72008-01-24 01:56:25 -0800238 /*
Ivo van Doorndd9fa2d2007-10-06 14:15:46 +0200239 * USB devices cannot blindly pass the skb->len as the
240 * length of the data to usb_fill_bulk_urb. Pass the skb
241 * to the driver to determine what the length should be.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700242 */
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100243 length = rt2x00dev->ops->lib->get_tx_data_len(entry);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700244
Ivo van Doorn6db37862008-06-06 22:50:28 +0200245 usb_fill_bulk_urb(entry_priv->urb, usb_dev,
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100246 usb_sndbulkpipe(usb_dev, entry->queue->usb_endpoint),
Ivo van Doorn6db37862008-06-06 22:50:28 +0200247 entry->skb->data, length,
248 rt2x00usb_interrupt_txdone, entry);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700249
Mattias Nissler1abc3652008-08-29 21:07:20 +0200250 /*
Gertjan van Wingerdebaaffe62010-06-03 10:51:43 +0200251 * Call the driver's write_tx_datadesc function, if it exists.
252 */
253 if (rt2x00dev->ops->lib->write_tx_datadesc)
254 rt2x00dev->ops->lib->write_tx_datadesc(entry, txdesc);
255
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700256 return 0;
257}
258EXPORT_SYMBOL_GPL(rt2x00usb_write_tx_data);
259
Ivo van Doornf019d512008-06-06 22:47:39 +0200260static inline void rt2x00usb_kick_tx_entry(struct queue_entry *entry)
261{
262 struct queue_entry_priv_usb *entry_priv = entry->priv_data;
263
Ivo van Doorn0262ab02008-08-29 21:04:26 +0200264 if (test_and_clear_bit(ENTRY_DATA_PENDING, &entry->flags))
Ivo van Doornf019d512008-06-06 22:47:39 +0200265 usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
266}
267
268void rt2x00usb_kick_tx_queue(struct rt2x00_dev *rt2x00dev,
269 const enum data_queue_qid qid)
270{
271 struct data_queue *queue = rt2x00queue_get_queue(rt2x00dev, qid);
272 unsigned long irqflags;
273 unsigned int index;
274 unsigned int index_done;
275 unsigned int i;
276
277 /*
278 * Only protect the range we are going to loop over,
279 * if during our loop a extra entry is set to pending
280 * it should not be kicked during this run, since it
281 * is part of another TX operation.
282 */
283 spin_lock_irqsave(&queue->lock, irqflags);
284 index = queue->index[Q_INDEX];
285 index_done = queue->index[Q_INDEX_DONE];
286 spin_unlock_irqrestore(&queue->lock, irqflags);
287
288 /*
289 * Start from the TX done pointer, this guarentees that we will
290 * send out all frames in the correct order.
291 */
292 if (index_done < index) {
293 for (i = index_done; i < index; i++)
294 rt2x00usb_kick_tx_entry(&queue->entries[i]);
295 } else {
296 for (i = index_done; i < queue->limit; i++)
297 rt2x00usb_kick_tx_entry(&queue->entries[i]);
298
299 for (i = 0; i < index; i++)
300 rt2x00usb_kick_tx_entry(&queue->entries[i]);
301 }
302}
303EXPORT_SYMBOL_GPL(rt2x00usb_kick_tx_queue);
304
Ivo van Doorna2c9b652009-01-28 00:32:33 +0100305void rt2x00usb_kill_tx_queue(struct rt2x00_dev *rt2x00dev,
306 const enum data_queue_qid qid)
307{
308 struct data_queue *queue = rt2x00queue_get_queue(rt2x00dev, qid);
309 struct queue_entry_priv_usb *entry_priv;
310 struct queue_entry_priv_usb_bcn *bcn_priv;
311 unsigned int i;
312 bool kill_guard;
313
314 /*
315 * When killing the beacon queue, we must also kill
316 * the beacon guard byte.
317 */
318 kill_guard =
319 (qid == QID_BEACON) &&
320 (test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags));
321
322 /*
323 * Cancel all entries.
324 */
325 for (i = 0; i < queue->limit; i++) {
326 entry_priv = queue->entries[i].priv_data;
327 usb_kill_urb(entry_priv->urb);
328
329 /*
330 * Kill guardian urb (if required by driver).
331 */
332 if (kill_guard) {
333 bcn_priv = queue->entries[i].priv_data;
334 usb_kill_urb(bcn_priv->guardian_urb);
335 }
336 }
337}
338EXPORT_SYMBOL_GPL(rt2x00usb_kill_tx_queue);
339
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700340/*
341 * RX data handlers.
342 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500343static void rt2x00usb_interrupt_rxdone(struct urb *urb)
344{
345 struct queue_entry *entry = (struct queue_entry *)urb->context;
346 struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
Gertjan van Wingerdec4da0042008-06-16 19:56:31 +0200347 struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
Gertjan van Wingerdea26cbc62008-06-06 22:54:28 +0200348 u8 rxd[32];
Ivo van Doorn181d6902008-02-05 16:42:23 -0500349
Ivo van Doorn0262ab02008-08-29 21:04:26 +0200350 if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags) ||
Ivo van Doornd74f5ba2008-06-16 19:56:54 +0200351 !test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
Ivo van Doorn181d6902008-02-05 16:42:23 -0500352 return;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700353
354 /*
Ivo van Doorn181d6902008-02-05 16:42:23 -0500355 * Check if the received data is simply too small
356 * to be actually valid, or if the urb is signaling
357 * a problem.
Ivo van Doorn08992f72008-01-24 01:56:25 -0800358 */
Ivo van Doornd74f5ba2008-06-16 19:56:54 +0200359 if (urb->actual_length < entry->queue->desc_size || urb->status) {
Ivo van Doorn0262ab02008-08-29 21:04:26 +0200360 set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
Ivo van Doornd74f5ba2008-06-16 19:56:54 +0200361 usb_submit_urb(urb, GFP_ATOMIC);
362 return;
363 }
Ivo van Doorn181d6902008-02-05 16:42:23 -0500364
365 /*
Gertjan van Wingerdec4da0042008-06-16 19:56:31 +0200366 * Fill in desc fields of the skb descriptor
Ivo van Doorn181d6902008-02-05 16:42:23 -0500367 */
Gertjan van Wingerdea26cbc62008-06-06 22:54:28 +0200368 skbdesc->desc = rxd;
369 skbdesc->desc_len = entry->queue->desc_size;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500370
Ivo van Doorn08992f72008-01-24 01:56:25 -0800371 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700372 * Send the frame to rt2x00lib for further processing.
373 */
Gertjan van Wingerdec4da0042008-06-16 19:56:31 +0200374 rt2x00lib_rxdone(rt2x00dev, entry);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700375}
376
377/*
378 * Radio handlers
379 */
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700380void rt2x00usb_disable_radio(struct rt2x00_dev *rt2x00dev)
381{
Ivo van Doornbd394a72008-04-21 19:01:58 +0200382 rt2x00usb_vendor_request_sw(rt2x00dev, USB_RX_CONTROL, 0, 0,
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700383 REGISTER_TIMEOUT);
384
385 /*
Ivo van Doorna2c9b652009-01-28 00:32:33 +0100386 * The USB version of kill_tx_queue also works
387 * on the RX queue.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700388 */
Ivo van Doorna2c9b652009-01-28 00:32:33 +0100389 rt2x00dev->ops->lib->kill_tx_queue(rt2x00dev, QID_RX);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700390}
391EXPORT_SYMBOL_GPL(rt2x00usb_disable_radio);
392
393/*
394 * Device initialization handlers.
395 */
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100396void rt2x00usb_clear_entry(struct queue_entry *entry)
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100397{
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100398 struct usb_device *usb_dev =
399 to_usb_device_intf(entry->queue->rt2x00dev->dev);
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200400 struct queue_entry_priv_usb *entry_priv = entry->priv_data;
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100401 int pipe;
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100402
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100403 if (entry->queue->qid == QID_RX) {
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100404 pipe = usb_rcvbulkpipe(usb_dev, entry->queue->usb_endpoint);
405 usb_fill_bulk_urb(entry_priv->urb, usb_dev, pipe,
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100406 entry->skb->data, entry->skb->len,
407 rt2x00usb_interrupt_rxdone, entry);
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100408
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100409 set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
410 usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
411 } else {
412 entry->flags = 0;
413 }
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100414}
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100415EXPORT_SYMBOL_GPL(rt2x00usb_clear_entry);
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100416
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100417static void rt2x00usb_assign_endpoint(struct data_queue *queue,
418 struct usb_endpoint_descriptor *ep_desc)
419{
420 struct usb_device *usb_dev = to_usb_device_intf(queue->rt2x00dev->dev);
421 int pipe;
422
423 queue->usb_endpoint = usb_endpoint_num(ep_desc);
424
425 if (queue->qid == QID_RX) {
426 pipe = usb_rcvbulkpipe(usb_dev, queue->usb_endpoint);
427 queue->usb_maxpacket = usb_maxpacket(usb_dev, pipe, 0);
428 } else {
429 pipe = usb_sndbulkpipe(usb_dev, queue->usb_endpoint);
430 queue->usb_maxpacket = usb_maxpacket(usb_dev, pipe, 1);
431 }
432
433 if (!queue->usb_maxpacket)
434 queue->usb_maxpacket = 1;
435}
436
437static int rt2x00usb_find_endpoints(struct rt2x00_dev *rt2x00dev)
438{
439 struct usb_interface *intf = to_usb_interface(rt2x00dev->dev);
440 struct usb_host_interface *intf_desc = intf->cur_altsetting;
441 struct usb_endpoint_descriptor *ep_desc;
442 struct data_queue *queue = rt2x00dev->tx;
443 struct usb_endpoint_descriptor *tx_ep_desc = NULL;
444 unsigned int i;
445
446 /*
447 * Walk through all available endpoints to search for "bulk in"
448 * and "bulk out" endpoints. When we find such endpoints collect
449 * the information we need from the descriptor and assign it
450 * to the queue.
451 */
452 for (i = 0; i < intf_desc->desc.bNumEndpoints; i++) {
453 ep_desc = &intf_desc->endpoint[i].desc;
454
455 if (usb_endpoint_is_bulk_in(ep_desc)) {
456 rt2x00usb_assign_endpoint(rt2x00dev->rx, ep_desc);
Ivo van Doornd15cfc32008-12-20 11:00:23 +0100457 } else if (usb_endpoint_is_bulk_out(ep_desc) &&
458 (queue != queue_end(rt2x00dev))) {
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100459 rt2x00usb_assign_endpoint(queue, ep_desc);
Ivo van Doornd15cfc32008-12-20 11:00:23 +0100460 queue = queue_next(queue);
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100461
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100462 tx_ep_desc = ep_desc;
463 }
464 }
465
466 /*
467 * At least 1 endpoint for RX and 1 endpoint for TX must be available.
468 */
469 if (!rt2x00dev->rx->usb_endpoint || !rt2x00dev->tx->usb_endpoint) {
470 ERROR(rt2x00dev, "Bulk-in/Bulk-out endpoints not found\n");
471 return -EPIPE;
472 }
473
474 /*
475 * It might be possible not all queues have a dedicated endpoint.
476 * Loop through all TX queues and copy the endpoint information
477 * which we have gathered from already assigned endpoints.
478 */
479 txall_queue_for_each(rt2x00dev, queue) {
480 if (!queue->usb_endpoint)
481 rt2x00usb_assign_endpoint(queue, tx_ep_desc);
482 }
483
484 return 0;
485}
486
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700487static int rt2x00usb_alloc_urb(struct rt2x00_dev *rt2x00dev,
Ivo van Doorn181d6902008-02-05 16:42:23 -0500488 struct data_queue *queue)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700489{
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200490 struct queue_entry_priv_usb *entry_priv;
491 struct queue_entry_priv_usb_bcn *bcn_priv;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700492 unsigned int i;
493
Ivo van Doorn181d6902008-02-05 16:42:23 -0500494 for (i = 0; i < queue->limit; i++) {
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200495 entry_priv = queue->entries[i].priv_data;
496 entry_priv->urb = usb_alloc_urb(0, GFP_KERNEL);
497 if (!entry_priv->urb)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700498 return -ENOMEM;
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200499 }
Ivo van Doorn181d6902008-02-05 16:42:23 -0500500
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200501 /*
502 * If this is not the beacon queue or
503 * no guardian byte was required for the beacon,
504 * then we are done.
505 */
506 if (rt2x00dev->bcn != queue ||
507 !test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
508 return 0;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500509
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200510 for (i = 0; i < queue->limit; i++) {
511 bcn_priv = queue->entries[i].priv_data;
512 bcn_priv->guardian_urb = usb_alloc_urb(0, GFP_KERNEL);
513 if (!bcn_priv->guardian_urb)
514 return -ENOMEM;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700515 }
516
517 return 0;
518}
519
520static void rt2x00usb_free_urb(struct rt2x00_dev *rt2x00dev,
Ivo van Doorn181d6902008-02-05 16:42:23 -0500521 struct data_queue *queue)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700522{
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200523 struct queue_entry_priv_usb *entry_priv;
524 struct queue_entry_priv_usb_bcn *bcn_priv;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700525 unsigned int i;
526
Ivo van Doorn181d6902008-02-05 16:42:23 -0500527 if (!queue->entries)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700528 return;
529
Ivo van Doorn181d6902008-02-05 16:42:23 -0500530 for (i = 0; i < queue->limit; i++) {
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200531 entry_priv = queue->entries[i].priv_data;
532 usb_kill_urb(entry_priv->urb);
533 usb_free_urb(entry_priv->urb);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700534 }
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200535
536 /*
537 * If this is not the beacon queue or
538 * no guardian byte was required for the beacon,
539 * then we are done.
540 */
541 if (rt2x00dev->bcn != queue ||
542 !test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
543 return;
544
545 for (i = 0; i < queue->limit; i++) {
546 bcn_priv = queue->entries[i].priv_data;
547 usb_kill_urb(bcn_priv->guardian_urb);
548 usb_free_urb(bcn_priv->guardian_urb);
549 }
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700550}
551
552int rt2x00usb_initialize(struct rt2x00_dev *rt2x00dev)
553{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500554 struct data_queue *queue;
Gertjan van Wingerde30caa6e2008-06-16 19:56:08 +0200555 int status;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700556
557 /*
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100558 * Find endpoints for each queue
559 */
560 status = rt2x00usb_find_endpoints(rt2x00dev);
561 if (status)
562 goto exit;
563
564 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700565 * Allocate DMA
566 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500567 queue_for_each(rt2x00dev, queue) {
568 status = rt2x00usb_alloc_urb(rt2x00dev, queue);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700569 if (status)
570 goto exit;
571 }
572
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700573 return 0;
574
575exit:
576 rt2x00usb_uninitialize(rt2x00dev);
577
578 return status;
579}
580EXPORT_SYMBOL_GPL(rt2x00usb_initialize);
581
582void rt2x00usb_uninitialize(struct rt2x00_dev *rt2x00dev)
583{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500584 struct data_queue *queue;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700585
Ivo van Doorn181d6902008-02-05 16:42:23 -0500586 queue_for_each(rt2x00dev, queue)
587 rt2x00usb_free_urb(rt2x00dev, queue);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700588}
589EXPORT_SYMBOL_GPL(rt2x00usb_uninitialize);
590
591/*
592 * USB driver handlers.
593 */
594static void rt2x00usb_free_reg(struct rt2x00_dev *rt2x00dev)
595{
596 kfree(rt2x00dev->rf);
597 rt2x00dev->rf = NULL;
598
599 kfree(rt2x00dev->eeprom);
600 rt2x00dev->eeprom = NULL;
601
Ivo van Doorn21795092008-02-10 22:49:13 +0100602 kfree(rt2x00dev->csr.cache);
603 rt2x00dev->csr.cache = NULL;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700604}
605
606static int rt2x00usb_alloc_reg(struct rt2x00_dev *rt2x00dev)
607{
Ivo van Doorn21795092008-02-10 22:49:13 +0100608 rt2x00dev->csr.cache = kzalloc(CSR_CACHE_SIZE, GFP_KERNEL);
609 if (!rt2x00dev->csr.cache)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700610 goto exit;
611
612 rt2x00dev->eeprom = kzalloc(rt2x00dev->ops->eeprom_size, GFP_KERNEL);
613 if (!rt2x00dev->eeprom)
614 goto exit;
615
616 rt2x00dev->rf = kzalloc(rt2x00dev->ops->rf_size, GFP_KERNEL);
617 if (!rt2x00dev->rf)
618 goto exit;
619
620 return 0;
621
622exit:
623 ERROR_PROBE("Failed to allocate registers.\n");
624
625 rt2x00usb_free_reg(rt2x00dev);
626
627 return -ENOMEM;
628}
629
630int rt2x00usb_probe(struct usb_interface *usb_intf,
631 const struct usb_device_id *id)
632{
633 struct usb_device *usb_dev = interface_to_usbdev(usb_intf);
634 struct rt2x00_ops *ops = (struct rt2x00_ops *)id->driver_info;
635 struct ieee80211_hw *hw;
636 struct rt2x00_dev *rt2x00dev;
637 int retval;
638
639 usb_dev = usb_get_dev(usb_dev);
640
641 hw = ieee80211_alloc_hw(sizeof(struct rt2x00_dev), ops->hw);
642 if (!hw) {
643 ERROR_PROBE("Failed to allocate hardware.\n");
644 retval = -ENOMEM;
645 goto exit_put_device;
646 }
647
648 usb_set_intfdata(usb_intf, hw);
649
650 rt2x00dev = hw->priv;
Gertjan van Wingerde14a3bf82008-06-16 19:55:43 +0200651 rt2x00dev->dev = &usb_intf->dev;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700652 rt2x00dev->ops = ops;
653 rt2x00dev->hw = hw;
654
Gertjan van Wingerde2015d192009-11-08 12:30:14 +0100655 rt2x00_set_chip_intf(rt2x00dev, RT2X00_CHIP_INTF_USB);
656
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700657 retval = rt2x00usb_alloc_reg(rt2x00dev);
658 if (retval)
659 goto exit_free_device;
660
661 retval = rt2x00lib_probe_dev(rt2x00dev);
662 if (retval)
663 goto exit_free_reg;
664
665 return 0;
666
667exit_free_reg:
668 rt2x00usb_free_reg(rt2x00dev);
669
670exit_free_device:
671 ieee80211_free_hw(hw);
672
673exit_put_device:
674 usb_put_dev(usb_dev);
675
676 usb_set_intfdata(usb_intf, NULL);
677
678 return retval;
679}
680EXPORT_SYMBOL_GPL(rt2x00usb_probe);
681
682void rt2x00usb_disconnect(struct usb_interface *usb_intf)
683{
684 struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
685 struct rt2x00_dev *rt2x00dev = hw->priv;
686
687 /*
688 * Free all allocated data.
689 */
690 rt2x00lib_remove_dev(rt2x00dev);
691 rt2x00usb_free_reg(rt2x00dev);
692 ieee80211_free_hw(hw);
693
694 /*
695 * Free the USB device data.
696 */
697 usb_set_intfdata(usb_intf, NULL);
698 usb_put_dev(interface_to_usbdev(usb_intf));
699}
700EXPORT_SYMBOL_GPL(rt2x00usb_disconnect);
701
702#ifdef CONFIG_PM
703int rt2x00usb_suspend(struct usb_interface *usb_intf, pm_message_t state)
704{
705 struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
706 struct rt2x00_dev *rt2x00dev = hw->priv;
707 int retval;
708
709 retval = rt2x00lib_suspend(rt2x00dev, state);
710 if (retval)
711 return retval;
712
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700713 /*
714 * Decrease usbdev refcount.
715 */
716 usb_put_dev(interface_to_usbdev(usb_intf));
717
718 return 0;
719}
720EXPORT_SYMBOL_GPL(rt2x00usb_suspend);
721
722int rt2x00usb_resume(struct usb_interface *usb_intf)
723{
724 struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
725 struct rt2x00_dev *rt2x00dev = hw->priv;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700726
727 usb_get_dev(interface_to_usbdev(usb_intf));
728
Ivo van Doorn499a2142009-03-28 20:51:58 +0100729 return rt2x00lib_resume(rt2x00dev);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700730}
731EXPORT_SYMBOL_GPL(rt2x00usb_resume);
732#endif /* CONFIG_PM */
733
734/*
Ivo van Doorn181d6902008-02-05 16:42:23 -0500735 * rt2x00usb module information.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700736 */
737MODULE_AUTHOR(DRV_PROJECT);
738MODULE_VERSION(DRV_VERSION);
Ivo van Doorn181d6902008-02-05 16:42:23 -0500739MODULE_DESCRIPTION("rt2x00 usb library");
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700740MODULE_LICENSE("GPL");