blob: f9a7f8b1741134e57e840ea01baa0bb4ace149b8 [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 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700201 * Obtain the status about this packet.
Ivo van Doornfb55f4d12008-05-10 13:42:06 +0200202 * Note that when the status is 0 it does not mean the
203 * frame was send out correctly. It only means the frame
204 * was succesfully pushed to the hardware, we have no
205 * way to determine the transmission status right now.
206 * (Only indirectly by looking at the failed TX counters
207 * in the register).
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700208 */
Jochen Friedrichf126cba2008-08-15 14:47:46 +0200209 txdesc.flags = 0;
Ivo van Doornfb55f4d12008-05-10 13:42:06 +0200210 if (!urb->status)
211 __set_bit(TXDONE_UNKNOWN, &txdesc.flags);
212 else
213 __set_bit(TXDONE_FAILURE, &txdesc.flags);
Ivo van Doorn181d6902008-02-05 16:42:23 -0500214 txdesc.retry = 0;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700215
Ivo van Doorn181d6902008-02-05 16:42:23 -0500216 rt2x00lib_txdone(entry, &txdesc);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700217}
218
Ivo van Doorn6db37862008-06-06 22:50:28 +0200219int rt2x00usb_write_tx_data(struct queue_entry *entry)
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");