blob: acf3282fc13e10aca74932705c9b8e5fb5083736 [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>
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 Doornc1d35df2008-06-16 19:57:11 +020043 struct usb_device *usb_dev = to_usb_device_intf(rt2x00dev->dev);
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
Sean Cross66f84d62009-11-05 20:22:03 +010050 if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
51 return -ENODEV;
Adam Baker3d823462007-10-27 13:43:29 +020052
Ivo van Doorn95ea3622007-09-25 17:57:13 -070053 for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
54 status = usb_control_msg(usb_dev, pipe, request, requesttype,
55 value, offset, buffer, buffer_length,
56 timeout);
57 if (status >= 0)
58 return 0;
59
60 /*
Ivo van Doorne9136552007-09-25 20:54:20 +020061 * Check for errors
Ivo van Doorn95ea3622007-09-25 17:57:13 -070062 * -ENODEV: Device has disappeared, no point continuing.
Ivo van Doorne9136552007-09-25 20:54:20 +020063 * All other errors: Try again.
Ivo van Doorn95ea3622007-09-25 17:57:13 -070064 */
Sean Cross66f84d62009-11-05 20:22:03 +010065 else if (status == -ENODEV) {
66 clear_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags);
Ivo van Doorn95ea3622007-09-25 17:57:13 -070067 break;
Sean Cross66f84d62009-11-05 20:22:03 +010068 }
Ivo van Doorn95ea3622007-09-25 17:57:13 -070069 }
70
71 ERROR(rt2x00dev,
72 "Vendor Request 0x%02x failed for offset 0x%04x with error %d.\n",
73 request, offset, status);
74
75 return status;
76}
77EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request);
78
Adam Baker3d823462007-10-27 13:43:29 +020079int rt2x00usb_vendor_req_buff_lock(struct rt2x00_dev *rt2x00dev,
80 const u8 request, const u8 requesttype,
81 const u16 offset, void *buffer,
82 const u16 buffer_length, const int timeout)
Ivo van Doorn95ea3622007-09-25 17:57:13 -070083{
84 int status;
85
Ivo van Doorn8ff48a82008-11-09 23:40:46 +010086 BUG_ON(!mutex_is_locked(&rt2x00dev->csr_mutex));
Adam Baker3d823462007-10-27 13:43:29 +020087
Ivo van Doorn95ea3622007-09-25 17:57:13 -070088 /*
89 * Check for Cache availability.
90 */
Ivo van Doorn21795092008-02-10 22:49:13 +010091 if (unlikely(!rt2x00dev->csr.cache || buffer_length > CSR_CACHE_SIZE)) {
Ivo van Doorn95ea3622007-09-25 17:57:13 -070092 ERROR(rt2x00dev, "CSR cache not available.\n");
93 return -ENOMEM;
94 }
95
96 if (requesttype == USB_VENDOR_REQUEST_OUT)
Ivo van Doorn21795092008-02-10 22:49:13 +010097 memcpy(rt2x00dev->csr.cache, buffer, buffer_length);
Ivo van Doorn95ea3622007-09-25 17:57:13 -070098
99 status = rt2x00usb_vendor_request(rt2x00dev, request, requesttype,
Ivo van Doorn21795092008-02-10 22:49:13 +0100100 offset, 0, rt2x00dev->csr.cache,
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700101 buffer_length, timeout);
102
103 if (!status && requesttype == USB_VENDOR_REQUEST_IN)
Ivo van Doorn21795092008-02-10 22:49:13 +0100104 memcpy(buffer, rt2x00dev->csr.cache, buffer_length);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700105
106 return status;
107}
Adam Baker3d823462007-10-27 13:43:29 +0200108EXPORT_SYMBOL_GPL(rt2x00usb_vendor_req_buff_lock);
109
110int rt2x00usb_vendor_request_buff(struct rt2x00_dev *rt2x00dev,
111 const u8 request, const u8 requesttype,
112 const u16 offset, void *buffer,
113 const u16 buffer_length, const int timeout)
114{
115 int status;
116
Ivo van Doorn8ff48a82008-11-09 23:40:46 +0100117 mutex_lock(&rt2x00dev->csr_mutex);
Adam Baker3d823462007-10-27 13:43:29 +0200118
119 status = rt2x00usb_vendor_req_buff_lock(rt2x00dev, request,
120 requesttype, offset, buffer,
121 buffer_length, timeout);
122
Ivo van Doorn8ff48a82008-11-09 23:40:46 +0100123 mutex_unlock(&rt2x00dev->csr_mutex);
Adam Baker3d823462007-10-27 13:43:29 +0200124
125 return status;
126}
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700127EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_buff);
128
Iwo Merglered0dbee2008-07-19 16:16:54 +0200129int rt2x00usb_vendor_request_large_buff(struct rt2x00_dev *rt2x00dev,
130 const u8 request, const u8 requesttype,
Ivo van Doorn82f97b82008-08-02 01:31:09 -0700131 const u16 offset, const void *buffer,
Iwo Merglered0dbee2008-07-19 16:16:54 +0200132 const u16 buffer_length,
133 const int timeout)
134{
135 int status = 0;
136 unsigned char *tb;
137 u16 off, len, bsize;
138
Ivo van Doorn8ff48a82008-11-09 23:40:46 +0100139 mutex_lock(&rt2x00dev->csr_mutex);
Iwo Merglered0dbee2008-07-19 16:16:54 +0200140
Ivo van Doorn82f97b82008-08-02 01:31:09 -0700141 tb = (char *)buffer;
Iwo Merglered0dbee2008-07-19 16:16:54 +0200142 off = offset;
143 len = buffer_length;
144 while (len && !status) {
145 bsize = min_t(u16, CSR_CACHE_SIZE, len);
146 status = rt2x00usb_vendor_req_buff_lock(rt2x00dev, request,
147 requesttype, off, tb,
148 bsize, timeout);
149
150 tb += bsize;
151 len -= bsize;
152 off += bsize;
153 }
154
Ivo van Doorn8ff48a82008-11-09 23:40:46 +0100155 mutex_unlock(&rt2x00dev->csr_mutex);
Iwo Merglered0dbee2008-07-19 16:16:54 +0200156
157 return status;
158}
159EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_large_buff);
160
Ivo van Doorn0f829b12008-11-10 19:42:18 +0100161int rt2x00usb_regbusy_read(struct rt2x00_dev *rt2x00dev,
162 const unsigned int offset,
Bartlomiej Zolnierkiewiczf255b922009-11-04 18:35:18 +0100163 const struct rt2x00_field32 field,
Ivo van Doorn0f829b12008-11-10 19:42:18 +0100164 u32 *reg)
165{
166 unsigned int i;
167
Sean Cross66f84d62009-11-05 20:22:03 +0100168 if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
169 return -ENODEV;
170
Ivo van Doorn0f829b12008-11-10 19:42:18 +0100171 for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
172 rt2x00usb_register_read_lock(rt2x00dev, offset, reg);
173 if (!rt2x00_get_field32(*reg, field))
174 return 1;
175 udelay(REGISTER_BUSY_DELAY);
176 }
177
178 ERROR(rt2x00dev, "Indirect register access failed: "
179 "offset=0x%.08x, value=0x%.08x\n", offset, *reg);
180 *reg = ~0;
181
182 return 0;
183}
184EXPORT_SYMBOL_GPL(rt2x00usb_regbusy_read);
185
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700186/*
187 * TX data handlers.
188 */
189static void rt2x00usb_interrupt_txdone(struct urb *urb)
190{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500191 struct queue_entry *entry = (struct queue_entry *)urb->context;
192 struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500193 struct txdone_entry_desc txdesc;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700194
Ivo van Doorn0262ab02008-08-29 21:04:26 +0200195 if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags) ||
Ivo van Doornd74f5ba2008-06-16 19:56:54 +0200196 !test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700197 return;
198
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700199 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700200 * Obtain the status about this packet.
Ivo van Doornfb55f4d2008-05-10 13:42:06 +0200201 * Note that when the status is 0 it does not mean the
202 * frame was send out correctly. It only means the frame
203 * was succesfully pushed to the hardware, we have no
204 * way to determine the transmission status right now.
205 * (Only indirectly by looking at the failed TX counters
206 * in the register).
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700207 */
Jochen Friedrichf126cba2008-08-15 14:47:46 +0200208 txdesc.flags = 0;
Ivo van Doornfb55f4d2008-05-10 13:42:06 +0200209 if (!urb->status)
210 __set_bit(TXDONE_UNKNOWN, &txdesc.flags);
211 else
212 __set_bit(TXDONE_FAILURE, &txdesc.flags);
Ivo van Doorn181d6902008-02-05 16:42:23 -0500213 txdesc.retry = 0;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700214
Ivo van Doorn181d6902008-02-05 16:42:23 -0500215 rt2x00lib_txdone(entry, &txdesc);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700216}
217
Helmut Schaa41086692010-04-15 09:13:13 +0200218int rt2x00usb_write_tx_data(struct queue_entry *entry,
219 struct txentry_desc *txdesc)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700220{
Ivo van Doorn6db37862008-06-06 22:50:28 +0200221 struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
Ivo van Doornc1d35df2008-06-16 19:57:11 +0200222 struct usb_device *usb_dev = to_usb_device_intf(rt2x00dev->dev);
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200223 struct queue_entry_priv_usb *entry_priv = entry->priv_data;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500224 struct skb_frame_desc *skbdesc;
Ivo van Doorndd9fa2d2007-10-06 14:15:46 +0200225 u32 length;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700226
Ivo van Doorn7050ec82008-05-10 13:46:13 +0200227 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700228 * Add the descriptor in front of the skb.
229 */
Ivo van Doorn6db37862008-06-06 22:50:28 +0200230 skb_push(entry->skb, entry->queue->desc_size);
231 memset(entry->skb->data, 0, entry->queue->desc_size);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700232
Ivo van Doorn08992f72008-01-24 01:56:25 -0800233 /*
234 * Fill in skb descriptor
235 */
Ivo van Doorn6db37862008-06-06 22:50:28 +0200236 skbdesc = get_skb_frame_desc(entry->skb);
Ivo van Doorn6db37862008-06-06 22:50:28 +0200237 skbdesc->desc = entry->skb->data;
238 skbdesc->desc_len = entry->queue->desc_size;
Ivo van Doorn08992f72008-01-24 01:56:25 -0800239
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700240 /*
Ivo van Doorndd9fa2d2007-10-06 14:15:46 +0200241 * USB devices cannot blindly pass the skb->len as the
242 * length of the data to usb_fill_bulk_urb. Pass the skb
243 * to the driver to determine what the length should be.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700244 */
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100245 length = rt2x00dev->ops->lib->get_tx_data_len(entry);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700246
Ivo van Doorn6db37862008-06-06 22:50:28 +0200247 usb_fill_bulk_urb(entry_priv->urb, usb_dev,
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100248 usb_sndbulkpipe(usb_dev, entry->queue->usb_endpoint),
Ivo van Doorn6db37862008-06-06 22:50:28 +0200249 entry->skb->data, length,
250 rt2x00usb_interrupt_txdone, entry);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700251
Mattias Nissler1abc3652008-08-29 21:07:20 +0200252 /*
253 * Make sure the skb->data pointer points to the frame, not the
254 * descriptor.
255 */
256 skb_pull(entry->skb, entry->queue->desc_size);
257
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700258 return 0;
259}
260EXPORT_SYMBOL_GPL(rt2x00usb_write_tx_data);
261
Ivo van Doornf019d512008-06-06 22:47:39 +0200262static inline void rt2x00usb_kick_tx_entry(struct queue_entry *entry)
263{
264 struct queue_entry_priv_usb *entry_priv = entry->priv_data;
265
Ivo van Doorn0262ab02008-08-29 21:04:26 +0200266 if (test_and_clear_bit(ENTRY_DATA_PENDING, &entry->flags))
Ivo van Doornf019d512008-06-06 22:47:39 +0200267 usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
268}
269
270void rt2x00usb_kick_tx_queue(struct rt2x00_dev *rt2x00dev,
271 const enum data_queue_qid qid)
272{
273 struct data_queue *queue = rt2x00queue_get_queue(rt2x00dev, qid);
274 unsigned long irqflags;
275 unsigned int index;
276 unsigned int index_done;
277 unsigned int i;
278
279 /*
280 * Only protect the range we are going to loop over,
281 * if during our loop a extra entry is set to pending
282 * it should not be kicked during this run, since it
283 * is part of another TX operation.
284 */
285 spin_lock_irqsave(&queue->lock, irqflags);
286 index = queue->index[Q_INDEX];
287 index_done = queue->index[Q_INDEX_DONE];
288 spin_unlock_irqrestore(&queue->lock, irqflags);
289
290 /*
291 * Start from the TX done pointer, this guarentees that we will
292 * send out all frames in the correct order.
293 */
294 if (index_done < index) {
295 for (i = index_done; i < index; i++)
296 rt2x00usb_kick_tx_entry(&queue->entries[i]);
297 } else {
298 for (i = index_done; i < queue->limit; i++)
299 rt2x00usb_kick_tx_entry(&queue->entries[i]);
300
301 for (i = 0; i < index; i++)
302 rt2x00usb_kick_tx_entry(&queue->entries[i]);
303 }
304}
305EXPORT_SYMBOL_GPL(rt2x00usb_kick_tx_queue);
306
Ivo van Doorna2c9b652009-01-28 00:32:33 +0100307void rt2x00usb_kill_tx_queue(struct rt2x00_dev *rt2x00dev,
308 const enum data_queue_qid qid)
309{
310 struct data_queue *queue = rt2x00queue_get_queue(rt2x00dev, qid);
311 struct queue_entry_priv_usb *entry_priv;
312 struct queue_entry_priv_usb_bcn *bcn_priv;
313 unsigned int i;
314 bool kill_guard;
315
316 /*
317 * When killing the beacon queue, we must also kill
318 * the beacon guard byte.
319 */
320 kill_guard =
321 (qid == QID_BEACON) &&
322 (test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags));
323
324 /*
325 * Cancel all entries.
326 */
327 for (i = 0; i < queue->limit; i++) {
328 entry_priv = queue->entries[i].priv_data;
329 usb_kill_urb(entry_priv->urb);
330
331 /*
332 * Kill guardian urb (if required by driver).
333 */
334 if (kill_guard) {
335 bcn_priv = queue->entries[i].priv_data;
336 usb_kill_urb(bcn_priv->guardian_urb);
337 }
338 }
339}
340EXPORT_SYMBOL_GPL(rt2x00usb_kill_tx_queue);
341
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700342/*
343 * RX data handlers.
344 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500345static void rt2x00usb_interrupt_rxdone(struct urb *urb)
346{
347 struct queue_entry *entry = (struct queue_entry *)urb->context;
348 struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
Gertjan van Wingerdec4da0042008-06-16 19:56:31 +0200349 struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
Gertjan van Wingerdea26cbc62008-06-06 22:54:28 +0200350 u8 rxd[32];
Ivo van Doorn181d6902008-02-05 16:42:23 -0500351
Ivo van Doorn0262ab02008-08-29 21:04:26 +0200352 if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags) ||
Ivo van Doornd74f5ba2008-06-16 19:56:54 +0200353 !test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
Ivo van Doorn181d6902008-02-05 16:42:23 -0500354 return;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700355
356 /*
Ivo van Doorn181d6902008-02-05 16:42:23 -0500357 * Check if the received data is simply too small
358 * to be actually valid, or if the urb is signaling
359 * a problem.
Ivo van Doorn08992f72008-01-24 01:56:25 -0800360 */
Ivo van Doornd74f5ba2008-06-16 19:56:54 +0200361 if (urb->actual_length < entry->queue->desc_size || urb->status) {
Ivo van Doorn0262ab02008-08-29 21:04:26 +0200362 set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
Ivo van Doornd74f5ba2008-06-16 19:56:54 +0200363 usb_submit_urb(urb, GFP_ATOMIC);
364 return;
365 }
Ivo van Doorn181d6902008-02-05 16:42:23 -0500366
367 /*
Gertjan van Wingerdec4da0042008-06-16 19:56:31 +0200368 * Fill in desc fields of the skb descriptor
Ivo van Doorn181d6902008-02-05 16:42:23 -0500369 */
Gertjan van Wingerdea26cbc62008-06-06 22:54:28 +0200370 skbdesc->desc = rxd;
371 skbdesc->desc_len = entry->queue->desc_size;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500372
Ivo van Doorn08992f72008-01-24 01:56:25 -0800373 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700374 * Send the frame to rt2x00lib for further processing.
375 */
Gertjan van Wingerdec4da0042008-06-16 19:56:31 +0200376 rt2x00lib_rxdone(rt2x00dev, entry);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700377}
378
379/*
380 * Radio handlers
381 */
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700382void rt2x00usb_disable_radio(struct rt2x00_dev *rt2x00dev)
383{
Ivo van Doornbd394a72008-04-21 19:01:58 +0200384 rt2x00usb_vendor_request_sw(rt2x00dev, USB_RX_CONTROL, 0, 0,
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700385 REGISTER_TIMEOUT);
386
387 /*
Ivo van Doorna2c9b652009-01-28 00:32:33 +0100388 * The USB version of kill_tx_queue also works
389 * on the RX queue.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700390 */
Ivo van Doorna2c9b652009-01-28 00:32:33 +0100391 rt2x00dev->ops->lib->kill_tx_queue(rt2x00dev, QID_RX);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700392}
393EXPORT_SYMBOL_GPL(rt2x00usb_disable_radio);
394
395/*
396 * Device initialization handlers.
397 */
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100398void rt2x00usb_clear_entry(struct queue_entry *entry)
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100399{
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100400 struct usb_device *usb_dev =
401 to_usb_device_intf(entry->queue->rt2x00dev->dev);
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200402 struct queue_entry_priv_usb *entry_priv = entry->priv_data;
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100403 int pipe;
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100404
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100405 if (entry->queue->qid == QID_RX) {
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100406 pipe = usb_rcvbulkpipe(usb_dev, entry->queue->usb_endpoint);
407 usb_fill_bulk_urb(entry_priv->urb, usb_dev, pipe,
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100408 entry->skb->data, entry->skb->len,
409 rt2x00usb_interrupt_rxdone, entry);
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100410
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100411 set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
412 usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
413 } else {
414 entry->flags = 0;
415 }
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100416}
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100417EXPORT_SYMBOL_GPL(rt2x00usb_clear_entry);
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100418
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100419static void rt2x00usb_assign_endpoint(struct data_queue *queue,
420 struct usb_endpoint_descriptor *ep_desc)
421{
422 struct usb_device *usb_dev = to_usb_device_intf(queue->rt2x00dev->dev);
423 int pipe;
424
425 queue->usb_endpoint = usb_endpoint_num(ep_desc);
426
427 if (queue->qid == QID_RX) {
428 pipe = usb_rcvbulkpipe(usb_dev, queue->usb_endpoint);
429 queue->usb_maxpacket = usb_maxpacket(usb_dev, pipe, 0);
430 } else {
431 pipe = usb_sndbulkpipe(usb_dev, queue->usb_endpoint);
432 queue->usb_maxpacket = usb_maxpacket(usb_dev, pipe, 1);
433 }
434
435 if (!queue->usb_maxpacket)
436 queue->usb_maxpacket = 1;
437}
438
439static int rt2x00usb_find_endpoints(struct rt2x00_dev *rt2x00dev)
440{
441 struct usb_interface *intf = to_usb_interface(rt2x00dev->dev);
442 struct usb_host_interface *intf_desc = intf->cur_altsetting;
443 struct usb_endpoint_descriptor *ep_desc;
444 struct data_queue *queue = rt2x00dev->tx;
445 struct usb_endpoint_descriptor *tx_ep_desc = NULL;
446 unsigned int i;
447
448 /*
449 * Walk through all available endpoints to search for "bulk in"
450 * and "bulk out" endpoints. When we find such endpoints collect
451 * the information we need from the descriptor and assign it
452 * to the queue.
453 */
454 for (i = 0; i < intf_desc->desc.bNumEndpoints; i++) {
455 ep_desc = &intf_desc->endpoint[i].desc;
456
457 if (usb_endpoint_is_bulk_in(ep_desc)) {
458 rt2x00usb_assign_endpoint(rt2x00dev->rx, ep_desc);
Ivo van Doornd15cfc32008-12-20 11:00:23 +0100459 } else if (usb_endpoint_is_bulk_out(ep_desc) &&
460 (queue != queue_end(rt2x00dev))) {
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100461 rt2x00usb_assign_endpoint(queue, ep_desc);
Ivo van Doornd15cfc32008-12-20 11:00:23 +0100462 queue = queue_next(queue);
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100463
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100464 tx_ep_desc = ep_desc;
465 }
466 }
467
468 /*
469 * At least 1 endpoint for RX and 1 endpoint for TX must be available.
470 */
471 if (!rt2x00dev->rx->usb_endpoint || !rt2x00dev->tx->usb_endpoint) {
472 ERROR(rt2x00dev, "Bulk-in/Bulk-out endpoints not found\n");
473 return -EPIPE;
474 }
475
476 /*
477 * It might be possible not all queues have a dedicated endpoint.
478 * Loop through all TX queues and copy the endpoint information
479 * which we have gathered from already assigned endpoints.
480 */
481 txall_queue_for_each(rt2x00dev, queue) {
482 if (!queue->usb_endpoint)
483 rt2x00usb_assign_endpoint(queue, tx_ep_desc);
484 }
485
486 return 0;
487}
488
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700489static int rt2x00usb_alloc_urb(struct rt2x00_dev *rt2x00dev,
Ivo van Doorn181d6902008-02-05 16:42:23 -0500490 struct data_queue *queue)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700491{
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200492 struct queue_entry_priv_usb *entry_priv;
493 struct queue_entry_priv_usb_bcn *bcn_priv;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700494 unsigned int i;
495
Ivo van Doorn181d6902008-02-05 16:42:23 -0500496 for (i = 0; i < queue->limit; i++) {
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200497 entry_priv = queue->entries[i].priv_data;
498 entry_priv->urb = usb_alloc_urb(0, GFP_KERNEL);
499 if (!entry_priv->urb)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700500 return -ENOMEM;
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200501 }
Ivo van Doorn181d6902008-02-05 16:42:23 -0500502
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200503 /*
504 * If this is not the beacon queue or
505 * no guardian byte was required for the beacon,
506 * then we are done.
507 */
508 if (rt2x00dev->bcn != queue ||
509 !test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
510 return 0;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500511
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200512 for (i = 0; i < queue->limit; i++) {
513 bcn_priv = queue->entries[i].priv_data;
514 bcn_priv->guardian_urb = usb_alloc_urb(0, GFP_KERNEL);
515 if (!bcn_priv->guardian_urb)
516 return -ENOMEM;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700517 }
518
519 return 0;
520}
521
522static void rt2x00usb_free_urb(struct rt2x00_dev *rt2x00dev,
Ivo van Doorn181d6902008-02-05 16:42:23 -0500523 struct data_queue *queue)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700524{
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200525 struct queue_entry_priv_usb *entry_priv;
526 struct queue_entry_priv_usb_bcn *bcn_priv;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700527 unsigned int i;
528
Ivo van Doorn181d6902008-02-05 16:42:23 -0500529 if (!queue->entries)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700530 return;
531
Ivo van Doorn181d6902008-02-05 16:42:23 -0500532 for (i = 0; i < queue->limit; i++) {
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200533 entry_priv = queue->entries[i].priv_data;
534 usb_kill_urb(entry_priv->urb);
535 usb_free_urb(entry_priv->urb);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700536 }
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200537
538 /*
539 * If this is not the beacon queue or
540 * no guardian byte was required for the beacon,
541 * then we are done.
542 */
543 if (rt2x00dev->bcn != queue ||
544 !test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
545 return;
546
547 for (i = 0; i < queue->limit; i++) {
548 bcn_priv = queue->entries[i].priv_data;
549 usb_kill_urb(bcn_priv->guardian_urb);
550 usb_free_urb(bcn_priv->guardian_urb);
551 }
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700552}
553
554int rt2x00usb_initialize(struct rt2x00_dev *rt2x00dev)
555{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500556 struct data_queue *queue;
Gertjan van Wingerde30caa6e2008-06-16 19:56:08 +0200557 int status;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700558
559 /*
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100560 * Find endpoints for each queue
561 */
562 status = rt2x00usb_find_endpoints(rt2x00dev);
563 if (status)
564 goto exit;
565
566 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700567 * Allocate DMA
568 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500569 queue_for_each(rt2x00dev, queue) {
570 status = rt2x00usb_alloc_urb(rt2x00dev, queue);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700571 if (status)
572 goto exit;
573 }
574
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700575 return 0;
576
577exit:
578 rt2x00usb_uninitialize(rt2x00dev);
579
580 return status;
581}
582EXPORT_SYMBOL_GPL(rt2x00usb_initialize);
583
584void rt2x00usb_uninitialize(struct rt2x00_dev *rt2x00dev)
585{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500586 struct data_queue *queue;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700587
Ivo van Doorn181d6902008-02-05 16:42:23 -0500588 queue_for_each(rt2x00dev, queue)
589 rt2x00usb_free_urb(rt2x00dev, queue);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700590}
591EXPORT_SYMBOL_GPL(rt2x00usb_uninitialize);
592
593/*
594 * USB driver handlers.
595 */
596static void rt2x00usb_free_reg(struct rt2x00_dev *rt2x00dev)
597{
598 kfree(rt2x00dev->rf);
599 rt2x00dev->rf = NULL;
600
601 kfree(rt2x00dev->eeprom);
602 rt2x00dev->eeprom = NULL;
603
Ivo van Doorn21795092008-02-10 22:49:13 +0100604 kfree(rt2x00dev->csr.cache);
605 rt2x00dev->csr.cache = NULL;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700606}
607
608static int rt2x00usb_alloc_reg(struct rt2x00_dev *rt2x00dev)
609{
Ivo van Doorn21795092008-02-10 22:49:13 +0100610 rt2x00dev->csr.cache = kzalloc(CSR_CACHE_SIZE, GFP_KERNEL);
611 if (!rt2x00dev->csr.cache)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700612 goto exit;
613
614 rt2x00dev->eeprom = kzalloc(rt2x00dev->ops->eeprom_size, GFP_KERNEL);
615 if (!rt2x00dev->eeprom)
616 goto exit;
617
618 rt2x00dev->rf = kzalloc(rt2x00dev->ops->rf_size, GFP_KERNEL);
619 if (!rt2x00dev->rf)
620 goto exit;
621
622 return 0;
623
624exit:
625 ERROR_PROBE("Failed to allocate registers.\n");
626
627 rt2x00usb_free_reg(rt2x00dev);
628
629 return -ENOMEM;
630}
631
632int rt2x00usb_probe(struct usb_interface *usb_intf,
633 const struct usb_device_id *id)
634{
635 struct usb_device *usb_dev = interface_to_usbdev(usb_intf);
636 struct rt2x00_ops *ops = (struct rt2x00_ops *)id->driver_info;
637 struct ieee80211_hw *hw;
638 struct rt2x00_dev *rt2x00dev;
639 int retval;
640
641 usb_dev = usb_get_dev(usb_dev);
642
643 hw = ieee80211_alloc_hw(sizeof(struct rt2x00_dev), ops->hw);
644 if (!hw) {
645 ERROR_PROBE("Failed to allocate hardware.\n");
646 retval = -ENOMEM;
647 goto exit_put_device;
648 }
649
650 usb_set_intfdata(usb_intf, hw);
651
652 rt2x00dev = hw->priv;
Gertjan van Wingerde14a3bf82008-06-16 19:55:43 +0200653 rt2x00dev->dev = &usb_intf->dev;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700654 rt2x00dev->ops = ops;
655 rt2x00dev->hw = hw;
656
Gertjan van Wingerde2015d192009-11-08 12:30:14 +0100657 rt2x00_set_chip_intf(rt2x00dev, RT2X00_CHIP_INTF_USB);
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
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700715 /*
716 * Decrease usbdev refcount.
717 */
718 usb_put_dev(interface_to_usbdev(usb_intf));
719
720 return 0;
721}
722EXPORT_SYMBOL_GPL(rt2x00usb_suspend);
723
724int rt2x00usb_resume(struct usb_interface *usb_intf)
725{
726 struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
727 struct rt2x00_dev *rt2x00dev = hw->priv;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700728
729 usb_get_dev(interface_to_usbdev(usb_intf));
730
Ivo van Doorn499a2142009-03-28 20:51:58 +0100731 return rt2x00lib_resume(rt2x00dev);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700732}
733EXPORT_SYMBOL_GPL(rt2x00usb_resume);
734#endif /* CONFIG_PM */
735
736/*
Ivo van Doorn181d6902008-02-05 16:42:23 -0500737 * rt2x00usb module information.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700738 */
739MODULE_AUTHOR(DRV_PROJECT);
740MODULE_VERSION(DRV_VERSION);
Ivo van Doorn181d6902008-02-05 16:42:23 -0500741MODULE_DESCRIPTION("rt2x00 usb library");
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700742MODULE_LICENSE("GPL");