rt2x00usb.c 17.3 KB
Newer Older
1
/*
2
	Copyright (C) 2004 - 2008 rt2x00 SourceForge Project
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
	<http://rt2x00.serialmonkey.com>

	This program is free software; you can redistribute it and/or modify
	it under the terms of the GNU General Public License as published by
	the Free Software Foundation; either version 2 of the License, or
	(at your option) any later version.

	This program is distributed in the hope that it will be useful,
	but WITHOUT ANY WARRANTY; without even the implied warranty of
	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	GNU General Public License for more details.

	You should have received a copy of the GNU General Public License
	along with this program; if not, write to the
	Free Software Foundation, Inc.,
	59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 */

/*
	Module: rt2x00usb
	Abstract: rt2x00 generic usb device routines.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/usb.h>
29
#include <linux/bug.h>
30
31
32
33
34
35
36

#include "rt2x00.h"
#include "rt2x00usb.h"

/*
 * Interfacing with the HW.
 */
Adam Baker's avatar
Adam Baker committed
37
int rt2x00usb_vendor_request(struct rt2x00_dev *rt2x00dev,
38
39
40
			     const u8 request, const u8 requesttype,
			     const u16 offset, const u16 value,
			     void *buffer, const u16 buffer_length,
41
			     const int timeout)
42
{
43
	struct usb_device *usb_dev = rt2x00dev_usb_dev(rt2x00dev);
44
45
46
47
48
49
	int status;
	unsigned int i;
	unsigned int pipe =
	    (requesttype == USB_VENDOR_REQUEST_IN) ?
	    usb_rcvctrlpipe(usb_dev, 0) : usb_sndctrlpipe(usb_dev, 0);

50

51
52
53
54
55
56
57
58
	for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
		status = usb_control_msg(usb_dev, pipe, request, requesttype,
					 value, offset, buffer, buffer_length,
					 timeout);
		if (status >= 0)
			return 0;

		/*
59
		 * Check for errors
60
		 * -ENODEV: Device has disappeared, no point continuing.
61
		 * All other errors: Try again.
62
63
64
65
66
67
68
69
70
71
72
73
74
		 */
		else if (status == -ENODEV)
			break;
	}

	ERROR(rt2x00dev,
	      "Vendor Request 0x%02x failed for offset 0x%04x with error %d.\n",
	      request, offset, status);

	return status;
}
EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request);

75
76
77
78
int rt2x00usb_vendor_req_buff_lock(struct rt2x00_dev *rt2x00dev,
				   const u8 request, const u8 requesttype,
				   const u16 offset, void *buffer,
				   const u16 buffer_length, const int timeout)
79
80
81
{
	int status;

82
83
	BUG_ON(!mutex_is_locked(&rt2x00dev->usb_cache_mutex));

84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
	/*
	 * Check for Cache availability.
	 */
	if (unlikely(!rt2x00dev->csr_cache || buffer_length > CSR_CACHE_SIZE)) {
		ERROR(rt2x00dev, "CSR cache not available.\n");
		return -ENOMEM;
	}

	if (requesttype == USB_VENDOR_REQUEST_OUT)
		memcpy(rt2x00dev->csr_cache, buffer, buffer_length);

	status = rt2x00usb_vendor_request(rt2x00dev, request, requesttype,
					  offset, 0, rt2x00dev->csr_cache,
					  buffer_length, timeout);

	if (!status && requesttype == USB_VENDOR_REQUEST_IN)
		memcpy(buffer, rt2x00dev->csr_cache, buffer_length);

	return status;
}
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
EXPORT_SYMBOL_GPL(rt2x00usb_vendor_req_buff_lock);

int rt2x00usb_vendor_request_buff(struct rt2x00_dev *rt2x00dev,
				  const u8 request, const u8 requesttype,
				  const u16 offset, void *buffer,
				  const u16 buffer_length, const int timeout)
{
	int status;

	mutex_lock(&rt2x00dev->usb_cache_mutex);

	status = rt2x00usb_vendor_req_buff_lock(rt2x00dev, request,
						requesttype, offset, buffer,
						buffer_length, timeout);

	mutex_unlock(&rt2x00dev->usb_cache_mutex);

	return status;
}
123
124
EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_buff);

125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
static void rt2x00usb_vendor_request_async_complete(struct urb *urb)
{
	/*
	 * We're done with it, descrease usage count and let the
	 * usb layer delete it as soon as it is done with it.
	 */
	usb_put_urb(urb);
}

int rt2x00usb_vendor_request_async(struct rt2x00_dev *rt2x00dev,
				   const u8 request, const u16 offset,
				   const u16 value)
{
	struct usb_device *usb_dev = rt2x00dev_usb_dev(rt2x00dev);
	struct usb_ctrlrequest *ctrl;
	struct urb *urb;
	int status;

	urb = usb_alloc_urb(0, GFP_NOIO);
	if (!urb)
		return -ENOMEM;

	ctrl = kmalloc(sizeof(struct usb_ctrlrequest), GFP_NOIO);
	if (!ctrl) {
		status = -ENOMEM;
		goto exit;
	}

	ctrl->bRequestType= USB_VENDOR_REQUEST_OUT;
	ctrl->bRequest = request;
	ctrl->wValue = cpu_to_le16p(&value);
	ctrl->wIndex = cpu_to_le16p(&offset);
	ctrl->wLength = 0;

	usb_fill_control_urb(urb, usb_dev, usb_sndctrlpipe(usb_dev, 0),
			     (unsigned char *)ctrl, NULL, 0,
			     rt2x00usb_vendor_request_async_complete, NULL);

	status = usb_submit_urb(urb, GFP_ATOMIC);
	if (!status)
		goto exit;

	return 0;

exit:
	usb_put_urb(urb);
	kfree(ctrl);

	return status;
}
EXPORT_SYMBOL_GPL(rt2x00usb_vendor_request_async);

177
178
179
180
181
/*
 * TX data handlers.
 */
static void rt2x00usb_interrupt_txdone(struct urb *urb)
{
182
183
184
185
	struct queue_entry *entry = (struct queue_entry *)urb->context;
	struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
	struct queue_entry_priv_usb_tx *priv_tx = entry->priv_data;
	struct txdone_entry_desc txdesc;
186
	__le32 *txd = (__le32 *)entry->skb->data;
187
188
189
	u32 word;

	if (!test_bit(DEVICE_ENABLED_RADIO, &rt2x00dev->flags) ||
190
	    !__test_and_clear_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
191
192
193
194
195
196
197
		return;

	rt2x00_desc_read(txd, 0, &word);

	/*
	 * Remove the descriptor data from the buffer.
	 */
198
	skb_pull(entry->skb, entry->queue->desc_size);
199
200
201
202

	/*
	 * Obtain the status about this packet.
	 */
203
204
205
	txdesc.status = !urb->status ? TX_SUCCESS : TX_FAIL_RETRY;
	txdesc.retry = 0;
	txdesc.control = &priv_tx->control;
206

207
	rt2x00lib_txdone(entry, &txdesc);
208
209
210
211
212

	/*
	 * Make this entry available for reuse.
	 */
	entry->flags = 0;
213
	rt2x00queue_index_inc(entry->queue, Q_INDEX_DONE);
214
215

	/*
216
	 * If the data queue was full before the txdone handler
217
218
219
	 * we must make sure the packet queue in the mac80211 stack
	 * is reenabled when the txdone handler has finished.
	 */
220
221
	if (!rt2x00queue_full(entry->queue))
		ieee80211_wake_queue(rt2x00dev->hw, priv_tx->control.queue);
222
223
224
}

int rt2x00usb_write_tx_data(struct rt2x00_dev *rt2x00dev,
225
			    struct data_queue *queue, struct sk_buff *skb,
226
227
			    struct ieee80211_tx_control *control)
{
228
229
230
231
	struct usb_device *usb_dev = rt2x00dev_usb_dev(rt2x00dev);
	struct queue_entry *entry = rt2x00queue_get_entry(queue, Q_INDEX);
	struct queue_entry_priv_usb_tx *priv_tx = entry->priv_data;
	struct skb_frame_desc *skbdesc;
232
	u32 length;
233

234
	if (rt2x00queue_full(queue))
235
236
		return -EINVAL;

237
	if (test_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags)) {
238
239
240
241
242
243
244
245
246
247
		ERROR(rt2x00dev,
		      "Arrived at non-free entry in the non-full queue %d.\n"
		      "Please file bug report to %s.\n",
		      control->queue, DRV_PROJECT);
		return -EINVAL;
	}

	/*
	 * Add the descriptor in front of the skb.
	 */
248
249
	skb_push(skb, queue->desc_size);
	memset(skb->data, 0, queue->desc_size);
250

Ivo van Doorn's avatar
Ivo van Doorn committed
251
252
253
	/*
	 * Fill in skb descriptor
	 */
254
255
256
257
258
259
260
	skbdesc = get_skb_frame_desc(skb);
	memset(skbdesc, 0, sizeof(*skbdesc));
	skbdesc->data = skb->data + queue->desc_size;
	skbdesc->data_len = queue->data_size;
	skbdesc->desc = skb->data;
	skbdesc->desc_len = queue->desc_size;
	skbdesc->entry = entry;
Ivo van Doorn's avatar
Ivo van Doorn committed
261
262

	rt2x00lib_write_tx_desc(rt2x00dev, skb, control);
263
264

	/*
265
266
267
	 * USB devices cannot blindly pass the skb->len as the
	 * length of the data to usb_fill_bulk_urb. Pass the skb
	 * to the driver to determine what the length should be.
268
	 */
269
	length = rt2x00dev->ops->lib->get_tx_data_len(rt2x00dev, skb);
270

271
272
273
	/*
	 * Initialize URB and send the frame to the device.
	 */
274
275
	__set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
	usb_fill_bulk_urb(priv_tx->urb, usb_dev, usb_sndbulkpipe(usb_dev, 1),
276
			  skb->data, length, rt2x00usb_interrupt_txdone, entry);
277
	usb_submit_urb(priv_tx->urb, GFP_ATOMIC);
278

279
	rt2x00queue_index_inc(queue, Q_INDEX);
280
281
282
283
284
285
286
287

	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00usb_write_tx_data);

/*
 * RX data handlers.
 */
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
static struct sk_buff* rt2x00usb_alloc_rxskb(struct data_queue *queue)
{
	struct sk_buff *skb;
	unsigned int frame_size;

	/*
	 * As alignment we use 2 and not NET_IP_ALIGN because we need
	 * to be sure we have 2 bytes room in the head. (NET_IP_ALIGN
	 * can be 0 on some hardware). We use these 2 bytes for frame
	 * alignment later, we assume that the chance that
	 * header_size % 4 == 2 is bigger then header_size % 2 == 0
	 * and thus optimize alignment by reserving the 2 bytes in
	 * advance.
	 */
	frame_size = queue->data_size + queue->desc_size;
	skb = dev_alloc_skb(frame_size + 2);
	if (!skb)
		return NULL;

	skb_reserve(skb, 2);
	skb_put(skb, frame_size);

	return skb;
}

313
314
static void rt2x00usb_interrupt_rxdone(struct urb *urb)
{
315
316
	struct queue_entry *entry = (struct queue_entry *)urb->context;
	struct rt2x00_dev *rt2x00dev = entry->queue->rt2x00dev;
317
	struct sk_buff *skb;
318
319
	struct skb_frame_desc *skbdesc;
	struct rxdone_entry_desc rxdesc;
320
321

	if (!test_bit(DEVICE_ENABLED_RADIO, &rt2x00dev->flags) ||
322
	    !test_and_clear_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags))
323
324
325
326
327
328
329
		return;

	/*
	 * Check if the received data is simply too small
	 * to be actually valid, or if the urb is signaling
	 * a problem.
	 */
330
	if (urb->actual_length < entry->queue->desc_size || urb->status)
331
332
		goto skip_entry;

333
334
335
	/*
	 * Fill in skb descriptor
	 */
336
337
	skbdesc = get_skb_frame_desc(entry->skb);
	memset(skbdesc, 0, sizeof(*skbdesc));
338
339
	skbdesc->entry = entry;

340
341
	memset(&rxdesc, 0, sizeof(rxdesc));
	rt2x00dev->ops->lib->fill_rxdone(entry, &rxdesc);
342
343
344
345
346
347

	/*
	 * Allocate a new sk buffer to replace the current one.
	 * If allocation fails, we should drop the current frame
	 * so we can recycle the existing sk buffer for the new frame.
	 */
348
	skb = rt2x00usb_alloc_rxskb(entry->queue);
349
350
351
352
353
354
	if (!skb)
		goto skip_entry;

	/*
	 * Send the frame to rt2x00lib for further processing.
	 */
355
	rt2x00lib_rxdone(entry, &rxdesc);
356
357
358
359
360
361
362
363
364
365

	/*
	 * Replace current entry's skb with the newly allocated one,
	 * and reinitialize the urb.
	 */
	entry->skb = skb;
	urb->transfer_buffer = entry->skb->data;
	urb->transfer_buffer_length = entry->skb->len;

skip_entry:
366
367
	if (test_bit(DEVICE_ENABLED_RADIO, &entry->queue->rt2x00dev->flags)) {
		__set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
368
369
370
		usb_submit_urb(urb, GFP_ATOMIC);
	}

371
	rt2x00queue_index_inc(entry->queue, Q_INDEX);
372
373
374
375
376
377
378
}

/*
 * Radio handlers
 */
void rt2x00usb_disable_radio(struct rt2x00_dev *rt2x00dev)
{
379
380
381
	struct queue_entry_priv_usb_rx *priv_rx;
	struct queue_entry_priv_usb_tx *priv_tx;
	struct data_queue *queue;
382
383
384
385
386
387
	unsigned int i;

	rt2x00usb_vendor_request_sw(rt2x00dev, USB_RX_CONTROL, 0x0000, 0x0000,
				    REGISTER_TIMEOUT);

	/*
388
	 * Cancel all queues.
389
	 */
390
391
392
393
394
395
396
397
398
399
	for (i = 0; i < rt2x00dev->rx->limit; i++) {
		priv_rx = rt2x00dev->rx->entries[i].priv_data;
		usb_kill_urb(priv_rx->urb);
	}

	txall_queue_for_each(rt2x00dev, queue) {
		for (i = 0; i < queue->limit; i++) {
			priv_tx = queue->entries[i].priv_data;
			usb_kill_urb(priv_tx->urb);
		}
400
401
402
403
404
405
406
	}
}
EXPORT_SYMBOL_GPL(rt2x00usb_disable_radio);

/*
 * Device initialization handlers.
 */
407
void rt2x00usb_init_rxentry(struct rt2x00_dev *rt2x00dev,
408
			    struct queue_entry *entry)
409
{
410
411
	struct usb_device *usb_dev = rt2x00dev_usb_dev(rt2x00dev);
	struct queue_entry_priv_usb_rx *priv_rx = entry->priv_data;
412

413
	usb_fill_bulk_urb(priv_rx->urb, usb_dev,
414
415
416
417
			  usb_rcvbulkpipe(usb_dev, 1),
			  entry->skb->data, entry->skb->len,
			  rt2x00usb_interrupt_rxdone, entry);

418
419
	__set_bit(ENTRY_OWNER_DEVICE_DATA, &entry->flags);
	usb_submit_urb(priv_rx->urb, GFP_ATOMIC);
420
421
422
423
}
EXPORT_SYMBOL_GPL(rt2x00usb_init_rxentry);

void rt2x00usb_init_txentry(struct rt2x00_dev *rt2x00dev,
424
			    struct queue_entry *entry)
425
426
427
428
429
{
	entry->flags = 0;
}
EXPORT_SYMBOL_GPL(rt2x00usb_init_txentry);

430
static int rt2x00usb_alloc_urb(struct rt2x00_dev *rt2x00dev,
431
			       struct data_queue *queue)
432
{
433
434
435
436
437
438
	struct queue_entry_priv_usb_rx *priv_rx;
	struct queue_entry_priv_usb_tx *priv_tx;
	struct queue_entry_priv_usb_bcn *priv_bcn;
	struct urb *urb;
	unsigned int guardian =
	    test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags);
439
440
441
442
443
	unsigned int i;

	/*
	 * Allocate the URB's
	 */
444
445
446
	for (i = 0; i < queue->limit; i++) {
		urb = usb_alloc_urb(0, GFP_KERNEL);
		if (!urb)
447
			return -ENOMEM;
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464

		if (queue->qid == QID_RX) {
			priv_rx = queue->entries[i].priv_data;
			priv_rx->urb = urb;
		} else if (queue->qid == QID_MGMT && guardian) {
			priv_bcn = queue->entries[i].priv_data;
			priv_bcn->urb = urb;

			urb = usb_alloc_urb(0, GFP_KERNEL);
			if (!urb)
				return -ENOMEM;

			priv_bcn->guardian_urb = urb;
		} else {
			priv_tx = queue->entries[i].priv_data;
			priv_tx->urb = urb;
		}
465
466
467
468
469
470
	}

	return 0;
}

static void rt2x00usb_free_urb(struct rt2x00_dev *rt2x00dev,
471
			       struct data_queue *queue)
472
{
473
474
475
476
477
478
	struct queue_entry_priv_usb_rx *priv_rx;
	struct queue_entry_priv_usb_tx *priv_tx;
	struct queue_entry_priv_usb_bcn *priv_bcn;
	struct urb *urb;
	unsigned int guardian =
	    test_bit(DRIVER_REQUIRE_BEACON_GUARD, &rt2x00dev->flags);
479
480
	unsigned int i;

481
	if (!queue->entries)
482
483
		return;

484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
	for (i = 0; i < queue->limit; i++) {
		if (queue->qid == QID_RX) {
			priv_rx = queue->entries[i].priv_data;
			urb = priv_rx->urb;
		} else if (queue->qid == QID_MGMT && guardian) {
			priv_bcn = queue->entries[i].priv_data;

			usb_kill_urb(priv_bcn->guardian_urb);
			usb_free_urb(priv_bcn->guardian_urb);

			urb = priv_bcn->urb;
		} else {
			priv_tx = queue->entries[i].priv_data;
			urb = priv_tx->urb;
		}

		usb_kill_urb(urb);
		usb_free_urb(urb);
		if (queue->entries[i].skb)
			kfree_skb(queue->entries[i].skb);
504
505
506
507
508
	}
}

int rt2x00usb_initialize(struct rt2x00_dev *rt2x00dev)
{
509
	struct data_queue *queue;
510
511
512
	struct sk_buff *skb;
	unsigned int entry_size;
	unsigned int i;
513
	int uninitialized_var(status);
514
515
516
517

	/*
	 * Allocate DMA
	 */
518
519
	queue_for_each(rt2x00dev, queue) {
		status = rt2x00usb_alloc_urb(rt2x00dev, queue);
520
521
522
523
524
		if (status)
			goto exit;
	}

	/*
525
	 * For the RX queue, skb's should be allocated.
526
527
	 */
	entry_size = rt2x00dev->rx->data_size + rt2x00dev->rx->desc_size;
528
529
	for (i = 0; i < rt2x00dev->rx->limit; i++) {
		skb = rt2x00usb_alloc_rxskb(rt2x00dev->rx);
530
531
532
		if (!skb)
			goto exit;

533
		rt2x00dev->rx->entries[i].skb = skb;
534
535
536
537
538
539
540
541
542
543
544
545
546
	}

	return 0;

exit:
	rt2x00usb_uninitialize(rt2x00dev);

	return status;
}
EXPORT_SYMBOL_GPL(rt2x00usb_initialize);

void rt2x00usb_uninitialize(struct rt2x00_dev *rt2x00dev)
{
547
	struct data_queue *queue;
548

549
550
	queue_for_each(rt2x00dev, queue)
		rt2x00usb_free_urb(rt2x00dev, queue);
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
}
EXPORT_SYMBOL_GPL(rt2x00usb_uninitialize);

/*
 * USB driver handlers.
 */
static void rt2x00usb_free_reg(struct rt2x00_dev *rt2x00dev)
{
	kfree(rt2x00dev->rf);
	rt2x00dev->rf = NULL;

	kfree(rt2x00dev->eeprom);
	rt2x00dev->eeprom = NULL;

	kfree(rt2x00dev->csr_cache);
	rt2x00dev->csr_cache = NULL;
}

static int rt2x00usb_alloc_reg(struct rt2x00_dev *rt2x00dev)
{
	rt2x00dev->csr_cache = kzalloc(CSR_CACHE_SIZE, GFP_KERNEL);
	if (!rt2x00dev->csr_cache)
		goto exit;

	rt2x00dev->eeprom = kzalloc(rt2x00dev->ops->eeprom_size, GFP_KERNEL);
	if (!rt2x00dev->eeprom)
		goto exit;

	rt2x00dev->rf = kzalloc(rt2x00dev->ops->rf_size, GFP_KERNEL);
	if (!rt2x00dev->rf)
		goto exit;

	return 0;

exit:
	ERROR_PROBE("Failed to allocate registers.\n");

	rt2x00usb_free_reg(rt2x00dev);

	return -ENOMEM;
}

int rt2x00usb_probe(struct usb_interface *usb_intf,
		    const struct usb_device_id *id)
{
	struct usb_device *usb_dev = interface_to_usbdev(usb_intf);
	struct rt2x00_ops *ops = (struct rt2x00_ops *)id->driver_info;
	struct ieee80211_hw *hw;
	struct rt2x00_dev *rt2x00dev;
	int retval;

	usb_dev = usb_get_dev(usb_dev);

	hw = ieee80211_alloc_hw(sizeof(struct rt2x00_dev), ops->hw);
	if (!hw) {
		ERROR_PROBE("Failed to allocate hardware.\n");
		retval = -ENOMEM;
		goto exit_put_device;
	}

	usb_set_intfdata(usb_intf, hw);

	rt2x00dev = hw->priv;
	rt2x00dev->dev = usb_intf;
	rt2x00dev->ops = ops;
	rt2x00dev->hw = hw;
617
	mutex_init(&rt2x00dev->usb_cache_mutex);
618

619
620
621
622
623
	rt2x00dev->usb_maxpacket =
	    usb_maxpacket(usb_dev, usb_sndbulkpipe(usb_dev, 1), 1);
	if (!rt2x00dev->usb_maxpacket)
		rt2x00dev->usb_maxpacket = 1;

624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
717
	retval = rt2x00usb_alloc_reg(rt2x00dev);
	if (retval)
		goto exit_free_device;

	retval = rt2x00lib_probe_dev(rt2x00dev);
	if (retval)
		goto exit_free_reg;

	return 0;

exit_free_reg:
	rt2x00usb_free_reg(rt2x00dev);

exit_free_device:
	ieee80211_free_hw(hw);

exit_put_device:
	usb_put_dev(usb_dev);

	usb_set_intfdata(usb_intf, NULL);

	return retval;
}
EXPORT_SYMBOL_GPL(rt2x00usb_probe);

void rt2x00usb_disconnect(struct usb_interface *usb_intf)
{
	struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
	struct rt2x00_dev *rt2x00dev = hw->priv;

	/*
	 * Free all allocated data.
	 */
	rt2x00lib_remove_dev(rt2x00dev);
	rt2x00usb_free_reg(rt2x00dev);
	ieee80211_free_hw(hw);

	/*
	 * Free the USB device data.
	 */
	usb_set_intfdata(usb_intf, NULL);
	usb_put_dev(interface_to_usbdev(usb_intf));
}
EXPORT_SYMBOL_GPL(rt2x00usb_disconnect);

#ifdef CONFIG_PM
int rt2x00usb_suspend(struct usb_interface *usb_intf, pm_message_t state)
{
	struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
	struct rt2x00_dev *rt2x00dev = hw->priv;
	int retval;

	retval = rt2x00lib_suspend(rt2x00dev, state);
	if (retval)
		return retval;

	rt2x00usb_free_reg(rt2x00dev);

	/*
	 * Decrease usbdev refcount.
	 */
	usb_put_dev(interface_to_usbdev(usb_intf));

	return 0;
}
EXPORT_SYMBOL_GPL(rt2x00usb_suspend);

int rt2x00usb_resume(struct usb_interface *usb_intf)
{
	struct ieee80211_hw *hw = usb_get_intfdata(usb_intf);
	struct rt2x00_dev *rt2x00dev = hw->priv;
	int retval;

	usb_get_dev(interface_to_usbdev(usb_intf));

	retval = rt2x00usb_alloc_reg(rt2x00dev);
	if (retval)
		return retval;

	retval = rt2x00lib_resume(rt2x00dev);
	if (retval)
		goto exit_free_reg;

	return 0;

exit_free_reg:
	rt2x00usb_free_reg(rt2x00dev);

	return retval;
}
EXPORT_SYMBOL_GPL(rt2x00usb_resume);
#endif /* CONFIG_PM */

/*
718
 * rt2x00usb module information.
719
720
721
 */
MODULE_AUTHOR(DRV_PROJECT);
MODULE_VERSION(DRV_VERSION);
722
MODULE_DESCRIPTION("rt2x00 usb library");
723
MODULE_LICENSE("GPL");