blob: 25cc376d388e7e29f0cfee708e7588d6ae8c6e47 [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
Helmut Schaa41086692010-04-15 09:13:13 +0200219int rt2x00usb_write_tx_data(struct queue_entry *entry,
220 struct txentry_desc *txdesc)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700221{
Ivo van Doorn6db37862008-06-06 22:50:28 +0200222 struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
Ivo van Doornc1d35df2008-06-16 19:57:11 +0200223 struct usb_device *usb_dev = to_usb_device_intf(rt2x00dev->dev);
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200224 struct queue_entry_priv_usb *entry_priv = entry->priv_data;
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 /*
Ivo van Doorndd9fa2d2007-10-06 14:15:46 +0200234 * USB devices cannot blindly pass the skb->len as the
235 * length of the data to usb_fill_bulk_urb. Pass the skb
236 * to the driver to determine what the length should be.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700237 */
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100238 length = rt2x00dev->ops->lib->get_tx_data_len(entry);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700239
Ivo van Doorn6db37862008-06-06 22:50:28 +0200240 usb_fill_bulk_urb(entry_priv->urb, usb_dev,
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100241 usb_sndbulkpipe(usb_dev, entry->queue->usb_endpoint),
Ivo van Doorn6db37862008-06-06 22:50:28 +0200242 entry->skb->data, length,
243 rt2x00usb_interrupt_txdone, entry);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700244
Mattias Nissler1abc3652008-08-29 21:07:20 +0200245 /*
246 * Make sure the skb->data pointer points to the frame, not the
247 * descriptor.
248 */
249 skb_pull(entry->skb, entry->queue->desc_size);
250
Gertjan van Wingerdebaaffe62010-06-03 10:51:43 +0200251 /*
252 * Call the driver's write_tx_datadesc function, if it exists.
253 */
254 if (rt2x00dev->ops->lib->write_tx_datadesc)
255 rt2x00dev->ops->lib->write_tx_datadesc(entry, txdesc);
256
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700257 return 0;
258}
259EXPORT_SYMBOL_GPL(rt2x00usb_write_tx_data);
260
Ivo van Doornf019d512008-06-06 22:47:39 +0200261static inline void rt2x00usb_kick_tx_entry(struct queue_entry *entry)
262{
263 struct queue_entry_priv_usb *entry_priv = entry->priv_data;
264
Ivo van Doorn0262ab02008-08-29 21:04:26 +0200265 if (test_and_clear_bit(ENTRY_DATA_PENDING, &entry->flags))
Ivo van Doornf019d512008-06-06 22:47:39 +0200266 usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
267}
268
269void rt2x00usb_kick_tx_queue(struct rt2x00_dev *rt2x00dev,
270 const enum data_queue_qid qid)
271{
272 struct data_queue *queue = rt2x00queue_get_queue(rt2x00dev, qid);
273 unsigned long irqflags;
274 unsigned int index;
275 unsigned int index_done;
276 unsigned int i;
277
278 /*
279 * Only protect the range we are going to loop over,
280 * if during our loop a extra entry is set to pending
281 * it should not be kicked during this run, since it
282 * is part of another TX operation.
283 */
284 spin_lock_irqsave(&queue->lock, irqflags);
285 index = queue->index[Q_INDEX];
286 index_done = queue->index[Q_INDEX_DONE];
287 spin_unlock_irqrestore(&queue->lock, irqflags);
288
289 /*
290 * Start from the TX done pointer, this guarentees that we will
291 * send out all frames in the correct order.
292 */
293 if (index_done < index) {
294 for (i = index_done; i < index; i++)
295 rt2x00usb_kick_tx_entry(&queue->entries[i]);
296 } else {
297 for (i = index_done; i < queue->limit; i++)
298 rt2x00usb_kick_tx_entry(&queue->entries[i]);
299
300 for (i = 0; i < index; i++)
301 rt2x00usb_kick_tx_entry(&queue->entries[i]);
302 }
303}
304EXPORT_SYMBOL_GPL(rt2x00usb_kick_tx_queue);
305
Ivo van Doorna2c9b652009-01-28 00:32:33 +0100306void rt2x00usb_kill_tx_queue(struct rt2x00_dev *rt2x00dev,
307 const enum data_queue_qid qid)
308{
309 struct data_queue *queue = rt2x00queue_get_queue(rt2x00dev, qid);
310 struct queue_entry_priv_usb *entry_priv;
311 struct queue_entry_priv_usb_bcn *bcn_priv;
312 unsigned int i;
313 bool kill_guard;
314
315 /*
316 * When killing the beacon queue, we must also kill
317 * the beacon guard byte.
318 */
319 kill_guard =
320 (qid == QID_BEACON) &&
321 (test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags));
322
323 /*
324 * Cancel all entries.
325 */
326 for (i = 0; i < queue->limit; i++) {
327 entry_priv = queue->entries[i].priv_data;
328 usb_kill_urb(entry_priv->urb);
329
330 /*
331 * Kill guardian urb (if required by driver).
332 */
333 if (kill_guard) {
334 bcn_priv = queue->entries[i].priv_data;
335 usb_kill_urb(bcn_priv->guardian_urb);
336 }
337 }
338}
339EXPORT_SYMBOL_GPL(rt2x00usb_kill_tx_queue);
340
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700341/*
342 * RX data handlers.
343 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500344static void rt2x00usb_interrupt_rxdone(struct urb *urb)
345{
346 struct queue_entry *entry = (struct queue_entry *)urb->context;
347 struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
Gertjan van Wingerdec4da0042008-06-16 19:56:31 +0200348 struct skb_frame_desc *skbdesc = get_skb_frame_desc(entry->skb);
Gertjan van Wingerdea26cbc62008-06-06 22:54:28 +0200349 u8 rxd[32];
Ivo van Doorn181d6902008-02-05 16:42:23 -0500350
Ivo van Doorn0262ab02008-08-29 21:04:26 +0200351 if (!test_bit(DEVICE_STATE_ENABLED_RADIO, &rt2x00dev->flags) ||
Ivo van Doornd74f5ba2008-06-16 19:56:54 +0200352 !test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
Ivo van Doorn181d6902008-02-05 16:42:23 -0500353 return;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700354
355 /*
Ivo van Doorn181d6902008-02-05 16:42:23 -0500356 * Check if the received data is simply too small
357 * to be actually valid, or if the urb is signaling
358 * a problem.
Ivo van Doorn08992f72008-01-24 01:56:25 -0800359 */
Ivo van Doornd74f5ba2008-06-16 19:56:54 +0200360 if (urb->actual_length < entry->queue->desc_size || urb->status) {
Ivo van Doorn0262ab02008-08-29 21:04:26 +0200361 set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
Ivo van Doornd74f5ba2008-06-16 19:56:54 +0200362 usb_submit_urb(urb, GFP_ATOMIC);
363 return;
364 }
Ivo van Doorn181d6902008-02-05 16:42:23 -0500365
366 /*
Gertjan van Wingerdec4da0042008-06-16 19:56:31 +0200367 * Fill in desc fields of the skb descriptor
Ivo van Doorn181d6902008-02-05 16:42:23 -0500368 */
Gertjan van Wingerdea26cbc62008-06-06 22:54:28 +0200369 skbdesc->desc = rxd;
370 skbdesc->desc_len = entry->queue->desc_size;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500371
Ivo van Doorn08992f72008-01-24 01:56:25 -0800372 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700373 * Send the frame to rt2x00lib for further processing.
374 */
Gertjan van Wingerdec4da0042008-06-16 19:56:31 +0200375 rt2x00lib_rxdone(rt2x00dev, entry);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700376}
377
378/*
379 * Radio handlers
380 */
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700381void rt2x00usb_disable_radio(struct rt2x00_dev *rt2x00dev)
382{
Ivo van Doornbd394a72008-04-21 19:01:58 +0200383 rt2x00usb_vendor_request_sw(rt2x00dev, USB_RX_CONTROL, 0, 0,
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700384 REGISTER_TIMEOUT);
385
386 /*
Ivo van Doorna2c9b652009-01-28 00:32:33 +0100387 * The USB version of kill_tx_queue also works
388 * on the RX queue.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700389 */
Ivo van Doorna2c9b652009-01-28 00:32:33 +0100390 rt2x00dev->ops->lib->kill_tx_queue(rt2x00dev, QID_RX);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700391}
392EXPORT_SYMBOL_GPL(rt2x00usb_disable_radio);
393
394/*
395 * Device initialization handlers.
396 */
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100397void rt2x00usb_clear_entry(struct queue_entry *entry)
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100398{
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100399 struct usb_device *usb_dev =
400 to_usb_device_intf(entry->queue->rt2x00dev->dev);
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200401 struct queue_entry_priv_usb *entry_priv = entry->priv_data;
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100402 int pipe;
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100403
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100404 if (entry->queue->qid == QID_RX) {
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100405 pipe = usb_rcvbulkpipe(usb_dev, entry->queue->usb_endpoint);
406 usb_fill_bulk_urb(entry_priv->urb, usb_dev, pipe,
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100407 entry->skb->data, entry->skb->len,
408 rt2x00usb_interrupt_rxdone, entry);
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100409
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100410 set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
411 usb_submit_urb(entry_priv->urb, GFP_ATOMIC);
412 } else {
413 entry->flags = 0;
414 }
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100415}
Ivo van Doorn798b7ad2008-11-08 15:25:33 +0100416EXPORT_SYMBOL_GPL(rt2x00usb_clear_entry);
Ivo van Doorn837e7f22008-01-06 23:41:45 +0100417
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100418static void rt2x00usb_assign_endpoint(struct data_queue *queue,
419 struct usb_endpoint_descriptor *ep_desc)
420{
421 struct usb_device *usb_dev = to_usb_device_intf(queue->rt2x00dev->dev);
422 int pipe;
423
424 queue->usb_endpoint = usb_endpoint_num(ep_desc);
425
426 if (queue->qid == QID_RX) {
427 pipe = usb_rcvbulkpipe(usb_dev, queue->usb_endpoint);
428 queue->usb_maxpacket = usb_maxpacket(usb_dev, pipe, 0);
429 } else {
430 pipe = usb_sndbulkpipe(usb_dev, queue->usb_endpoint);
431 queue->usb_maxpacket = usb_maxpacket(usb_dev, pipe, 1);
432 }
433
434 if (!queue->usb_maxpacket)
435 queue->usb_maxpacket = 1;
436}
437
438static int rt2x00usb_find_endpoints(struct rt2x00_dev *rt2x00dev)
439{
440 struct usb_interface *intf = to_usb_interface(rt2x00dev->dev);
441 struct usb_host_interface *intf_desc = intf->cur_altsetting;
442 struct usb_endpoint_descriptor *ep_desc;
443 struct data_queue *queue = rt2x00dev->tx;
444 struct usb_endpoint_descriptor *tx_ep_desc = NULL;
445 unsigned int i;
446
447 /*
448 * Walk through all available endpoints to search for "bulk in"
449 * and "bulk out" endpoints. When we find such endpoints collect
450 * the information we need from the descriptor and assign it
451 * to the queue.
452 */
453 for (i = 0; i < intf_desc->desc.bNumEndpoints; i++) {
454 ep_desc = &intf_desc->endpoint[i].desc;
455
456 if (usb_endpoint_is_bulk_in(ep_desc)) {
457 rt2x00usb_assign_endpoint(rt2x00dev->rx, ep_desc);
Ivo van Doornd15cfc32008-12-20 11:00:23 +0100458 } else if (usb_endpoint_is_bulk_out(ep_desc) &&
459 (queue != queue_end(rt2x00dev))) {
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100460 rt2x00usb_assign_endpoint(queue, ep_desc);
Ivo van Doornd15cfc32008-12-20 11:00:23 +0100461 queue = queue_next(queue);
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100462
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100463 tx_ep_desc = ep_desc;
464 }
465 }
466
467 /*
468 * At least 1 endpoint for RX and 1 endpoint for TX must be available.
469 */
470 if (!rt2x00dev->rx->usb_endpoint || !rt2x00dev->tx->usb_endpoint) {
471 ERROR(rt2x00dev, "Bulk-in/Bulk-out endpoints not found\n");
472 return -EPIPE;
473 }
474
475 /*
476 * It might be possible not all queues have a dedicated endpoint.
477 * Loop through all TX queues and copy the endpoint information
478 * which we have gathered from already assigned endpoints.
479 */
480 txall_queue_for_each(rt2x00dev, queue) {
481 if (!queue->usb_endpoint)
482 rt2x00usb_assign_endpoint(queue, tx_ep_desc);
483 }
484
485 return 0;
486}
487
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700488static int rt2x00usb_alloc_urb(struct rt2x00_dev *rt2x00dev,
Ivo van Doorn181d6902008-02-05 16:42:23 -0500489 struct data_queue *queue)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700490{
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200491 struct queue_entry_priv_usb *entry_priv;
492 struct queue_entry_priv_usb_bcn *bcn_priv;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700493 unsigned int i;
494
Ivo van Doorn181d6902008-02-05 16:42:23 -0500495 for (i = 0; i < queue->limit; i++) {
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200496 entry_priv = queue->entries[i].priv_data;
497 entry_priv->urb = usb_alloc_urb(0, GFP_KERNEL);
498 if (!entry_priv->urb)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700499 return -ENOMEM;
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200500 }
Ivo van Doorn181d6902008-02-05 16:42:23 -0500501
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200502 /*
503 * If this is not the beacon queue or
504 * no guardian byte was required for the beacon,
505 * then we are done.
506 */
507 if (rt2x00dev->bcn != queue ||
508 !test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
509 return 0;
Ivo van Doorn181d6902008-02-05 16:42:23 -0500510
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200511 for (i = 0; i < queue->limit; i++) {
512 bcn_priv = queue->entries[i].priv_data;
513 bcn_priv->guardian_urb = usb_alloc_urb(0, GFP_KERNEL);
514 if (!bcn_priv->guardian_urb)
515 return -ENOMEM;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700516 }
517
518 return 0;
519}
520
521static void rt2x00usb_free_urb(struct rt2x00_dev *rt2x00dev,
Ivo van Doorn181d6902008-02-05 16:42:23 -0500522 struct data_queue *queue)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700523{
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200524 struct queue_entry_priv_usb *entry_priv;
525 struct queue_entry_priv_usb_bcn *bcn_priv;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700526 unsigned int i;
527
Ivo van Doorn181d6902008-02-05 16:42:23 -0500528 if (!queue->entries)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700529 return;
530
Ivo van Doorn181d6902008-02-05 16:42:23 -0500531 for (i = 0; i < queue->limit; i++) {
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200532 entry_priv = queue->entries[i].priv_data;
533 usb_kill_urb(entry_priv->urb);
534 usb_free_urb(entry_priv->urb);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700535 }
Ivo van Doornb8be63f2008-05-10 13:46:03 +0200536
537 /*
538 * If this is not the beacon queue or
539 * no guardian byte was required for the beacon,
540 * then we are done.
541 */
542 if (rt2x00dev->bcn != queue ||
543 !test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags))
544 return;
545
546 for (i = 0; i < queue->limit; i++) {
547 bcn_priv = queue->entries[i].priv_data;
548 usb_kill_urb(bcn_priv->guardian_urb);
549 usb_free_urb(bcn_priv->guardian_urb);
550 }
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700551}
552
553int rt2x00usb_initialize(struct rt2x00_dev *rt2x00dev)
554{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500555 struct data_queue *queue;
Gertjan van Wingerde30caa6e2008-06-16 19:56:08 +0200556 int status;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700557
558 /*
Ivo van Doornf1ca2162008-11-13 23:07:33 +0100559 * Find endpoints for each queue
560 */
561 status = rt2x00usb_find_endpoints(rt2x00dev);
562 if (status)
563 goto exit;
564
565 /*
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700566 * Allocate DMA
567 */
Ivo van Doorn181d6902008-02-05 16:42:23 -0500568 queue_for_each(rt2x00dev, queue) {
569 status = rt2x00usb_alloc_urb(rt2x00dev, queue);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700570 if (status)
571 goto exit;
572 }
573
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700574 return 0;
575
576exit:
577 rt2x00usb_uninitialize(rt2x00dev);
578
579 return status;
580}
581EXPORT_SYMBOL_GPL(rt2x00usb_initialize);
582
583void rt2x00usb_uninitialize(struct rt2x00_dev *rt2x00dev)
584{
Ivo van Doorn181d6902008-02-05 16:42:23 -0500585 struct data_queue *queue;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700586
Ivo van Doorn181d6902008-02-05 16:42:23 -0500587 queue_for_each(rt2x00dev, queue)
588 rt2x00usb_free_urb(rt2x00dev, queue);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700589}
590EXPORT_SYMBOL_GPL(rt2x00usb_uninitialize);
591
592/*
593 * USB driver handlers.
594 */
595static void rt2x00usb_free_reg(struct rt2x00_dev *rt2x00dev)
596{
597 kfree(rt2x00dev->rf);
598 rt2x00dev->rf = NULL;
599
600 kfree(rt2x00dev->eeprom);
601 rt2x00dev->eeprom = NULL;
602
Ivo van Doorn21795092008-02-10 22:49:13 +0100603 kfree(rt2x00dev->csr.cache);
604 rt2x00dev->csr.cache = NULL;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700605}
606
607static int rt2x00usb_alloc_reg(struct rt2x00_dev *rt2x00dev)
608{
Ivo van Doorn21795092008-02-10 22:49:13 +0100609 rt2x00dev->csr.cache = kzalloc(CSR_CACHE_SIZE, GFP_KERNEL);
610 if (!rt2x00dev->csr.cache)
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700611 goto exit;
612
613 rt2x00dev->eeprom = kzalloc(rt2x00dev->ops->eeprom_size, GFP_KERNEL);
614 if (!rt2x00dev->eeprom)
615 goto exit;
616
617 rt2x00dev->rf = kzalloc(rt2x00dev->ops->rf_size, GFP_KERNEL);
618 if (!rt2x00dev->rf)
619 goto exit;
620
621 return 0;
622
623exit:
624 ERROR_PROBE("Failed to allocate registers.\n");
625
626 rt2x00usb_free_reg(rt2x00dev);
627
628 return -ENOMEM;
629}
630
631int rt2x00usb_probe(struct usb_interface *usb_intf,
632 const struct usb_device_id *id)
633{
634 struct usb_device *usb_dev = interface_to_usbdev(usb_intf);
635 struct rt2x00_ops *ops = (struct rt2x00_ops *)id->driver_info;
636 struct ieee80211_hw *hw;
637 struct rt2x00_dev *rt2x00dev;
638 int retval;
639
640 usb_dev = usb_get_dev(usb_dev);
641
642 hw = ieee80211_alloc_hw(sizeof(struct rt2x00_dev), ops->hw);
643 if (!hw) {
644 ERROR_PROBE("Failed to allocate hardware.\n");
645 retval = -ENOMEM;
646 goto exit_put_device;
647 }
648
649 usb_set_intfdata(usb_intf, hw);
650
651 rt2x00dev = hw->priv;
Gertjan van Wingerde14a3bf82008-06-16 19:55:43 +0200652 rt2x00dev->dev = &usb_intf->dev;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700653 rt2x00dev->ops = ops;
654 rt2x00dev->hw = hw;
655
Gertjan van Wingerde2015d192009-11-08 12:30:14 +0100656 rt2x00_set_chip_intf(rt2x00dev, RT2X00_CHIP_INTF_USB);
657
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700658 retval = rt2x00usb_alloc_reg(rt2x00dev);
659 if (retval)
660 goto exit_free_device;
661
662 retval = rt2x00lib_probe_dev(rt2x00dev);
663 if (retval)
664 goto exit_free_reg;
665
666 return 0;
667
668exit_free_reg:
669 rt2x00usb_free_reg(rt2x00dev);
670
671exit_free_device:
672 ieee80211_free_hw(hw);
673
674exit_put_device:
675 usb_put_dev(usb_dev);
676
677 usb_set_intfdata(usb_intf, NULL);
678
679 return retval;
680}
681EXPORT_SYMBOL_GPL(rt2x00usb_probe);
682
683void rt2x00usb_disconnect(struct usb_interface *usb_intf)
684{
685 struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
686 struct rt2x00_dev *rt2x00dev = hw->priv;
687
688 /*
689 * Free all allocated data.
690 */
691 rt2x00lib_remove_dev(rt2x00dev);
692 rt2x00usb_free_reg(rt2x00dev);
693 ieee80211_free_hw(hw);
694
695 /*
696 * Free the USB device data.
697 */
698 usb_set_intfdata(usb_intf, NULL);
699 usb_put_dev(interface_to_usbdev(usb_intf));
700}
701EXPORT_SYMBOL_GPL(rt2x00usb_disconnect);
702
703#ifdef CONFIG_PM
704int rt2x00usb_suspend(struct usb_interface *usb_intf, pm_message_t state)
705{
706 struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
707 struct rt2x00_dev *rt2x00dev = hw->priv;
708 int retval;
709
710 retval = rt2x00lib_suspend(rt2x00dev, state);
711 if (retval)
712 return retval;
713
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700714 /*
715 * Decrease usbdev refcount.
716 */
717 usb_put_dev(interface_to_usbdev(usb_intf));
718
719 return 0;
720}
721EXPORT_SYMBOL_GPL(rt2x00usb_suspend);
722
723int rt2x00usb_resume(struct usb_interface *usb_intf)
724{
725 struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
726 struct rt2x00_dev *rt2x00dev = hw->priv;
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700727
728 usb_get_dev(interface_to_usbdev(usb_intf));
729
Ivo van Doorn499a2142009-03-28 20:51:58 +0100730 return rt2x00lib_resume(rt2x00dev);
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700731}
732EXPORT_SYMBOL_GPL(rt2x00usb_resume);
733#endif /* CONFIG_PM */
734
735/*
Ivo van Doorn181d6902008-02-05 16:42:23 -0500736 * rt2x00usb module information.
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700737 */
738MODULE_AUTHOR(DRV_PROJECT);
739MODULE_VERSION(DRV_VERSION);
Ivo van Doorn181d6902008-02-05 16:42:23 -0500740MODULE_DESCRIPTION("rt2x00 usb library");
Ivo van Doorn95ea3622007-09-25 17:57:13 -0700741MODULE_LICENSE("GPL");