blob: 8b4ca1cb450aacce4dffaf67b0ca650b0cfa2544 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001#include <linux/kernel.h>
2#include <linux/errno.h>
3#include <linux/init.h>
4#include <linux/slab.h>
5#include <linux/mm.h>
6#include <linux/module.h>
7#include <linux/moduleparam.h>
David Hardeman378f0582005-09-17 17:55:31 +10008#include <linux/scatterlist.h>
Matthias Kaehlcke1cfab022007-12-13 16:15:33 -08009#include <linux/mutex.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070010
11#include <linux/usb.h>
12
13
14/*-------------------------------------------------------------------------*/
15
Alan Sternd0b46522013-01-30 16:38:11 -050016static int override_alt = -1;
17module_param_named(alt, override_alt, int, 0644);
18MODULE_PARM_DESC(alt, ">= 0 to override altsetting selection");
19
20/*-------------------------------------------------------------------------*/
21
Martin Fuzzeyfabbf212010-10-01 00:20:42 +020022/* FIXME make these public somewhere; usbdevfs.h? */
Linus Torvalds1da177e2005-04-16 15:20:36 -070023struct usbtest_param {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +020024 /* inputs */
Linus Torvalds1da177e2005-04-16 15:20:36 -070025 unsigned test_num; /* 0..(TEST_CASES-1) */
26 unsigned iterations;
27 unsigned length;
28 unsigned vary;
29 unsigned sglen;
30
Martin Fuzzeyfabbf212010-10-01 00:20:42 +020031 /* outputs */
Linus Torvalds1da177e2005-04-16 15:20:36 -070032 struct timeval duration;
33};
34#define USBTEST_REQUEST _IOWR('U', 100, struct usbtest_param)
35
36/*-------------------------------------------------------------------------*/
37
38#define GENERIC /* let probe() bind using module params */
39
40/* Some devices that can be used for testing will have "real" drivers.
41 * Entries for those need to be enabled here by hand, after disabling
42 * that "real" driver.
43 */
44//#define IBOT2 /* grab iBOT2 webcams */
45//#define KEYSPAN_19Qi /* grab un-renumerated serial adapter */
46
47/*-------------------------------------------------------------------------*/
48
49struct usbtest_info {
50 const char *name;
51 u8 ep_in; /* bulk/intr source */
52 u8 ep_out; /* bulk/intr sink */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +020053 unsigned autoconf:1;
54 unsigned ctrl_out:1;
55 unsigned iso:1; /* try iso in/out */
Linus Torvalds1da177e2005-04-16 15:20:36 -070056 int alt;
57};
58
59/* this is accessed only through usbfs ioctl calls.
60 * one ioctl to issue a test ... one lock per device.
61 * tests create other threads if they need them.
62 * urbs and buffers are allocated dynamically,
63 * and data generated deterministically.
64 */
65struct usbtest_dev {
66 struct usb_interface *intf;
67 struct usbtest_info *info;
68 int in_pipe;
69 int out_pipe;
70 int in_iso_pipe;
71 int out_iso_pipe;
72 struct usb_endpoint_descriptor *iso_in, *iso_out;
Matthias Kaehlcke1cfab022007-12-13 16:15:33 -080073 struct mutex lock;
Linus Torvalds1da177e2005-04-16 15:20:36 -070074
75#define TBUF_SIZE 256
76 u8 *buf;
77};
78
Martin Fuzzeyfabbf212010-10-01 00:20:42 +020079static struct usb_device *testdev_to_usbdev(struct usbtest_dev *test)
Linus Torvalds1da177e2005-04-16 15:20:36 -070080{
Martin Fuzzeyfabbf212010-10-01 00:20:42 +020081 return interface_to_usbdev(test->intf);
Linus Torvalds1da177e2005-04-16 15:20:36 -070082}
83
84/* set up all urbs so they can be used with either bulk or interrupt */
85#define INTERRUPT_RATE 1 /* msec/transfer */
86
David Brownell28ffd792008-04-25 18:51:10 -070087#define ERROR(tdev, fmt, args...) \
88 dev_err(&(tdev)->intf->dev , fmt , ## args)
Arjan van de Venb6c63932008-07-25 01:45:52 -070089#define WARNING(tdev, fmt, args...) \
David Brownell28ffd792008-04-25 18:51:10 -070090 dev_warn(&(tdev)->intf->dev , fmt , ## args)
Linus Torvalds1da177e2005-04-16 15:20:36 -070091
Martin Fuzzey084fb202011-01-16 19:17:11 +010092#define GUARD_BYTE 0xA5
93
Linus Torvalds1da177e2005-04-16 15:20:36 -070094/*-------------------------------------------------------------------------*/
95
96static int
Martin Fuzzeyfabbf212010-10-01 00:20:42 +020097get_endpoints(struct usbtest_dev *dev, struct usb_interface *intf)
Linus Torvalds1da177e2005-04-16 15:20:36 -070098{
99 int tmp;
100 struct usb_host_interface *alt;
101 struct usb_host_endpoint *in, *out;
102 struct usb_host_endpoint *iso_in, *iso_out;
103 struct usb_device *udev;
104
105 for (tmp = 0; tmp < intf->num_altsetting; tmp++) {
106 unsigned ep;
107
108 in = out = NULL;
109 iso_in = iso_out = NULL;
110 alt = intf->altsetting + tmp;
111
Alan Sternd0b46522013-01-30 16:38:11 -0500112 if (override_alt >= 0 &&
113 override_alt != alt->desc.bAlternateSetting)
114 continue;
115
Linus Torvalds1da177e2005-04-16 15:20:36 -0700116 /* take the first altsetting with in-bulk + out-bulk;
Justin P. Mattock70f23fd2011-05-10 10:16:21 +0200117 * ignore other endpoints and altsettings.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700118 */
119 for (ep = 0; ep < alt->desc.bNumEndpoints; ep++) {
120 struct usb_host_endpoint *e;
121
122 e = alt->endpoint + ep;
123 switch (e->desc.bmAttributes) {
124 case USB_ENDPOINT_XFER_BULK:
125 break;
126 case USB_ENDPOINT_XFER_ISOC:
127 if (dev->info->iso)
128 goto try_iso;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200129 /* FALLTHROUGH */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700130 default:
131 continue;
132 }
Luiz Fernando N. Capitulino4d823dd2006-10-26 13:03:02 -0300133 if (usb_endpoint_dir_in(&e->desc)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700134 if (!in)
135 in = e;
136 } else {
137 if (!out)
138 out = e;
139 }
140 continue;
141try_iso:
Luiz Fernando N. Capitulino4d823dd2006-10-26 13:03:02 -0300142 if (usb_endpoint_dir_in(&e->desc)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143 if (!iso_in)
144 iso_in = e;
145 } else {
146 if (!iso_out)
147 iso_out = e;
148 }
149 }
Ming Lei951fd8e2010-08-02 22:09:17 +0800150 if ((in && out) || iso_in || iso_out)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700151 goto found;
152 }
153 return -EINVAL;
154
155found:
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200156 udev = testdev_to_usbdev(dev);
Alan Sternd0b46522013-01-30 16:38:11 -0500157 dev->info->alt = alt->desc.bAlternateSetting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700158 if (alt->desc.bAlternateSetting != 0) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200159 tmp = usb_set_interface(udev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160 alt->desc.bInterfaceNumber,
161 alt->desc.bAlternateSetting);
162 if (tmp < 0)
163 return tmp;
164 }
165
166 if (in) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200167 dev->in_pipe = usb_rcvbulkpipe(udev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700168 in->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200169 dev->out_pipe = usb_sndbulkpipe(udev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700170 out->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK);
171 }
172 if (iso_in) {
173 dev->iso_in = &iso_in->desc;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200174 dev->in_iso_pipe = usb_rcvisocpipe(udev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700175 iso_in->desc.bEndpointAddress
176 & USB_ENDPOINT_NUMBER_MASK);
Ming Lei951fd8e2010-08-02 22:09:17 +0800177 }
178
179 if (iso_out) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700180 dev->iso_out = &iso_out->desc;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200181 dev->out_iso_pipe = usb_sndisocpipe(udev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182 iso_out->desc.bEndpointAddress
183 & USB_ENDPOINT_NUMBER_MASK);
184 }
185 return 0;
186}
187
188/*-------------------------------------------------------------------------*/
189
190/* Support for testing basic non-queued I/O streams.
191 *
192 * These just package urbs as requests that can be easily canceled.
193 * Each urb's data buffer is dynamically allocated; callers can fill
194 * them with non-zero test data (or test for it) when appropriate.
195 */
196
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200197static void simple_callback(struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198{
Ming Leicdc97792008-02-24 18:41:47 +0800199 complete(urb->context);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700200}
201
Martin Fuzzey084fb202011-01-16 19:17:11 +0100202static struct urb *usbtest_alloc_urb(
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203 struct usb_device *udev,
204 int pipe,
Martin Fuzzey084fb202011-01-16 19:17:11 +0100205 unsigned long bytes,
206 unsigned transfer_flags,
207 unsigned offset)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700208{
209 struct urb *urb;
210
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200211 urb = usb_alloc_urb(0, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700212 if (!urb)
213 return urb;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200214 usb_fill_bulk_urb(urb, udev, pipe, NULL, bytes, simple_callback, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215 urb->interval = (udev->speed == USB_SPEED_HIGH)
216 ? (INTERRUPT_RATE << 3)
217 : INTERRUPT_RATE;
Martin Fuzzey084fb202011-01-16 19:17:11 +0100218 urb->transfer_flags = transfer_flags;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200219 if (usb_pipein(pipe))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700220 urb->transfer_flags |= URB_SHORT_NOT_OK;
Martin Fuzzey084fb202011-01-16 19:17:11 +0100221
222 if (urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP)
223 urb->transfer_buffer = usb_alloc_coherent(udev, bytes + offset,
224 GFP_KERNEL, &urb->transfer_dma);
225 else
226 urb->transfer_buffer = kmalloc(bytes + offset, GFP_KERNEL);
227
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 if (!urb->transfer_buffer) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200229 usb_free_urb(urb);
Martin Fuzzey084fb202011-01-16 19:17:11 +0100230 return NULL;
231 }
232
233 /* To test unaligned transfers add an offset and fill the
234 unused memory with a guard value */
235 if (offset) {
236 memset(urb->transfer_buffer, GUARD_BYTE, offset);
237 urb->transfer_buffer += offset;
238 if (urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP)
239 urb->transfer_dma += offset;
240 }
241
242 /* For inbound transfers use guard byte so that test fails if
243 data not correctly copied */
244 memset(urb->transfer_buffer,
245 usb_pipein(urb->pipe) ? GUARD_BYTE : 0,
246 bytes);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700247 return urb;
248}
249
Martin Fuzzey084fb202011-01-16 19:17:11 +0100250static struct urb *simple_alloc_urb(
251 struct usb_device *udev,
252 int pipe,
253 unsigned long bytes)
254{
255 return usbtest_alloc_urb(udev, pipe, bytes, URB_NO_TRANSFER_DMA_MAP, 0);
256}
257
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200258static unsigned pattern;
Vikram Pandita7f4e9852009-11-09 21:24:32 -0600259static unsigned mod_pattern;
260module_param_named(pattern, mod_pattern, uint, S_IRUGO | S_IWUSR);
261MODULE_PARM_DESC(mod_pattern, "i/o pattern (0 == zeroes)");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700262
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200263static inline void simple_fill_buf(struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264{
265 unsigned i;
266 u8 *buf = urb->transfer_buffer;
267 unsigned len = urb->transfer_buffer_length;
268
269 switch (pattern) {
270 default:
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200271 /* FALLTHROUGH */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272 case 0:
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200273 memset(buf, 0, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274 break;
275 case 1: /* mod63 */
276 for (i = 0; i < len; i++)
277 *buf++ = (u8) (i % 63);
278 break;
279 }
280}
281
Greg Dietsche304b0b52011-05-08 22:51:43 -0500282static inline unsigned long buffer_offset(void *buf)
Martin Fuzzey084fb202011-01-16 19:17:11 +0100283{
Greg Dietsche304b0b52011-05-08 22:51:43 -0500284 return (unsigned long)buf & (ARCH_KMALLOC_MINALIGN - 1);
Martin Fuzzey084fb202011-01-16 19:17:11 +0100285}
286
287static int check_guard_bytes(struct usbtest_dev *tdev, struct urb *urb)
288{
289 u8 *buf = urb->transfer_buffer;
290 u8 *guard = buf - buffer_offset(buf);
291 unsigned i;
292
293 for (i = 0; guard < buf; i++, guard++) {
294 if (*guard != GUARD_BYTE) {
295 ERROR(tdev, "guard byte[%d] %d (not %d)\n",
296 i, *guard, GUARD_BYTE);
297 return -EINVAL;
298 }
299 }
300 return 0;
301}
302
303static int simple_check_buf(struct usbtest_dev *tdev, struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304{
305 unsigned i;
306 u8 expected;
307 u8 *buf = urb->transfer_buffer;
308 unsigned len = urb->actual_length;
309
Martin Fuzzey084fb202011-01-16 19:17:11 +0100310 int ret = check_guard_bytes(tdev, urb);
311 if (ret)
312 return ret;
313
Linus Torvalds1da177e2005-04-16 15:20:36 -0700314 for (i = 0; i < len; i++, buf++) {
315 switch (pattern) {
316 /* all-zeroes has no synchronization issues */
317 case 0:
318 expected = 0;
319 break;
320 /* mod63 stays in sync with short-terminated transfers,
321 * or otherwise when host and gadget agree on how large
322 * each usb transfer request should be. resync is done
323 * with set_interface or set_config.
324 */
325 case 1: /* mod63 */
326 expected = i % 63;
327 break;
328 /* always fail unsupported patterns */
329 default:
330 expected = !*buf;
331 break;
332 }
333 if (*buf == expected)
334 continue;
David Brownell28ffd792008-04-25 18:51:10 -0700335 ERROR(tdev, "buf[%d] = %d (not %d)\n", i, *buf, expected);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700336 return -EINVAL;
337 }
338 return 0;
339}
340
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200341static void simple_free_urb(struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342{
Greg Dietsche304b0b52011-05-08 22:51:43 -0500343 unsigned long offset = buffer_offset(urb->transfer_buffer);
Martin Fuzzey084fb202011-01-16 19:17:11 +0100344
345 if (urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP)
346 usb_free_coherent(
347 urb->dev,
348 urb->transfer_buffer_length + offset,
349 urb->transfer_buffer - offset,
350 urb->transfer_dma - offset);
351 else
352 kfree(urb->transfer_buffer - offset);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200353 usb_free_urb(urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700354}
355
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200356static int simple_io(
David Brownell28ffd792008-04-25 18:51:10 -0700357 struct usbtest_dev *tdev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358 struct urb *urb,
359 int iterations,
360 int vary,
361 int expected,
362 const char *label
363)
364{
365 struct usb_device *udev = urb->dev;
366 int max = urb->transfer_buffer_length;
367 struct completion completion;
368 int retval = 0;
369
370 urb->context = &completion;
371 while (retval == 0 && iterations-- > 0) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200372 init_completion(&completion);
Sebastian Andrzej Siewior7c79d092011-08-23 10:44:54 +0200373 if (usb_pipeout(urb->pipe)) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200374 simple_fill_buf(urb);
Sebastian Andrzej Siewior7c79d092011-08-23 10:44:54 +0200375 urb->transfer_flags |= URB_ZERO_PACKET;
376 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200377 retval = usb_submit_urb(urb, GFP_KERNEL);
378 if (retval != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379 break;
380
381 /* NOTE: no timeouts; can't be broken out of by interrupt */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200382 wait_for_completion(&completion);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383 retval = urb->status;
384 urb->dev = udev;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200385 if (retval == 0 && usb_pipein(urb->pipe))
David Brownell28ffd792008-04-25 18:51:10 -0700386 retval = simple_check_buf(tdev, urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387
388 if (vary) {
389 int len = urb->transfer_buffer_length;
390
391 len += vary;
392 len %= max;
393 if (len == 0)
394 len = (vary < max) ? vary : max;
395 urb->transfer_buffer_length = len;
396 }
397
398 /* FIXME if endpoint halted, clear halt (and log) */
399 }
400 urb->transfer_buffer_length = max;
401
402 if (expected != retval)
David Brownell28ffd792008-04-25 18:51:10 -0700403 dev_err(&udev->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404 "%s failed, iterations left %d, status %d (not %d)\n",
405 label, iterations, retval, expected);
406 return retval;
407}
408
409
410/*-------------------------------------------------------------------------*/
411
412/* We use scatterlist primitives to test queued I/O.
413 * Yes, this also tests the scatterlist primitives.
414 */
415
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200416static void free_sglist(struct scatterlist *sg, int nents)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700417{
418 unsigned i;
David Brownell28ffd792008-04-25 18:51:10 -0700419
Linus Torvalds1da177e2005-04-16 15:20:36 -0700420 if (!sg)
421 return;
422 for (i = 0; i < nents; i++) {
Jens Axboe45711f12007-10-22 21:19:53 +0200423 if (!sg_page(&sg[i]))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700424 continue;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200425 kfree(sg_virt(&sg[i]));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700426 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200427 kfree(sg);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700428}
429
430static struct scatterlist *
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200431alloc_sglist(int nents, int max, int vary)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700432{
433 struct scatterlist *sg;
434 unsigned i;
435 unsigned size = max;
436
Dan Carpenter564e6982012-11-17 18:06:11 +0300437 if (max == 0)
438 return NULL;
439
Xi Wang8bde9a62012-04-09 15:48:45 -0400440 sg = kmalloc_array(nents, sizeof *sg, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700441 if (!sg)
442 return NULL;
Alan Stern4756feb2008-03-27 10:15:22 -0400443 sg_init_table(sg, nents);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700444
445 for (i = 0; i < nents; i++) {
446 char *buf;
David Brownell8b524902006-04-02 10:20:15 -0800447 unsigned j;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700448
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200449 buf = kzalloc(size, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700450 if (!buf) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200451 free_sglist(sg, i);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700452 return NULL;
453 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700454
455 /* kmalloc pages are always physically contiguous! */
Alan Stern4756feb2008-03-27 10:15:22 -0400456 sg_set_buf(&sg[i], buf, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700457
David Brownell8b524902006-04-02 10:20:15 -0800458 switch (pattern) {
459 case 0:
460 /* already zeroed */
461 break;
462 case 1:
463 for (j = 0; j < size; j++)
464 *buf++ = (u8) (j % 63);
465 break;
466 }
467
Linus Torvalds1da177e2005-04-16 15:20:36 -0700468 if (vary) {
469 size += vary;
470 size %= max;
471 if (size == 0)
472 size = (vary < max) ? vary : max;
473 }
474 }
475
476 return sg;
477}
478
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200479static int perform_sglist(
David Brownell28ffd792008-04-25 18:51:10 -0700480 struct usbtest_dev *tdev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 unsigned iterations,
482 int pipe,
483 struct usb_sg_request *req,
484 struct scatterlist *sg,
485 int nents
486)
487{
David Brownell28ffd792008-04-25 18:51:10 -0700488 struct usb_device *udev = testdev_to_usbdev(tdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700489 int retval = 0;
490
491 while (retval == 0 && iterations-- > 0) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200492 retval = usb_sg_init(req, udev, pipe,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700493 (udev->speed == USB_SPEED_HIGH)
494 ? (INTERRUPT_RATE << 3)
495 : INTERRUPT_RATE,
Christoph Lametere94b1762006-12-06 20:33:17 -0800496 sg, nents, 0, GFP_KERNEL);
David Brownell28ffd792008-04-25 18:51:10 -0700497
Linus Torvalds1da177e2005-04-16 15:20:36 -0700498 if (retval)
499 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200500 usb_sg_wait(req);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700501 retval = req->status;
502
David Brownell8b524902006-04-02 10:20:15 -0800503 /* FIXME check resulting data pattern */
504
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505 /* FIXME if endpoint halted, clear halt (and log) */
506 }
507
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200508 /* FIXME for unlink or fault handling tests, don't report
509 * failure if retval is as we expected ...
510 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511 if (retval)
David Brownell28ffd792008-04-25 18:51:10 -0700512 ERROR(tdev, "perform_sglist failed, "
513 "iterations left %d, status %d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514 iterations, retval);
515 return retval;
516}
517
518
519/*-------------------------------------------------------------------------*/
520
521/* unqueued control message testing
522 *
523 * there's a nice set of device functional requirements in chapter 9 of the
524 * usb 2.0 spec, which we can apply to ANY device, even ones that don't use
525 * special test firmware.
526 *
527 * we know the device is configured (or suspended) by the time it's visible
528 * through usbfs. we can't change that, so we won't test enumeration (which
529 * worked 'well enough' to get here, this time), power management (ditto),
530 * or remote wakeup (which needs human interaction).
531 */
532
533static unsigned realworld = 1;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200534module_param(realworld, uint, 0);
535MODULE_PARM_DESC(realworld, "clear to demand stricter spec compliance");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200537static int get_altsetting(struct usbtest_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538{
539 struct usb_interface *iface = dev->intf;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200540 struct usb_device *udev = interface_to_usbdev(iface);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700541 int retval;
542
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200543 retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700544 USB_REQ_GET_INTERFACE, USB_DIR_IN|USB_RECIP_INTERFACE,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200545 0, iface->altsetting[0].desc.bInterfaceNumber,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700546 dev->buf, 1, USB_CTRL_GET_TIMEOUT);
547 switch (retval) {
548 case 1:
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200549 return dev->buf[0];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550 case 0:
551 retval = -ERANGE;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200552 /* FALLTHROUGH */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700553 default:
554 return retval;
555 }
556}
557
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200558static int set_altsetting(struct usbtest_dev *dev, int alternate)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700559{
560 struct usb_interface *iface = dev->intf;
561 struct usb_device *udev;
562
563 if (alternate < 0 || alternate >= 256)
564 return -EINVAL;
565
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200566 udev = interface_to_usbdev(iface);
567 return usb_set_interface(udev,
568 iface->altsetting[0].desc.bInterfaceNumber,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700569 alternate);
570}
571
David Brownell28ffd792008-04-25 18:51:10 -0700572static int is_good_config(struct usbtest_dev *tdev, int len)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700573{
574 struct usb_config_descriptor *config;
David Brownell28ffd792008-04-25 18:51:10 -0700575
Linus Torvalds1da177e2005-04-16 15:20:36 -0700576 if (len < sizeof *config)
577 return 0;
David Brownell28ffd792008-04-25 18:51:10 -0700578 config = (struct usb_config_descriptor *) tdev->buf;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579
580 switch (config->bDescriptorType) {
581 case USB_DT_CONFIG:
582 case USB_DT_OTHER_SPEED_CONFIG:
583 if (config->bLength != 9) {
David Brownell28ffd792008-04-25 18:51:10 -0700584 ERROR(tdev, "bogus config descriptor length\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700585 return 0;
586 }
587 /* this bit 'must be 1' but often isn't */
588 if (!realworld && !(config->bmAttributes & 0x80)) {
David Brownell28ffd792008-04-25 18:51:10 -0700589 ERROR(tdev, "high bit of config attributes not set\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700590 return 0;
591 }
592 if (config->bmAttributes & 0x1f) { /* reserved == 0 */
David Brownell28ffd792008-04-25 18:51:10 -0700593 ERROR(tdev, "reserved config bits set\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700594 return 0;
595 }
596 break;
597 default:
598 return 0;
599 }
600
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200601 if (le16_to_cpu(config->wTotalLength) == len) /* read it all */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700602 return 1;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200603 if (le16_to_cpu(config->wTotalLength) >= TBUF_SIZE) /* max partial read */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700604 return 1;
David Brownell28ffd792008-04-25 18:51:10 -0700605 ERROR(tdev, "bogus config descriptor read size\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700606 return 0;
607}
608
609/* sanity test for standard requests working with usb_control_mesg() and some
610 * of the utility functions which use it.
611 *
612 * this doesn't test how endpoint halts behave or data toggles get set, since
613 * we won't do I/O to bulk/interrupt endpoints here (which is how to change
614 * halt or toggle). toggle testing is impractical without support from hcds.
615 *
616 * this avoids failing devices linux would normally work with, by not testing
617 * config/altsetting operations for devices that only support their defaults.
618 * such devices rarely support those needless operations.
619 *
620 * NOTE that since this is a sanity test, it's not examining boundary cases
621 * to see if usbcore, hcd, and device all behave right. such testing would
622 * involve varied read sizes and other operation sequences.
623 */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200624static int ch9_postconfig(struct usbtest_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625{
626 struct usb_interface *iface = dev->intf;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200627 struct usb_device *udev = interface_to_usbdev(iface);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628 int i, alt, retval;
629
630 /* [9.2.3] if there's more than one altsetting, we need to be able to
631 * set and get each one. mostly trusts the descriptors from usbcore.
632 */
633 for (i = 0; i < iface->num_altsetting; i++) {
634
635 /* 9.2.3 constrains the range here */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200636 alt = iface->altsetting[i].desc.bAlternateSetting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700637 if (alt < 0 || alt >= iface->num_altsetting) {
David Brownell28ffd792008-04-25 18:51:10 -0700638 dev_err(&iface->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700639 "invalid alt [%d].bAltSetting = %d\n",
640 i, alt);
641 }
642
643 /* [real world] get/set unimplemented if there's only one */
644 if (realworld && iface->num_altsetting == 1)
645 continue;
646
647 /* [9.4.10] set_interface */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200648 retval = set_altsetting(dev, alt);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700649 if (retval) {
David Brownell28ffd792008-04-25 18:51:10 -0700650 dev_err(&iface->dev, "can't set_interface = %d, %d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700651 alt, retval);
652 return retval;
653 }
654
655 /* [9.4.4] get_interface always works */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200656 retval = get_altsetting(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700657 if (retval != alt) {
David Brownell28ffd792008-04-25 18:51:10 -0700658 dev_err(&iface->dev, "get alt should be %d, was %d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700659 alt, retval);
660 return (retval < 0) ? retval : -EDOM;
661 }
662
663 }
664
665 /* [real world] get_config unimplemented if there's only one */
666 if (!realworld || udev->descriptor.bNumConfigurations != 1) {
667 int expected = udev->actconfig->desc.bConfigurationValue;
668
669 /* [9.4.2] get_configuration always works
670 * ... although some cheap devices (like one TI Hub I've got)
671 * won't return config descriptors except before set_config.
672 */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200673 retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700674 USB_REQ_GET_CONFIGURATION,
675 USB_DIR_IN | USB_RECIP_DEVICE,
676 0, 0, dev->buf, 1, USB_CTRL_GET_TIMEOUT);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200677 if (retval != 1 || dev->buf[0] != expected) {
David Brownell28ffd792008-04-25 18:51:10 -0700678 dev_err(&iface->dev, "get config --> %d %d (1 %d)\n",
David Brownellff7c79e2005-04-22 13:17:00 -0700679 retval, dev->buf[0], expected);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700680 return (retval < 0) ? retval : -EDOM;
681 }
682 }
683
684 /* there's always [9.4.3] a device descriptor [9.6.1] */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200685 retval = usb_get_descriptor(udev, USB_DT_DEVICE, 0,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700686 dev->buf, sizeof udev->descriptor);
687 if (retval != sizeof udev->descriptor) {
David Brownell28ffd792008-04-25 18:51:10 -0700688 dev_err(&iface->dev, "dev descriptor --> %d\n", retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700689 return (retval < 0) ? retval : -EDOM;
690 }
691
692 /* there's always [9.4.3] at least one config descriptor [9.6.3] */
693 for (i = 0; i < udev->descriptor.bNumConfigurations; i++) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200694 retval = usb_get_descriptor(udev, USB_DT_CONFIG, i,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695 dev->buf, TBUF_SIZE);
David Brownell28ffd792008-04-25 18:51:10 -0700696 if (!is_good_config(dev, retval)) {
697 dev_err(&iface->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700698 "config [%d] descriptor --> %d\n",
699 i, retval);
700 return (retval < 0) ? retval : -EDOM;
701 }
702
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200703 /* FIXME cross-checking udev->config[i] to make sure usbcore
704 * parsed it right (etc) would be good testing paranoia
705 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700706 }
707
708 /* and sometimes [9.2.6.6] speed dependent descriptors */
709 if (le16_to_cpu(udev->descriptor.bcdUSB) == 0x0200) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200710 struct usb_qualifier_descriptor *d = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700711
712 /* device qualifier [9.6.2] */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200713 retval = usb_get_descriptor(udev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700714 USB_DT_DEVICE_QUALIFIER, 0, dev->buf,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200715 sizeof(struct usb_qualifier_descriptor));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700716 if (retval == -EPIPE) {
717 if (udev->speed == USB_SPEED_HIGH) {
David Brownell28ffd792008-04-25 18:51:10 -0700718 dev_err(&iface->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700719 "hs dev qualifier --> %d\n",
720 retval);
721 return (retval < 0) ? retval : -EDOM;
722 }
723 /* usb2.0 but not high-speed capable; fine */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200724 } else if (retval != sizeof(struct usb_qualifier_descriptor)) {
David Brownell28ffd792008-04-25 18:51:10 -0700725 dev_err(&iface->dev, "dev qualifier --> %d\n", retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700726 return (retval < 0) ? retval : -EDOM;
727 } else
728 d = (struct usb_qualifier_descriptor *) dev->buf;
729
730 /* might not have [9.6.2] any other-speed configs [9.6.4] */
731 if (d) {
732 unsigned max = d->bNumConfigurations;
733 for (i = 0; i < max; i++) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200734 retval = usb_get_descriptor(udev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700735 USB_DT_OTHER_SPEED_CONFIG, i,
736 dev->buf, TBUF_SIZE);
David Brownell28ffd792008-04-25 18:51:10 -0700737 if (!is_good_config(dev, retval)) {
738 dev_err(&iface->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700739 "other speed config --> %d\n",
740 retval);
741 return (retval < 0) ? retval : -EDOM;
742 }
743 }
744 }
745 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200746 /* FIXME fetch strings from at least the device descriptor */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700747
748 /* [9.4.5] get_status always works */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200749 retval = usb_get_status(udev, USB_RECIP_DEVICE, 0, dev->buf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700750 if (retval != 2) {
David Brownell28ffd792008-04-25 18:51:10 -0700751 dev_err(&iface->dev, "get dev status --> %d\n", retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700752 return (retval < 0) ? retval : -EDOM;
753 }
754
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200755 /* FIXME configuration.bmAttributes says if we could try to set/clear
756 * the device's remote wakeup feature ... if we can, test that here
757 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700758
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200759 retval = usb_get_status(udev, USB_RECIP_INTERFACE,
760 iface->altsetting[0].desc.bInterfaceNumber, dev->buf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761 if (retval != 2) {
David Brownell28ffd792008-04-25 18:51:10 -0700762 dev_err(&iface->dev, "get interface status --> %d\n", retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700763 return (retval < 0) ? retval : -EDOM;
764 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200765 /* FIXME get status for each endpoint in the interface */
David Brownell28ffd792008-04-25 18:51:10 -0700766
Linus Torvalds1da177e2005-04-16 15:20:36 -0700767 return 0;
768}
769
770/*-------------------------------------------------------------------------*/
771
772/* use ch9 requests to test whether:
773 * (a) queues work for control, keeping N subtests queued and
774 * active (auto-resubmit) for M loops through the queue.
775 * (b) protocol stalls (control-only) will autorecover.
776 * it's not like bulk/intr; no halt clearing.
777 * (c) short control reads are reported and handled.
778 * (d) queues are always processed in-order
779 */
780
781struct ctrl_ctx {
782 spinlock_t lock;
783 struct usbtest_dev *dev;
784 struct completion complete;
785 unsigned count;
786 unsigned pending;
787 int status;
788 struct urb **urb;
789 struct usbtest_param *param;
790 int last;
791};
792
793#define NUM_SUBCASES 15 /* how many test subcases here? */
794
795struct subcase {
796 struct usb_ctrlrequest setup;
797 int number;
798 int expected;
799};
800
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200801static void ctrl_complete(struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700802{
803 struct ctrl_ctx *ctx = urb->context;
804 struct usb_ctrlrequest *reqp;
805 struct subcase *subcase;
806 int status = urb->status;
807
808 reqp = (struct usb_ctrlrequest *)urb->setup_packet;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200809 subcase = container_of(reqp, struct subcase, setup);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700810
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200811 spin_lock(&ctx->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700812 ctx->count--;
813 ctx->pending--;
814
815 /* queue must transfer and complete in fifo order, unless
816 * usb_unlink_urb() is used to unlink something not at the
817 * physical queue head (not tested).
818 */
819 if (subcase->number > 0) {
820 if ((subcase->number - ctx->last) != 1) {
David Brownell28ffd792008-04-25 18:51:10 -0700821 ERROR(ctx->dev,
822 "subcase %d completed out of order, last %d\n",
823 subcase->number, ctx->last);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824 status = -EDOM;
825 ctx->last = subcase->number;
826 goto error;
827 }
828 }
829 ctx->last = subcase->number;
830
831 /* succeed or fault in only one way? */
832 if (status == subcase->expected)
833 status = 0;
834
835 /* async unlink for cleanup? */
836 else if (status != -ECONNRESET) {
837
838 /* some faults are allowed, not required */
839 if (subcase->expected > 0 && (
Greg Kroah-Hartman59d99782007-07-18 10:58:02 -0700840 ((status == -subcase->expected /* happened */
841 || status == 0)))) /* didn't */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700842 status = 0;
843 /* sometimes more than one fault is allowed */
844 else if (subcase->number == 12 && status == -EPIPE)
845 status = 0;
846 else
David Brownell28ffd792008-04-25 18:51:10 -0700847 ERROR(ctx->dev, "subtest %d error, status %d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700848 subcase->number, status);
849 }
850
851 /* unexpected status codes mean errors; ideally, in hardware */
852 if (status) {
853error:
854 if (ctx->status == 0) {
855 int i;
856
857 ctx->status = status;
David Brownell28ffd792008-04-25 18:51:10 -0700858 ERROR(ctx->dev, "control queue %02x.%02x, err %d, "
859 "%d left, subcase %d, len %d/%d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700860 reqp->bRequestType, reqp->bRequest,
David Brownell28ffd792008-04-25 18:51:10 -0700861 status, ctx->count, subcase->number,
862 urb->actual_length,
863 urb->transfer_buffer_length);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700864
865 /* FIXME this "unlink everything" exit route should
866 * be a separate test case.
867 */
868
869 /* unlink whatever's still pending */
870 for (i = 1; i < ctx->param->sglen; i++) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200871 struct urb *u = ctx->urb[
872 (i + subcase->number)
873 % ctx->param->sglen];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700874
875 if (u == urb || !u->dev)
876 continue;
Franck Bui-Huucaa2a122006-05-15 19:23:53 +0200877 spin_unlock(&ctx->lock);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200878 status = usb_unlink_urb(u);
Franck Bui-Huucaa2a122006-05-15 19:23:53 +0200879 spin_lock(&ctx->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700880 switch (status) {
881 case -EINPROGRESS:
882 case -EBUSY:
883 case -EIDRM:
884 continue;
885 default:
David Brownell28ffd792008-04-25 18:51:10 -0700886 ERROR(ctx->dev, "urb unlink --> %d\n",
887 status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700888 }
889 }
890 status = ctx->status;
891 }
892 }
893
894 /* resubmit if we need to, else mark this as done */
895 if ((status == 0) && (ctx->pending < ctx->count)) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200896 status = usb_submit_urb(urb, GFP_ATOMIC);
897 if (status != 0) {
David Brownell28ffd792008-04-25 18:51:10 -0700898 ERROR(ctx->dev,
899 "can't resubmit ctrl %02x.%02x, err %d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700900 reqp->bRequestType, reqp->bRequest, status);
901 urb->dev = NULL;
902 } else
903 ctx->pending++;
904 } else
905 urb->dev = NULL;
David Brownell28ffd792008-04-25 18:51:10 -0700906
Linus Torvalds1da177e2005-04-16 15:20:36 -0700907 /* signal completion when nothing's queued */
908 if (ctx->pending == 0)
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200909 complete(&ctx->complete);
910 spin_unlock(&ctx->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700911}
912
913static int
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200914test_ctrl_queue(struct usbtest_dev *dev, struct usbtest_param *param)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700915{
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200916 struct usb_device *udev = testdev_to_usbdev(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700917 struct urb **urb;
918 struct ctrl_ctx context;
919 int i;
920
Xi Wange65cdfa2012-04-09 15:48:55 -0400921 if (param->sglen == 0 || param->iterations > UINT_MAX / param->sglen)
922 return -EOPNOTSUPP;
923
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200924 spin_lock_init(&context.lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700925 context.dev = dev;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200926 init_completion(&context.complete);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700927 context.count = param->sglen * param->iterations;
928 context.pending = 0;
929 context.status = -ENOMEM;
930 context.param = param;
931 context.last = -1;
932
933 /* allocate and init the urbs we'll queue.
934 * as with bulk/intr sglists, sglen is the queue depth; it also
935 * controls which subtests run (more tests than sglen) or rerun.
936 */
Christoph Lametere94b1762006-12-06 20:33:17 -0800937 urb = kcalloc(param->sglen, sizeof(struct urb *), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700938 if (!urb)
939 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700940 for (i = 0; i < param->sglen; i++) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200941 int pipe = usb_rcvctrlpipe(udev, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700942 unsigned len;
943 struct urb *u;
944 struct usb_ctrlrequest req;
945 struct subcase *reqp;
Marcin Slusarz6def7552008-05-12 20:17:25 +0200946
947 /* sign of this variable means:
948 * -: tested code must return this (negative) error code
949 * +: tested code may return this (negative too) error code
950 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700951 int expected = 0;
952
953 /* requests here are mostly expected to succeed on any
954 * device, but some are chosen to trigger protocol stalls
955 * or short reads.
956 */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200957 memset(&req, 0, sizeof req);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700958 req.bRequest = USB_REQ_GET_DESCRIPTOR;
959 req.bRequestType = USB_DIR_IN|USB_RECIP_DEVICE;
960
961 switch (i % NUM_SUBCASES) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200962 case 0: /* get device descriptor */
963 req.wValue = cpu_to_le16(USB_DT_DEVICE << 8);
964 len = sizeof(struct usb_device_descriptor);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700965 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200966 case 1: /* get first config descriptor (only) */
967 req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
968 len = sizeof(struct usb_config_descriptor);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700969 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200970 case 2: /* get altsetting (OFTEN STALLS) */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700971 req.bRequest = USB_REQ_GET_INTERFACE;
972 req.bRequestType = USB_DIR_IN|USB_RECIP_INTERFACE;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200973 /* index = 0 means first interface */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700974 len = 1;
975 expected = EPIPE;
976 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200977 case 3: /* get interface status */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700978 req.bRequest = USB_REQ_GET_STATUS;
979 req.bRequestType = USB_DIR_IN|USB_RECIP_INTERFACE;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200980 /* interface 0 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700981 len = 2;
982 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200983 case 4: /* get device status */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700984 req.bRequest = USB_REQ_GET_STATUS;
985 req.bRequestType = USB_DIR_IN|USB_RECIP_DEVICE;
986 len = 2;
987 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200988 case 5: /* get device qualifier (MAY STALL) */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700989 req.wValue = cpu_to_le16 (USB_DT_DEVICE_QUALIFIER << 8);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200990 len = sizeof(struct usb_qualifier_descriptor);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700991 if (udev->speed != USB_SPEED_HIGH)
992 expected = EPIPE;
993 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200994 case 6: /* get first config descriptor, plus interface */
995 req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
996 len = sizeof(struct usb_config_descriptor);
997 len += sizeof(struct usb_interface_descriptor);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700998 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +0200999 case 7: /* get interface descriptor (ALWAYS STALLS) */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001000 req.wValue = cpu_to_le16 (USB_DT_INTERFACE << 8);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001001 /* interface == 0 */
1002 len = sizeof(struct usb_interface_descriptor);
David Brownell28ffd792008-04-25 18:51:10 -07001003 expected = -EPIPE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001004 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001005 /* NOTE: two consecutive stalls in the queue here.
1006 * that tests fault recovery a bit more aggressively. */
1007 case 8: /* clear endpoint halt (MAY STALL) */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001008 req.bRequest = USB_REQ_CLEAR_FEATURE;
1009 req.bRequestType = USB_RECIP_ENDPOINT;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001010 /* wValue 0 == ep halt */
1011 /* wIndex 0 == ep0 (shouldn't halt!) */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001012 len = 0;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001013 pipe = usb_sndctrlpipe(udev, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001014 expected = EPIPE;
1015 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001016 case 9: /* get endpoint status */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001017 req.bRequest = USB_REQ_GET_STATUS;
1018 req.bRequestType = USB_DIR_IN|USB_RECIP_ENDPOINT;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001019 /* endpoint 0 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001020 len = 2;
1021 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001022 case 10: /* trigger short read (EREMOTEIO) */
1023 req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001024 len = 1024;
1025 expected = -EREMOTEIO;
1026 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001027 /* NOTE: two consecutive _different_ faults in the queue. */
1028 case 11: /* get endpoint descriptor (ALWAYS STALLS) */
1029 req.wValue = cpu_to_le16(USB_DT_ENDPOINT << 8);
1030 /* endpoint == 0 */
1031 len = sizeof(struct usb_interface_descriptor);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001032 expected = EPIPE;
1033 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001034 /* NOTE: sometimes even a third fault in the queue! */
1035 case 12: /* get string 0 descriptor (MAY STALL) */
1036 req.wValue = cpu_to_le16(USB_DT_STRING << 8);
1037 /* string == 0, for language IDs */
1038 len = sizeof(struct usb_interface_descriptor);
1039 /* may succeed when > 4 languages */
1040 expected = EREMOTEIO; /* or EPIPE, if no strings */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001041 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001042 case 13: /* short read, resembling case 10 */
1043 req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
1044 /* last data packet "should" be DATA1, not DATA0 */
Paul Zimmerman6a23ccd2012-04-16 14:19:07 -07001045 if (udev->speed == USB_SPEED_SUPER)
1046 len = 1024 - 512;
1047 else
1048 len = 1024 - udev->descriptor.bMaxPacketSize0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001049 expected = -EREMOTEIO;
1050 break;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001051 case 14: /* short read; try to fill the last packet */
1052 req.wValue = cpu_to_le16((USB_DT_DEVICE << 8) | 0);
David Brownell28ffd792008-04-25 18:51:10 -07001053 /* device descriptor size == 18 bytes */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001054 len = udev->descriptor.bMaxPacketSize0;
Sebastian Andrzej Siewior67e7d642011-04-14 16:17:21 +02001055 if (udev->speed == USB_SPEED_SUPER)
1056 len = 512;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001057 switch (len) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001058 case 8:
1059 len = 24;
1060 break;
1061 case 16:
1062 len = 32;
1063 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001064 }
1065 expected = -EREMOTEIO;
1066 break;
1067 default:
David Brownell28ffd792008-04-25 18:51:10 -07001068 ERROR(dev, "bogus number of ctrl queue testcases!\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001069 context.status = -EINVAL;
1070 goto cleanup;
1071 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001072 req.wLength = cpu_to_le16(len);
1073 urb[i] = u = simple_alloc_urb(udev, pipe, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001074 if (!u)
1075 goto cleanup;
1076
Alan Stern0ede76f2010-03-05 15:10:17 -05001077 reqp = kmalloc(sizeof *reqp, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001078 if (!reqp)
1079 goto cleanup;
1080 reqp->setup = req;
1081 reqp->number = i % NUM_SUBCASES;
1082 reqp->expected = expected;
1083 u->setup_packet = (char *) &reqp->setup;
1084
1085 u->context = &context;
1086 u->complete = ctrl_complete;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001087 }
1088
1089 /* queue the urbs */
1090 context.urb = urb;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001091 spin_lock_irq(&context.lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001092 for (i = 0; i < param->sglen; i++) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001093 context.status = usb_submit_urb(urb[i], GFP_ATOMIC);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001094 if (context.status != 0) {
David Brownell28ffd792008-04-25 18:51:10 -07001095 ERROR(dev, "can't submit urb[%d], status %d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07001096 i, context.status);
1097 context.count = context.pending;
1098 break;
1099 }
1100 context.pending++;
1101 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001102 spin_unlock_irq(&context.lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001103
1104 /* FIXME set timer and time out; provide a disconnect hook */
1105
1106 /* wait for the last one to complete */
1107 if (context.pending > 0)
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001108 wait_for_completion(&context.complete);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001109
1110cleanup:
1111 for (i = 0; i < param->sglen; i++) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001112 if (!urb[i])
Linus Torvalds1da177e2005-04-16 15:20:36 -07001113 continue;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001114 urb[i]->dev = udev;
Alan Stern0ede76f2010-03-05 15:10:17 -05001115 kfree(urb[i]->setup_packet);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001116 simple_free_urb(urb[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001117 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001118 kfree(urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001119 return context.status;
1120}
1121#undef NUM_SUBCASES
1122
1123
1124/*-------------------------------------------------------------------------*/
1125
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001126static void unlink1_callback(struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001127{
1128 int status = urb->status;
1129
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001130 /* we "know" -EPIPE (stall) never happens */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001131 if (!status)
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001132 status = usb_submit_urb(urb, GFP_ATOMIC);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001133 if (status) {
1134 urb->status = status;
Ming Leicdc97792008-02-24 18:41:47 +08001135 complete(urb->context);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001136 }
1137}
1138
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001139static int unlink1(struct usbtest_dev *dev, int pipe, int size, int async)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001140{
1141 struct urb *urb;
1142 struct completion completion;
1143 int retval = 0;
1144
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001145 init_completion(&completion);
1146 urb = simple_alloc_urb(testdev_to_usbdev(dev), pipe, size);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001147 if (!urb)
1148 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001149 urb->context = &completion;
1150 urb->complete = unlink1_callback;
1151
1152 /* keep the endpoint busy. there are lots of hc/hcd-internal
1153 * states, and testing should get to all of them over time.
1154 *
1155 * FIXME want additional tests for when endpoint is STALLing
1156 * due to errors, or is just NAKing requests.
1157 */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001158 retval = usb_submit_urb(urb, GFP_KERNEL);
1159 if (retval != 0) {
David Brownell28ffd792008-04-25 18:51:10 -07001160 dev_err(&dev->intf->dev, "submit fail %d\n", retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001161 return retval;
1162 }
1163
1164 /* unlinking that should always work. variable delay tests more
1165 * hcd states and code paths, even with little other system load.
1166 */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001167 msleep(jiffies % (2 * INTERRUPT_RATE));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001168 if (async) {
Martin Fuzzey3b6c0232009-06-04 23:20:38 +02001169 while (!completion_done(&completion)) {
1170 retval = usb_unlink_urb(urb);
1171
1172 switch (retval) {
1173 case -EBUSY:
1174 case -EIDRM:
1175 /* we can't unlink urbs while they're completing
1176 * or if they've completed, and we haven't
1177 * resubmitted. "normal" drivers would prevent
1178 * resubmission, but since we're testing unlink
1179 * paths, we can't.
1180 */
1181 ERROR(dev, "unlink retry\n");
1182 continue;
1183 case 0:
1184 case -EINPROGRESS:
1185 break;
1186
1187 default:
1188 dev_err(&dev->intf->dev,
1189 "unlink fail %d\n", retval);
1190 return retval;
1191 }
1192
1193 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001194 }
1195 } else
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001196 usb_kill_urb(urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001197
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001198 wait_for_completion(&completion);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001199 retval = urb->status;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001200 simple_free_urb(urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001201
1202 if (async)
1203 return (retval == -ECONNRESET) ? 0 : retval - 1000;
1204 else
1205 return (retval == -ENOENT || retval == -EPERM) ?
1206 0 : retval - 2000;
1207}
1208
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001209static int unlink_simple(struct usbtest_dev *dev, int pipe, int len)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001210{
1211 int retval = 0;
1212
1213 /* test sync and async paths */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001214 retval = unlink1(dev, pipe, len, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001215 if (!retval)
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001216 retval = unlink1(dev, pipe, len, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001217 return retval;
1218}
1219
1220/*-------------------------------------------------------------------------*/
1221
Alan Stern869410f2011-04-14 11:21:04 -04001222struct queued_ctx {
1223 struct completion complete;
1224 atomic_t pending;
1225 unsigned num;
1226 int status;
1227 struct urb **urbs;
1228};
1229
1230static void unlink_queued_callback(struct urb *urb)
1231{
1232 int status = urb->status;
1233 struct queued_ctx *ctx = urb->context;
1234
1235 if (ctx->status)
1236 goto done;
1237 if (urb == ctx->urbs[ctx->num - 4] || urb == ctx->urbs[ctx->num - 2]) {
1238 if (status == -ECONNRESET)
1239 goto done;
1240 /* What error should we report if the URB completed normally? */
1241 }
1242 if (status != 0)
1243 ctx->status = status;
1244
1245 done:
1246 if (atomic_dec_and_test(&ctx->pending))
1247 complete(&ctx->complete);
1248}
1249
1250static int unlink_queued(struct usbtest_dev *dev, int pipe, unsigned num,
1251 unsigned size)
1252{
1253 struct queued_ctx ctx;
1254 struct usb_device *udev = testdev_to_usbdev(dev);
1255 void *buf;
1256 dma_addr_t buf_dma;
1257 int i;
1258 int retval = -ENOMEM;
1259
1260 init_completion(&ctx.complete);
1261 atomic_set(&ctx.pending, 1); /* One more than the actual value */
1262 ctx.num = num;
1263 ctx.status = 0;
1264
1265 buf = usb_alloc_coherent(udev, size, GFP_KERNEL, &buf_dma);
1266 if (!buf)
1267 return retval;
1268 memset(buf, 0, size);
1269
1270 /* Allocate and init the urbs we'll queue */
1271 ctx.urbs = kcalloc(num, sizeof(struct urb *), GFP_KERNEL);
1272 if (!ctx.urbs)
1273 goto free_buf;
1274 for (i = 0; i < num; i++) {
1275 ctx.urbs[i] = usb_alloc_urb(0, GFP_KERNEL);
1276 if (!ctx.urbs[i])
1277 goto free_urbs;
1278 usb_fill_bulk_urb(ctx.urbs[i], udev, pipe, buf, size,
1279 unlink_queued_callback, &ctx);
1280 ctx.urbs[i]->transfer_dma = buf_dma;
1281 ctx.urbs[i]->transfer_flags = URB_NO_TRANSFER_DMA_MAP;
1282 }
1283
1284 /* Submit all the URBs and then unlink URBs num - 4 and num - 2. */
1285 for (i = 0; i < num; i++) {
1286 atomic_inc(&ctx.pending);
1287 retval = usb_submit_urb(ctx.urbs[i], GFP_KERNEL);
1288 if (retval != 0) {
1289 dev_err(&dev->intf->dev, "submit urbs[%d] fail %d\n",
1290 i, retval);
1291 atomic_dec(&ctx.pending);
1292 ctx.status = retval;
1293 break;
1294 }
1295 }
1296 if (i == num) {
1297 usb_unlink_urb(ctx.urbs[num - 4]);
1298 usb_unlink_urb(ctx.urbs[num - 2]);
1299 } else {
1300 while (--i >= 0)
1301 usb_unlink_urb(ctx.urbs[i]);
1302 }
1303
1304 if (atomic_dec_and_test(&ctx.pending)) /* The extra count */
1305 complete(&ctx.complete);
1306 wait_for_completion(&ctx.complete);
1307 retval = ctx.status;
1308
1309 free_urbs:
1310 for (i = 0; i < num; i++)
1311 usb_free_urb(ctx.urbs[i]);
1312 kfree(ctx.urbs);
1313 free_buf:
1314 usb_free_coherent(udev, size, buf, buf_dma);
1315 return retval;
1316}
1317
1318/*-------------------------------------------------------------------------*/
1319
David Brownell28ffd792008-04-25 18:51:10 -07001320static int verify_not_halted(struct usbtest_dev *tdev, int ep, struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001321{
1322 int retval;
1323 u16 status;
1324
1325 /* shouldn't look or act halted */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001326 retval = usb_get_status(urb->dev, USB_RECIP_ENDPOINT, ep, &status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001327 if (retval < 0) {
David Brownell28ffd792008-04-25 18:51:10 -07001328 ERROR(tdev, "ep %02x couldn't get no-halt status, %d\n",
1329 ep, retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001330 return retval;
1331 }
1332 if (status != 0) {
David Brownell28ffd792008-04-25 18:51:10 -07001333 ERROR(tdev, "ep %02x bogus status: %04x != 0\n", ep, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001334 return -EINVAL;
1335 }
David Brownell28ffd792008-04-25 18:51:10 -07001336 retval = simple_io(tdev, urb, 1, 0, 0, __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001337 if (retval != 0)
1338 return -EINVAL;
1339 return 0;
1340}
1341
David Brownell28ffd792008-04-25 18:51:10 -07001342static int verify_halted(struct usbtest_dev *tdev, int ep, struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001343{
1344 int retval;
1345 u16 status;
1346
1347 /* should look and act halted */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001348 retval = usb_get_status(urb->dev, USB_RECIP_ENDPOINT, ep, &status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001349 if (retval < 0) {
David Brownell28ffd792008-04-25 18:51:10 -07001350 ERROR(tdev, "ep %02x couldn't get halt status, %d\n",
1351 ep, retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001352 return retval;
1353 }
Jan Andersson6ce45602008-01-08 16:39:49 +01001354 le16_to_cpus(&status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001355 if (status != 1) {
David Brownell28ffd792008-04-25 18:51:10 -07001356 ERROR(tdev, "ep %02x bogus status: %04x != 1\n", ep, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001357 return -EINVAL;
1358 }
David Brownell28ffd792008-04-25 18:51:10 -07001359 retval = simple_io(tdev, urb, 1, 0, -EPIPE, __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001360 if (retval != -EPIPE)
1361 return -EINVAL;
David Brownell28ffd792008-04-25 18:51:10 -07001362 retval = simple_io(tdev, urb, 1, 0, -EPIPE, "verify_still_halted");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001363 if (retval != -EPIPE)
1364 return -EINVAL;
1365 return 0;
1366}
1367
David Brownell28ffd792008-04-25 18:51:10 -07001368static int test_halt(struct usbtest_dev *tdev, int ep, struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001369{
1370 int retval;
1371
1372 /* shouldn't look or act halted now */
David Brownell28ffd792008-04-25 18:51:10 -07001373 retval = verify_not_halted(tdev, ep, urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001374 if (retval < 0)
1375 return retval;
1376
1377 /* set halt (protocol test only), verify it worked */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001378 retval = usb_control_msg(urb->dev, usb_sndctrlpipe(urb->dev, 0),
Linus Torvalds1da177e2005-04-16 15:20:36 -07001379 USB_REQ_SET_FEATURE, USB_RECIP_ENDPOINT,
1380 USB_ENDPOINT_HALT, ep,
1381 NULL, 0, USB_CTRL_SET_TIMEOUT);
1382 if (retval < 0) {
David Brownell28ffd792008-04-25 18:51:10 -07001383 ERROR(tdev, "ep %02x couldn't set halt, %d\n", ep, retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001384 return retval;
1385 }
David Brownell28ffd792008-04-25 18:51:10 -07001386 retval = verify_halted(tdev, ep, urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001387 if (retval < 0)
1388 return retval;
1389
1390 /* clear halt (tests API + protocol), verify it worked */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001391 retval = usb_clear_halt(urb->dev, urb->pipe);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001392 if (retval < 0) {
David Brownell28ffd792008-04-25 18:51:10 -07001393 ERROR(tdev, "ep %02x couldn't clear halt, %d\n", ep, retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001394 return retval;
1395 }
David Brownell28ffd792008-04-25 18:51:10 -07001396 retval = verify_not_halted(tdev, ep, urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001397 if (retval < 0)
1398 return retval;
1399
1400 /* NOTE: could also verify SET_INTERFACE clear halts ... */
1401
1402 return 0;
1403}
1404
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001405static int halt_simple(struct usbtest_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001406{
Paul Zimmerman6a23ccd2012-04-16 14:19:07 -07001407 int ep;
1408 int retval = 0;
1409 struct urb *urb;
1410 struct usb_device *udev = testdev_to_usbdev(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001411
Paul Zimmerman6a23ccd2012-04-16 14:19:07 -07001412 if (udev->speed == USB_SPEED_SUPER)
1413 urb = simple_alloc_urb(udev, 0, 1024);
1414 else
1415 urb = simple_alloc_urb(udev, 0, 512);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001416 if (urb == NULL)
1417 return -ENOMEM;
1418
1419 if (dev->in_pipe) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001420 ep = usb_pipeendpoint(dev->in_pipe) | USB_DIR_IN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001421 urb->pipe = dev->in_pipe;
David Brownell28ffd792008-04-25 18:51:10 -07001422 retval = test_halt(dev, ep, urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001423 if (retval < 0)
1424 goto done;
1425 }
1426
1427 if (dev->out_pipe) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001428 ep = usb_pipeendpoint(dev->out_pipe);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001429 urb->pipe = dev->out_pipe;
David Brownell28ffd792008-04-25 18:51:10 -07001430 retval = test_halt(dev, ep, urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001431 }
1432done:
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001433 simple_free_urb(urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001434 return retval;
1435}
1436
1437/*-------------------------------------------------------------------------*/
1438
1439/* Control OUT tests use the vendor control requests from Intel's
1440 * USB 2.0 compliance test device: write a buffer, read it back.
1441 *
1442 * Intel's spec only _requires_ that it work for one packet, which
1443 * is pretty weak. Some HCDs place limits here; most devices will
1444 * need to be able to handle more than one OUT data packet. We'll
1445 * try whatever we're told to try.
1446 */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001447static int ctrl_out(struct usbtest_dev *dev,
Martin Fuzzey084fb202011-01-16 19:17:11 +01001448 unsigned count, unsigned length, unsigned vary, unsigned offset)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001449{
Orjan Fribergf54fa842006-08-08 23:31:40 -07001450 unsigned i, j, len;
1451 int retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001452 u8 *buf;
1453 char *what = "?";
1454 struct usb_device *udev;
Orjan Fribergf54fa842006-08-08 23:31:40 -07001455
David Brownellff7c79e2005-04-22 13:17:00 -07001456 if (length < 1 || length > 0xffff || vary >= length)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001457 return -EINVAL;
1458
Martin Fuzzey084fb202011-01-16 19:17:11 +01001459 buf = kmalloc(length + offset, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001460 if (!buf)
1461 return -ENOMEM;
1462
Martin Fuzzey084fb202011-01-16 19:17:11 +01001463 buf += offset;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001464 udev = testdev_to_usbdev(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001465 len = length;
1466 retval = 0;
1467
1468 /* NOTE: hardware might well act differently if we pushed it
1469 * with lots back-to-back queued requests.
1470 */
1471 for (i = 0; i < count; i++) {
1472 /* write patterned data */
1473 for (j = 0; j < len; j++)
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001474 buf[j] = i + j;
1475 retval = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
Linus Torvalds1da177e2005-04-16 15:20:36 -07001476 0x5b, USB_DIR_OUT|USB_TYPE_VENDOR,
1477 0, 0, buf, len, USB_CTRL_SET_TIMEOUT);
1478 if (retval != len) {
1479 what = "write";
David Brownellff7c79e2005-04-22 13:17:00 -07001480 if (retval >= 0) {
David Brownell28ffd792008-04-25 18:51:10 -07001481 ERROR(dev, "ctrl_out, wlen %d (expected %d)\n",
David Brownellff7c79e2005-04-22 13:17:00 -07001482 retval, len);
1483 retval = -EBADMSG;
1484 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001485 break;
1486 }
1487
1488 /* read it back -- assuming nothing intervened!! */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001489 retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
Linus Torvalds1da177e2005-04-16 15:20:36 -07001490 0x5c, USB_DIR_IN|USB_TYPE_VENDOR,
1491 0, 0, buf, len, USB_CTRL_GET_TIMEOUT);
1492 if (retval != len) {
1493 what = "read";
David Brownellff7c79e2005-04-22 13:17:00 -07001494 if (retval >= 0) {
David Brownell28ffd792008-04-25 18:51:10 -07001495 ERROR(dev, "ctrl_out, rlen %d (expected %d)\n",
David Brownellff7c79e2005-04-22 13:17:00 -07001496 retval, len);
1497 retval = -EBADMSG;
1498 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001499 break;
1500 }
1501
1502 /* fail if we can't verify */
1503 for (j = 0; j < len; j++) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001504 if (buf[j] != (u8) (i + j)) {
David Brownell28ffd792008-04-25 18:51:10 -07001505 ERROR(dev, "ctrl_out, byte %d is %d not %d\n",
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001506 j, buf[j], (u8) i + j);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001507 retval = -EBADMSG;
1508 break;
1509 }
1510 }
1511 if (retval < 0) {
1512 what = "verify";
1513 break;
1514 }
1515
1516 len += vary;
David Brownellff7c79e2005-04-22 13:17:00 -07001517
1518 /* [real world] the "zero bytes IN" case isn't really used.
Joe Perchesdc0d5c12007-12-17 11:40:18 -08001519 * hardware can easily trip up in this weird case, since its
David Brownellff7c79e2005-04-22 13:17:00 -07001520 * status stage is IN, not OUT like other ep0in transfers.
1521 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001522 if (len > length)
David Brownellff7c79e2005-04-22 13:17:00 -07001523 len = realworld ? 1 : 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001524 }
1525
1526 if (retval < 0)
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001527 ERROR(dev, "ctrl_out %s failed, code %d, count %d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07001528 what, retval, i);
1529
Martin Fuzzey084fb202011-01-16 19:17:11 +01001530 kfree(buf - offset);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001531 return retval;
1532}
1533
1534/*-------------------------------------------------------------------------*/
1535
1536/* ISO tests ... mimics common usage
1537 * - buffer length is split into N packets (mostly maxpacket sized)
1538 * - multi-buffers according to sglen
1539 */
1540
1541struct iso_context {
1542 unsigned count;
1543 unsigned pending;
1544 spinlock_t lock;
1545 struct completion done;
Alan Stern9da21502006-05-22 16:47:13 -04001546 int submit_error;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001547 unsigned long errors;
Alan Stern9da21502006-05-22 16:47:13 -04001548 unsigned long packet_count;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001549 struct usbtest_dev *dev;
1550};
1551
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001552static void iso_callback(struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001553{
1554 struct iso_context *ctx = urb->context;
1555
1556 spin_lock(&ctx->lock);
1557 ctx->count--;
1558
Alan Stern9da21502006-05-22 16:47:13 -04001559 ctx->packet_count += urb->number_of_packets;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001560 if (urb->error_count > 0)
1561 ctx->errors += urb->error_count;
Alan Stern9da21502006-05-22 16:47:13 -04001562 else if (urb->status != 0)
1563 ctx->errors += urb->number_of_packets;
Martin Fuzzey40aed522010-10-01 00:20:48 +02001564 else if (urb->actual_length != urb->transfer_buffer_length)
1565 ctx->errors++;
Martin Fuzzey084fb202011-01-16 19:17:11 +01001566 else if (check_guard_bytes(ctx->dev, urb) != 0)
1567 ctx->errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001568
Alan Stern9da21502006-05-22 16:47:13 -04001569 if (urb->status == 0 && ctx->count > (ctx->pending - 1)
1570 && !ctx->submit_error) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001571 int status = usb_submit_urb(urb, GFP_ATOMIC);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001572 switch (status) {
1573 case 0:
1574 goto done;
1575 default:
David Brownell28ffd792008-04-25 18:51:10 -07001576 dev_err(&ctx->dev->intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001577 "iso resubmit err %d\n",
1578 status);
1579 /* FALLTHROUGH */
1580 case -ENODEV: /* disconnected */
Alan Stern9da21502006-05-22 16:47:13 -04001581 case -ESHUTDOWN: /* endpoint disabled */
1582 ctx->submit_error = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001583 break;
1584 }
1585 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001586
1587 ctx->pending--;
1588 if (ctx->pending == 0) {
1589 if (ctx->errors)
David Brownell28ffd792008-04-25 18:51:10 -07001590 dev_err(&ctx->dev->intf->dev,
Alan Stern9da21502006-05-22 16:47:13 -04001591 "iso test, %lu errors out of %lu\n",
1592 ctx->errors, ctx->packet_count);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001593 complete(&ctx->done);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001594 }
1595done:
1596 spin_unlock(&ctx->lock);
1597}
1598
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001599static struct urb *iso_alloc_urb(
Linus Torvalds1da177e2005-04-16 15:20:36 -07001600 struct usb_device *udev,
1601 int pipe,
1602 struct usb_endpoint_descriptor *desc,
Martin Fuzzey084fb202011-01-16 19:17:11 +01001603 long bytes,
1604 unsigned offset
Linus Torvalds1da177e2005-04-16 15:20:36 -07001605)
1606{
1607 struct urb *urb;
1608 unsigned i, maxp, packets;
1609
1610 if (bytes < 0 || !desc)
1611 return NULL;
Kuninori Morimoto29cc8892011-08-23 03:12:03 -07001612 maxp = 0x7ff & usb_endpoint_maxp(desc);
1613 maxp *= 1 + (0x3 & (usb_endpoint_maxp(desc) >> 11));
Julia Lawalldfa5ec72008-03-04 15:25:11 -08001614 packets = DIV_ROUND_UP(bytes, maxp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001615
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001616 urb = usb_alloc_urb(packets, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001617 if (!urb)
1618 return urb;
1619 urb->dev = udev;
1620 urb->pipe = pipe;
1621
1622 urb->number_of_packets = packets;
1623 urb->transfer_buffer_length = bytes;
Martin Fuzzey084fb202011-01-16 19:17:11 +01001624 urb->transfer_buffer = usb_alloc_coherent(udev, bytes + offset,
1625 GFP_KERNEL,
1626 &urb->transfer_dma);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001627 if (!urb->transfer_buffer) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001628 usb_free_urb(urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001629 return NULL;
1630 }
Martin Fuzzey084fb202011-01-16 19:17:11 +01001631 if (offset) {
1632 memset(urb->transfer_buffer, GUARD_BYTE, offset);
1633 urb->transfer_buffer += offset;
1634 urb->transfer_dma += offset;
1635 }
1636 /* For inbound transfers use guard byte so that test fails if
1637 data not correctly copied */
1638 memset(urb->transfer_buffer,
1639 usb_pipein(urb->pipe) ? GUARD_BYTE : 0,
1640 bytes);
1641
Linus Torvalds1da177e2005-04-16 15:20:36 -07001642 for (i = 0; i < packets; i++) {
1643 /* here, only the last packet will be short */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001644 urb->iso_frame_desc[i].length = min((unsigned) bytes, maxp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001645 bytes -= urb->iso_frame_desc[i].length;
1646
1647 urb->iso_frame_desc[i].offset = maxp * i;
1648 }
1649
1650 urb->complete = iso_callback;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001651 /* urb->context = SET BY CALLER */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001652 urb->interval = 1 << (desc->bInterval - 1);
1653 urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP;
1654 return urb;
1655}
1656
1657static int
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001658test_iso_queue(struct usbtest_dev *dev, struct usbtest_param *param,
Martin Fuzzey084fb202011-01-16 19:17:11 +01001659 int pipe, struct usb_endpoint_descriptor *desc, unsigned offset)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001660{
1661 struct iso_context context;
1662 struct usb_device *udev;
1663 unsigned i;
1664 unsigned long packets = 0;
Alan Stern9da21502006-05-22 16:47:13 -04001665 int status = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001666 struct urb *urbs[10]; /* FIXME no limit */
1667
1668 if (param->sglen > 10)
1669 return -EDOM;
1670
Alan Stern9da21502006-05-22 16:47:13 -04001671 memset(&context, 0, sizeof context);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001672 context.count = param->iterations * param->sglen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001673 context.dev = dev;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001674 init_completion(&context.done);
1675 spin_lock_init(&context.lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001676
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001677 memset(urbs, 0, sizeof urbs);
1678 udev = testdev_to_usbdev(dev);
David Brownell28ffd792008-04-25 18:51:10 -07001679 dev_info(&dev->intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001680 "... iso period %d %sframes, wMaxPacket %04x\n",
1681 1 << (desc->bInterval - 1),
1682 (udev->speed == USB_SPEED_HIGH) ? "micro" : "",
Kuninori Morimoto29cc8892011-08-23 03:12:03 -07001683 usb_endpoint_maxp(desc));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001684
1685 for (i = 0; i < param->sglen; i++) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001686 urbs[i] = iso_alloc_urb(udev, pipe, desc,
Martin Fuzzey084fb202011-01-16 19:17:11 +01001687 param->length, offset);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001688 if (!urbs[i]) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001689 status = -ENOMEM;
1690 goto fail;
1691 }
1692 packets += urbs[i]->number_of_packets;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001693 urbs[i]->context = &context;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001694 }
1695 packets *= param->iterations;
David Brownell28ffd792008-04-25 18:51:10 -07001696 dev_info(&dev->intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001697 "... total %lu msec (%lu packets)\n",
1698 (packets * (1 << (desc->bInterval - 1)))
1699 / ((udev->speed == USB_SPEED_HIGH) ? 8 : 1),
1700 packets);
1701
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001702 spin_lock_irq(&context.lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001703 for (i = 0; i < param->sglen; i++) {
Alan Stern9da21502006-05-22 16:47:13 -04001704 ++context.pending;
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001705 status = usb_submit_urb(urbs[i], GFP_ATOMIC);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001706 if (status < 0) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001707 ERROR(dev, "submit iso[%d], error %d\n", i, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001708 if (i == 0) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001709 spin_unlock_irq(&context.lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001710 goto fail;
1711 }
1712
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001713 simple_free_urb(urbs[i]);
Ming Leie10e1be2010-08-02 22:09:01 +08001714 urbs[i] = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001715 context.pending--;
Alan Stern9da21502006-05-22 16:47:13 -04001716 context.submit_error = 1;
1717 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001718 }
1719 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001720 spin_unlock_irq(&context.lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001721
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001722 wait_for_completion(&context.done);
Alan Stern9da21502006-05-22 16:47:13 -04001723
Ming Leie10e1be2010-08-02 22:09:01 +08001724 for (i = 0; i < param->sglen; i++) {
1725 if (urbs[i])
1726 simple_free_urb(urbs[i]);
1727 }
Alan Stern9da21502006-05-22 16:47:13 -04001728 /*
1729 * Isochronous transfers are expected to fail sometimes. As an
1730 * arbitrary limit, we will report an error if any submissions
1731 * fail or if the transfer failure rate is > 10%.
1732 */
1733 if (status != 0)
1734 ;
1735 else if (context.submit_error)
1736 status = -EACCES;
1737 else if (context.errors > context.packet_count / 10)
1738 status = -EIO;
1739 return status;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001740
1741fail:
1742 for (i = 0; i < param->sglen; i++) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001743 if (urbs[i])
1744 simple_free_urb(urbs[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001745 }
1746 return status;
1747}
1748
Martin Fuzzey084fb202011-01-16 19:17:11 +01001749static int test_unaligned_bulk(
1750 struct usbtest_dev *tdev,
1751 int pipe,
1752 unsigned length,
1753 int iterations,
1754 unsigned transfer_flags,
1755 const char *label)
1756{
1757 int retval;
1758 struct urb *urb = usbtest_alloc_urb(
1759 testdev_to_usbdev(tdev), pipe, length, transfer_flags, 1);
1760
1761 if (!urb)
1762 return -ENOMEM;
1763
1764 retval = simple_io(tdev, urb, iterations, 0, 0, label);
1765 simple_free_urb(urb);
1766 return retval;
1767}
1768
Linus Torvalds1da177e2005-04-16 15:20:36 -07001769/*-------------------------------------------------------------------------*/
1770
1771/* We only have this one interface to user space, through usbfs.
1772 * User mode code can scan usbfs to find N different devices (maybe on
1773 * different busses) to use when testing, and allocate one thread per
1774 * test. So discovery is simplified, and we have no device naming issues.
1775 *
1776 * Don't use these only as stress/load tests. Use them along with with
1777 * other USB bus activity: plugging, unplugging, mousing, mp3 playback,
1778 * video capture, and so on. Run different tests at different times, in
1779 * different sequences. Nothing here should interact with other devices,
1780 * except indirectly by consuming USB bandwidth and CPU resources for test
1781 * threads and request completion. But the only way to know that for sure
1782 * is to test when HC queues are in use by many devices.
David Brownell28ffd792008-04-25 18:51:10 -07001783 *
1784 * WARNING: Because usbfs grabs udev->dev.sem before calling this ioctl(),
1785 * it locks out usbcore in certain code paths. Notably, if you disconnect
1786 * the device-under-test, khubd will wait block forever waiting for the
1787 * ioctl to complete ... so that usb_disconnect() can abort the pending
1788 * urbs and then call usbtest_disconnect(). To abort a test, you're best
1789 * off just killing the userspace task and waiting for it to exit.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001790 */
1791
1792static int
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001793usbtest_ioctl(struct usb_interface *intf, unsigned int code, void *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001794{
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001795 struct usbtest_dev *dev = usb_get_intfdata(intf);
1796 struct usb_device *udev = testdev_to_usbdev(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001797 struct usbtest_param *param = buf;
1798 int retval = -EOPNOTSUPP;
1799 struct urb *urb;
1800 struct scatterlist *sg;
1801 struct usb_sg_request req;
1802 struct timeval start;
1803 unsigned i;
1804
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001805 /* FIXME USBDEVFS_CONNECTINFO doesn't say how fast the device is. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001806
Vikram Pandita7f4e9852009-11-09 21:24:32 -06001807 pattern = mod_pattern;
1808
Linus Torvalds1da177e2005-04-16 15:20:36 -07001809 if (code != USBTEST_REQUEST)
1810 return -EOPNOTSUPP;
1811
roel kluin8aafdf62008-10-21 00:36:44 -04001812 if (param->iterations <= 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001813 return -EINVAL;
1814
Matthias Kaehlcke1cfab022007-12-13 16:15:33 -08001815 if (mutex_lock_interruptible(&dev->lock))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001816 return -ERESTARTSYS;
1817
Alan Stern70a1c9e2008-03-06 17:00:58 -05001818 /* FIXME: What if a system sleep starts while a test is running? */
David Brownellff7c79e2005-04-22 13:17:00 -07001819
Linus Torvalds1da177e2005-04-16 15:20:36 -07001820 /* some devices, like ez-usb default devices, need a non-default
1821 * altsetting to have any active endpoints. some tests change
1822 * altsettings; force a default so most tests don't need to check.
1823 */
1824 if (dev->info->alt >= 0) {
David Brownell28ffd792008-04-25 18:51:10 -07001825 int res;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001826
1827 if (intf->altsetting->desc.bInterfaceNumber) {
Matthias Kaehlcke1cfab022007-12-13 16:15:33 -08001828 mutex_unlock(&dev->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001829 return -ENODEV;
1830 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001831 res = set_altsetting(dev, dev->info->alt);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001832 if (res) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001833 dev_err(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001834 "set altsetting to %d failed, %d\n",
1835 dev->info->alt, res);
Matthias Kaehlcke1cfab022007-12-13 16:15:33 -08001836 mutex_unlock(&dev->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001837 return res;
1838 }
1839 }
1840
1841 /*
1842 * Just a bunch of test cases that every HCD is expected to handle.
1843 *
1844 * Some may need specific firmware, though it'd be good to have
1845 * one firmware image to handle all the test cases.
1846 *
1847 * FIXME add more tests! cancel requests, verify the data, control
1848 * queueing, concurrent read+write threads, and so on.
1849 */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001850 do_gettimeofday(&start);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001851 switch (param->test_num) {
1852
1853 case 0:
David Brownell28ffd792008-04-25 18:51:10 -07001854 dev_info(&intf->dev, "TEST 0: NOP\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001855 retval = 0;
1856 break;
1857
1858 /* Simple non-queued bulk I/O tests */
1859 case 1:
1860 if (dev->out_pipe == 0)
1861 break;
David Brownell28ffd792008-04-25 18:51:10 -07001862 dev_info(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001863 "TEST 1: write %d bytes %u times\n",
1864 param->length, param->iterations);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001865 urb = simple_alloc_urb(udev, dev->out_pipe, param->length);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001866 if (!urb) {
1867 retval = -ENOMEM;
1868 break;
1869 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001870 /* FIRMWARE: bulk sink (maybe accepts short writes) */
David Brownell28ffd792008-04-25 18:51:10 -07001871 retval = simple_io(dev, urb, param->iterations, 0, 0, "test1");
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001872 simple_free_urb(urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001873 break;
1874 case 2:
1875 if (dev->in_pipe == 0)
1876 break;
David Brownell28ffd792008-04-25 18:51:10 -07001877 dev_info(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001878 "TEST 2: read %d bytes %u times\n",
1879 param->length, param->iterations);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001880 urb = simple_alloc_urb(udev, dev->in_pipe, param->length);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001881 if (!urb) {
1882 retval = -ENOMEM;
1883 break;
1884 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001885 /* FIRMWARE: bulk source (maybe generates short writes) */
David Brownell28ffd792008-04-25 18:51:10 -07001886 retval = simple_io(dev, urb, param->iterations, 0, 0, "test2");
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001887 simple_free_urb(urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001888 break;
1889 case 3:
1890 if (dev->out_pipe == 0 || param->vary == 0)
1891 break;
David Brownell28ffd792008-04-25 18:51:10 -07001892 dev_info(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001893 "TEST 3: write/%d 0..%d bytes %u times\n",
1894 param->vary, param->length, param->iterations);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001895 urb = simple_alloc_urb(udev, dev->out_pipe, param->length);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001896 if (!urb) {
1897 retval = -ENOMEM;
1898 break;
1899 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001900 /* FIRMWARE: bulk sink (maybe accepts short writes) */
David Brownell28ffd792008-04-25 18:51:10 -07001901 retval = simple_io(dev, urb, param->iterations, param->vary,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001902 0, "test3");
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001903 simple_free_urb(urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001904 break;
1905 case 4:
1906 if (dev->in_pipe == 0 || param->vary == 0)
1907 break;
David Brownell28ffd792008-04-25 18:51:10 -07001908 dev_info(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001909 "TEST 4: read/%d 0..%d bytes %u times\n",
1910 param->vary, param->length, param->iterations);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001911 urb = simple_alloc_urb(udev, dev->in_pipe, param->length);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001912 if (!urb) {
1913 retval = -ENOMEM;
1914 break;
1915 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001916 /* FIRMWARE: bulk source (maybe generates short writes) */
David Brownell28ffd792008-04-25 18:51:10 -07001917 retval = simple_io(dev, urb, param->iterations, param->vary,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001918 0, "test4");
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001919 simple_free_urb(urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001920 break;
1921
1922 /* Queued bulk I/O tests */
1923 case 5:
1924 if (dev->out_pipe == 0 || param->sglen == 0)
1925 break;
David Brownell28ffd792008-04-25 18:51:10 -07001926 dev_info(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001927 "TEST 5: write %d sglists %d entries of %d bytes\n",
1928 param->iterations,
1929 param->sglen, param->length);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001930 sg = alloc_sglist(param->sglen, param->length, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001931 if (!sg) {
1932 retval = -ENOMEM;
1933 break;
1934 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001935 /* FIRMWARE: bulk sink (maybe accepts short writes) */
David Brownell28ffd792008-04-25 18:51:10 -07001936 retval = perform_sglist(dev, param->iterations, dev->out_pipe,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001937 &req, sg, param->sglen);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001938 free_sglist(sg, param->sglen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001939 break;
1940
1941 case 6:
1942 if (dev->in_pipe == 0 || param->sglen == 0)
1943 break;
David Brownell28ffd792008-04-25 18:51:10 -07001944 dev_info(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001945 "TEST 6: read %d sglists %d entries of %d bytes\n",
1946 param->iterations,
1947 param->sglen, param->length);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001948 sg = alloc_sglist(param->sglen, param->length, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001949 if (!sg) {
1950 retval = -ENOMEM;
1951 break;
1952 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001953 /* FIRMWARE: bulk source (maybe generates short writes) */
David Brownell28ffd792008-04-25 18:51:10 -07001954 retval = perform_sglist(dev, param->iterations, dev->in_pipe,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001955 &req, sg, param->sglen);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001956 free_sglist(sg, param->sglen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001957 break;
1958 case 7:
1959 if (dev->out_pipe == 0 || param->sglen == 0 || param->vary == 0)
1960 break;
David Brownell28ffd792008-04-25 18:51:10 -07001961 dev_info(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001962 "TEST 7: write/%d %d sglists %d entries 0..%d bytes\n",
1963 param->vary, param->iterations,
1964 param->sglen, param->length);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001965 sg = alloc_sglist(param->sglen, param->length, param->vary);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001966 if (!sg) {
1967 retval = -ENOMEM;
1968 break;
1969 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001970 /* FIRMWARE: bulk sink (maybe accepts short writes) */
David Brownell28ffd792008-04-25 18:51:10 -07001971 retval = perform_sglist(dev, param->iterations, dev->out_pipe,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001972 &req, sg, param->sglen);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001973 free_sglist(sg, param->sglen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001974 break;
1975 case 8:
1976 if (dev->in_pipe == 0 || param->sglen == 0 || param->vary == 0)
1977 break;
David Brownell28ffd792008-04-25 18:51:10 -07001978 dev_info(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001979 "TEST 8: read/%d %d sglists %d entries 0..%d bytes\n",
1980 param->vary, param->iterations,
1981 param->sglen, param->length);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001982 sg = alloc_sglist(param->sglen, param->length, param->vary);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001983 if (!sg) {
1984 retval = -ENOMEM;
1985 break;
1986 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001987 /* FIRMWARE: bulk source (maybe generates short writes) */
David Brownell28ffd792008-04-25 18:51:10 -07001988 retval = perform_sglist(dev, param->iterations, dev->in_pipe,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001989 &req, sg, param->sglen);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02001990 free_sglist(sg, param->sglen);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001991 break;
1992
1993 /* non-queued sanity tests for control (chapter 9 subset) */
1994 case 9:
1995 retval = 0;
David Brownell28ffd792008-04-25 18:51:10 -07001996 dev_info(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001997 "TEST 9: ch9 (subset) control tests, %d times\n",
1998 param->iterations);
1999 for (i = param->iterations; retval == 0 && i--; /* NOP */)
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002000 retval = ch9_postconfig(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002001 if (retval)
David Brownell28ffd792008-04-25 18:51:10 -07002002 dev_err(&intf->dev, "ch9 subset failed, "
2003 "iterations left %d\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002004 break;
2005
2006 /* queued control messaging */
2007 case 10:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002008 retval = 0;
David Brownell28ffd792008-04-25 18:51:10 -07002009 dev_info(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002010 "TEST 10: queue %d control calls, %d times\n",
2011 param->sglen,
2012 param->iterations);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002013 retval = test_ctrl_queue(dev, param);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002014 break;
2015
2016 /* simple non-queued unlinks (ring with one urb) */
2017 case 11:
2018 if (dev->in_pipe == 0 || !param->length)
2019 break;
2020 retval = 0;
David Brownell28ffd792008-04-25 18:51:10 -07002021 dev_info(&intf->dev, "TEST 11: unlink %d reads of %d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07002022 param->iterations, param->length);
2023 for (i = param->iterations; retval == 0 && i--; /* NOP */)
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002024 retval = unlink_simple(dev, dev->in_pipe,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002025 param->length);
2026 if (retval)
David Brownell28ffd792008-04-25 18:51:10 -07002027 dev_err(&intf->dev, "unlink reads failed %d, "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002028 "iterations left %d\n", retval, i);
2029 break;
2030 case 12:
2031 if (dev->out_pipe == 0 || !param->length)
2032 break;
2033 retval = 0;
David Brownell28ffd792008-04-25 18:51:10 -07002034 dev_info(&intf->dev, "TEST 12: unlink %d writes of %d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07002035 param->iterations, param->length);
2036 for (i = param->iterations; retval == 0 && i--; /* NOP */)
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002037 retval = unlink_simple(dev, dev->out_pipe,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002038 param->length);
2039 if (retval)
David Brownell28ffd792008-04-25 18:51:10 -07002040 dev_err(&intf->dev, "unlink writes failed %d, "
Linus Torvalds1da177e2005-04-16 15:20:36 -07002041 "iterations left %d\n", retval, i);
2042 break;
2043
2044 /* ep halt tests */
2045 case 13:
2046 if (dev->out_pipe == 0 && dev->in_pipe == 0)
2047 break;
2048 retval = 0;
David Brownell28ffd792008-04-25 18:51:10 -07002049 dev_info(&intf->dev, "TEST 13: set/clear %d halts\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07002050 param->iterations);
2051 for (i = param->iterations; retval == 0 && i--; /* NOP */)
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002052 retval = halt_simple(dev);
David Brownell28ffd792008-04-25 18:51:10 -07002053
Linus Torvalds1da177e2005-04-16 15:20:36 -07002054 if (retval)
David Brownell28ffd792008-04-25 18:51:10 -07002055 ERROR(dev, "halts failed, iterations left %d\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002056 break;
2057
2058 /* control write tests */
2059 case 14:
2060 if (!dev->info->ctrl_out)
2061 break;
David Brownell28ffd792008-04-25 18:51:10 -07002062 dev_info(&intf->dev, "TEST 14: %d ep0out, %d..%d vary %d\n",
David Brownellff7c79e2005-04-22 13:17:00 -07002063 param->iterations,
2064 realworld ? 1 : 0, param->length,
2065 param->vary);
David Brownell28ffd792008-04-25 18:51:10 -07002066 retval = ctrl_out(dev, param->iterations,
Martin Fuzzey084fb202011-01-16 19:17:11 +01002067 param->length, param->vary, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002068 break;
2069
2070 /* iso write tests */
2071 case 15:
2072 if (dev->out_iso_pipe == 0 || param->sglen == 0)
2073 break;
David Brownell28ffd792008-04-25 18:51:10 -07002074 dev_info(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002075 "TEST 15: write %d iso, %d entries of %d bytes\n",
2076 param->iterations,
2077 param->sglen, param->length);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002078 /* FIRMWARE: iso sink */
2079 retval = test_iso_queue(dev, param,
Martin Fuzzey084fb202011-01-16 19:17:11 +01002080 dev->out_iso_pipe, dev->iso_out, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002081 break;
2082
2083 /* iso read tests */
2084 case 16:
2085 if (dev->in_iso_pipe == 0 || param->sglen == 0)
2086 break;
David Brownell28ffd792008-04-25 18:51:10 -07002087 dev_info(&intf->dev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002088 "TEST 16: read %d iso, %d entries of %d bytes\n",
2089 param->iterations,
2090 param->sglen, param->length);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002091 /* FIRMWARE: iso source */
2092 retval = test_iso_queue(dev, param,
Martin Fuzzey084fb202011-01-16 19:17:11 +01002093 dev->in_iso_pipe, dev->iso_in, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002094 break;
2095
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002096 /* FIXME scatterlist cancel (needs helper thread) */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002097
Martin Fuzzey084fb202011-01-16 19:17:11 +01002098 /* Tests for bulk I/O using DMA mapping by core and odd address */
2099 case 17:
2100 if (dev->out_pipe == 0)
2101 break;
2102 dev_info(&intf->dev,
2103 "TEST 17: write odd addr %d bytes %u times core map\n",
2104 param->length, param->iterations);
2105
2106 retval = test_unaligned_bulk(
2107 dev, dev->out_pipe,
2108 param->length, param->iterations,
2109 0, "test17");
2110 break;
2111
2112 case 18:
2113 if (dev->in_pipe == 0)
2114 break;
2115 dev_info(&intf->dev,
2116 "TEST 18: read odd addr %d bytes %u times core map\n",
2117 param->length, param->iterations);
2118
2119 retval = test_unaligned_bulk(
2120 dev, dev->in_pipe,
2121 param->length, param->iterations,
2122 0, "test18");
2123 break;
2124
2125 /* Tests for bulk I/O using premapped coherent buffer and odd address */
2126 case 19:
2127 if (dev->out_pipe == 0)
2128 break;
2129 dev_info(&intf->dev,
2130 "TEST 19: write odd addr %d bytes %u times premapped\n",
2131 param->length, param->iterations);
2132
2133 retval = test_unaligned_bulk(
2134 dev, dev->out_pipe,
2135 param->length, param->iterations,
2136 URB_NO_TRANSFER_DMA_MAP, "test19");
2137 break;
2138
2139 case 20:
2140 if (dev->in_pipe == 0)
2141 break;
2142 dev_info(&intf->dev,
2143 "TEST 20: read odd addr %d bytes %u times premapped\n",
2144 param->length, param->iterations);
2145
2146 retval = test_unaligned_bulk(
2147 dev, dev->in_pipe,
2148 param->length, param->iterations,
2149 URB_NO_TRANSFER_DMA_MAP, "test20");
2150 break;
2151
2152 /* control write tests with unaligned buffer */
2153 case 21:
2154 if (!dev->info->ctrl_out)
2155 break;
2156 dev_info(&intf->dev,
2157 "TEST 21: %d ep0out odd addr, %d..%d vary %d\n",
2158 param->iterations,
2159 realworld ? 1 : 0, param->length,
2160 param->vary);
2161 retval = ctrl_out(dev, param->iterations,
2162 param->length, param->vary, 1);
2163 break;
2164
2165 /* unaligned iso tests */
2166 case 22:
2167 if (dev->out_iso_pipe == 0 || param->sglen == 0)
2168 break;
2169 dev_info(&intf->dev,
2170 "TEST 22: write %d iso odd, %d entries of %d bytes\n",
2171 param->iterations,
2172 param->sglen, param->length);
2173 retval = test_iso_queue(dev, param,
2174 dev->out_iso_pipe, dev->iso_out, 1);
2175 break;
2176
2177 case 23:
2178 if (dev->in_iso_pipe == 0 || param->sglen == 0)
2179 break;
2180 dev_info(&intf->dev,
2181 "TEST 23: read %d iso odd, %d entries of %d bytes\n",
2182 param->iterations,
2183 param->sglen, param->length);
2184 retval = test_iso_queue(dev, param,
2185 dev->in_iso_pipe, dev->iso_in, 1);
2186 break;
2187
Alan Stern869410f2011-04-14 11:21:04 -04002188 /* unlink URBs from a bulk-OUT queue */
2189 case 24:
2190 if (dev->out_pipe == 0 || !param->length || param->sglen < 4)
2191 break;
2192 retval = 0;
Alan Stern2cb50002013-01-02 13:58:18 -05002193 dev_info(&intf->dev, "TEST 24: unlink from %d queues of "
Alan Stern869410f2011-04-14 11:21:04 -04002194 "%d %d-byte writes\n",
2195 param->iterations, param->sglen, param->length);
2196 for (i = param->iterations; retval == 0 && i > 0; --i) {
2197 retval = unlink_queued(dev, dev->out_pipe,
2198 param->sglen, param->length);
2199 if (retval) {
2200 dev_err(&intf->dev,
2201 "unlink queued writes failed %d, "
2202 "iterations left %d\n", retval, i);
2203 break;
2204 }
2205 }
2206 break;
2207
Linus Torvalds1da177e2005-04-16 15:20:36 -07002208 }
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002209 do_gettimeofday(&param->duration);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002210 param->duration.tv_sec -= start.tv_sec;
2211 param->duration.tv_usec -= start.tv_usec;
2212 if (param->duration.tv_usec < 0) {
2213 param->duration.tv_usec += 1000 * 1000;
2214 param->duration.tv_sec -= 1;
2215 }
Matthias Kaehlcke1cfab022007-12-13 16:15:33 -08002216 mutex_unlock(&dev->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002217 return retval;
2218}
2219
2220/*-------------------------------------------------------------------------*/
2221
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002222static unsigned force_interrupt;
2223module_param(force_interrupt, uint, 0);
2224MODULE_PARM_DESC(force_interrupt, "0 = test default; else interrupt");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002225
2226#ifdef GENERIC
2227static unsigned short vendor;
2228module_param(vendor, ushort, 0);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002229MODULE_PARM_DESC(vendor, "vendor code (from usb-if)");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002230
2231static unsigned short product;
2232module_param(product, ushort, 0);
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002233MODULE_PARM_DESC(product, "product code (from vendor)");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002234#endif
2235
2236static int
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002237usbtest_probe(struct usb_interface *intf, const struct usb_device_id *id)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002238{
2239 struct usb_device *udev;
2240 struct usbtest_dev *dev;
2241 struct usbtest_info *info;
2242 char *rtest, *wtest;
2243 char *irtest, *iwtest;
2244
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002245 udev = interface_to_usbdev(intf);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002246
2247#ifdef GENERIC
2248 /* specify devices by module parameters? */
2249 if (id->match_flags == 0) {
2250 /* vendor match required, product match optional */
2251 if (!vendor || le16_to_cpu(udev->descriptor.idVendor) != (u16)vendor)
2252 return -ENODEV;
2253 if (product && le16_to_cpu(udev->descriptor.idProduct) != (u16)product)
2254 return -ENODEV;
David Brownell28ffd792008-04-25 18:51:10 -07002255 dev_info(&intf->dev, "matched module params, "
2256 "vend=0x%04x prod=0x%04x\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07002257 le16_to_cpu(udev->descriptor.idVendor),
2258 le16_to_cpu(udev->descriptor.idProduct));
2259 }
2260#endif
2261
Christoph Lametere94b1762006-12-06 20:33:17 -08002262 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002263 if (!dev)
2264 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002265 info = (struct usbtest_info *) id->driver_info;
2266 dev->info = info;
Matthias Kaehlcke1cfab022007-12-13 16:15:33 -08002267 mutex_init(&dev->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002268
2269 dev->intf = intf;
2270
2271 /* cacheline-aligned scratch for i/o */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002272 dev->buf = kmalloc(TBUF_SIZE, GFP_KERNEL);
2273 if (dev->buf == NULL) {
2274 kfree(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002275 return -ENOMEM;
2276 }
2277
2278 /* NOTE this doesn't yet test the handful of difference that are
2279 * visible with high speed interrupts: bigger maxpacket (1K) and
2280 * "high bandwidth" modes (up to 3 packets/uframe).
2281 */
2282 rtest = wtest = "";
2283 irtest = iwtest = "";
2284 if (force_interrupt || udev->speed == USB_SPEED_LOW) {
2285 if (info->ep_in) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002286 dev->in_pipe = usb_rcvintpipe(udev, info->ep_in);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002287 rtest = " intr-in";
2288 }
2289 if (info->ep_out) {
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002290 dev->out_pipe = usb_sndintpipe(udev, info->ep_out);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002291 wtest = " intr-out";
2292 }
2293 } else {
Alan Sternd0b46522013-01-30 16:38:11 -05002294 if (override_alt >= 0 || info->autoconf) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002295 int status;
2296
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002297 status = get_endpoints(dev, intf);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002298 if (status < 0) {
Arjan van de Venb6c63932008-07-25 01:45:52 -07002299 WARNING(dev, "couldn't get endpoints, %d\n",
David Brownell28ffd792008-04-25 18:51:10 -07002300 status);
Julia Lawallf4a728d2012-03-25 21:08:32 +02002301 kfree(dev->buf);
2302 kfree(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002303 return status;
2304 }
2305 /* may find bulk or ISO pipes */
2306 } else {
2307 if (info->ep_in)
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002308 dev->in_pipe = usb_rcvbulkpipe(udev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002309 info->ep_in);
2310 if (info->ep_out)
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002311 dev->out_pipe = usb_sndbulkpipe(udev,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002312 info->ep_out);
2313 }
2314 if (dev->in_pipe)
2315 rtest = " bulk-in";
2316 if (dev->out_pipe)
2317 wtest = " bulk-out";
2318 if (dev->in_iso_pipe)
2319 irtest = " iso-in";
2320 if (dev->out_iso_pipe)
2321 iwtest = " iso-out";
2322 }
2323
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002324 usb_set_intfdata(intf, dev);
2325 dev_info(&intf->dev, "%s\n", info->name);
Michal Nazarewicze538dfd2011-08-30 17:11:19 +02002326 dev_info(&intf->dev, "%s {control%s%s%s%s%s} tests%s\n",
2327 usb_speed_string(udev->speed),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002328 info->ctrl_out ? " in/out" : "",
2329 rtest, wtest,
2330 irtest, iwtest,
2331 info->alt >= 0 ? " (+alt)" : "");
2332 return 0;
2333}
2334
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002335static int usbtest_suspend(struct usb_interface *intf, pm_message_t message)
David Brownellff7c79e2005-04-22 13:17:00 -07002336{
David Brownellff7c79e2005-04-22 13:17:00 -07002337 return 0;
2338}
2339
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002340static int usbtest_resume(struct usb_interface *intf)
David Brownellff7c79e2005-04-22 13:17:00 -07002341{
David Brownellff7c79e2005-04-22 13:17:00 -07002342 return 0;
2343}
2344
2345
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002346static void usbtest_disconnect(struct usb_interface *intf)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002347{
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002348 struct usbtest_dev *dev = usb_get_intfdata(intf);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002349
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002350 usb_set_intfdata(intf, NULL);
2351 dev_dbg(&intf->dev, "disconnect\n");
2352 kfree(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002353}
2354
2355/* Basic testing only needs a device that can source or sink bulk traffic.
2356 * Any device can test control transfers (default with GENERIC binding).
2357 *
2358 * Several entries work with the default EP0 implementation that's built
2359 * into EZ-USB chips. There's a default vendor ID which can be overridden
2360 * by (very) small config EEPROMS, but otherwise all these devices act
2361 * identically until firmware is loaded: only EP0 works. It turns out
2362 * to be easy to make other endpoints work, without modifying that EP0
2363 * behavior. For now, we expect that kind of firmware.
2364 */
2365
2366/* an21xx or fx versions of ez-usb */
2367static struct usbtest_info ez1_info = {
2368 .name = "EZ-USB device",
2369 .ep_in = 2,
2370 .ep_out = 2,
2371 .alt = 1,
2372};
2373
2374/* fx2 version of ez-usb */
2375static struct usbtest_info ez2_info = {
2376 .name = "FX2 device",
2377 .ep_in = 6,
2378 .ep_out = 2,
2379 .alt = 1,
2380};
2381
2382/* ezusb family device with dedicated usb test firmware,
2383 */
2384static struct usbtest_info fw_info = {
2385 .name = "usb test device",
2386 .ep_in = 2,
2387 .ep_out = 2,
2388 .alt = 1,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002389 .autoconf = 1, /* iso and ctrl_out need autoconf */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002390 .ctrl_out = 1,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002391 .iso = 1, /* iso_ep's are #8 in/out */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002392};
2393
2394/* peripheral running Linux and 'zero.c' test firmware, or
2395 * its user-mode cousin. different versions of this use
2396 * different hardware with the same vendor/product codes.
2397 * host side MUST rely on the endpoint descriptors.
2398 */
2399static struct usbtest_info gz_info = {
2400 .name = "Linux gadget zero",
2401 .autoconf = 1,
2402 .ctrl_out = 1,
Boyan Nedeltchev4b85c622012-11-12 13:06:06 +02002403 .iso = 1,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002404 .alt = 0,
2405};
2406
2407static struct usbtest_info um_info = {
2408 .name = "Linux user mode test driver",
2409 .autoconf = 1,
2410 .alt = -1,
2411};
2412
2413static struct usbtest_info um2_info = {
2414 .name = "Linux user mode ISO test driver",
2415 .autoconf = 1,
2416 .iso = 1,
2417 .alt = -1,
2418};
2419
2420#ifdef IBOT2
2421/* this is a nice source of high speed bulk data;
2422 * uses an FX2, with firmware provided in the device
2423 */
2424static struct usbtest_info ibot2_info = {
2425 .name = "iBOT2 webcam",
2426 .ep_in = 2,
2427 .alt = -1,
2428};
2429#endif
2430
2431#ifdef GENERIC
2432/* we can use any device to test control traffic */
2433static struct usbtest_info generic_info = {
2434 .name = "Generic USB device",
2435 .alt = -1,
2436};
2437#endif
2438
Linus Torvalds1da177e2005-04-16 15:20:36 -07002439
Németh Márton33b9e162010-01-10 15:34:45 +01002440static const struct usb_device_id id_table[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002441
Linus Torvalds1da177e2005-04-16 15:20:36 -07002442 /*-------------------------------------------------------------*/
2443
2444 /* EZ-USB devices which download firmware to replace (or in our
2445 * case augment) the default device implementation.
2446 */
2447
2448 /* generic EZ-USB FX controller */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002449 { USB_DEVICE(0x0547, 0x2235),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002450 .driver_info = (unsigned long) &ez1_info,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002451 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07002452
2453 /* CY3671 development board with EZ-USB FX */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002454 { USB_DEVICE(0x0547, 0x0080),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002455 .driver_info = (unsigned long) &ez1_info,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002456 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07002457
2458 /* generic EZ-USB FX2 controller (or development board) */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002459 { USB_DEVICE(0x04b4, 0x8613),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002460 .driver_info = (unsigned long) &ez2_info,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002461 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07002462
2463 /* re-enumerated usb test device firmware */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002464 { USB_DEVICE(0xfff0, 0xfff0),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002465 .driver_info = (unsigned long) &fw_info,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002466 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07002467
2468 /* "Gadget Zero" firmware runs under Linux */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002469 { USB_DEVICE(0x0525, 0xa4a0),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002470 .driver_info = (unsigned long) &gz_info,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002471 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07002472
2473 /* so does a user-mode variant */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002474 { USB_DEVICE(0x0525, 0xa4a4),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002475 .driver_info = (unsigned long) &um_info,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002476 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07002477
2478 /* ... and a user-mode variant that talks iso */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002479 { USB_DEVICE(0x0525, 0xa4a3),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002480 .driver_info = (unsigned long) &um2_info,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002481 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07002482
2483#ifdef KEYSPAN_19Qi
2484 /* Keyspan 19qi uses an21xx (original EZ-USB) */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002485 /* this does not coexist with the real Keyspan 19qi driver! */
2486 { USB_DEVICE(0x06cd, 0x010b),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002487 .driver_info = (unsigned long) &ez1_info,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002488 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07002489#endif
2490
2491 /*-------------------------------------------------------------*/
2492
2493#ifdef IBOT2
2494 /* iBOT2 makes a nice source of high speed bulk-in data */
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002495 /* this does not coexist with a real iBOT2 driver! */
2496 { USB_DEVICE(0x0b62, 0x0059),
Linus Torvalds1da177e2005-04-16 15:20:36 -07002497 .driver_info = (unsigned long) &ibot2_info,
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002498 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07002499#endif
2500
2501 /*-------------------------------------------------------------*/
2502
2503#ifdef GENERIC
2504 /* module params can specify devices to use for control tests */
2505 { .driver_info = (unsigned long) &generic_info, },
2506#endif
2507
2508 /*-------------------------------------------------------------*/
2509
2510 { }
2511};
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002512MODULE_DEVICE_TABLE(usb, id_table);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002513
2514static struct usb_driver usbtest_driver = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002515 .name = "usbtest",
2516 .id_table = id_table,
2517 .probe = usbtest_probe,
Andi Kleenc532b292010-06-01 23:04:41 +02002518 .unlocked_ioctl = usbtest_ioctl,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002519 .disconnect = usbtest_disconnect,
David Brownellff7c79e2005-04-22 13:17:00 -07002520 .suspend = usbtest_suspend,
2521 .resume = usbtest_resume,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002522};
2523
2524/*-------------------------------------------------------------------------*/
2525
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002526static int __init usbtest_init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002527{
2528#ifdef GENERIC
2529 if (vendor)
David Brownell28ffd792008-04-25 18:51:10 -07002530 pr_debug("params: vend=0x%04x prod=0x%04x\n", vendor, product);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002531#endif
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002532 return usb_register(&usbtest_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002533}
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002534module_init(usbtest_init);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002535
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002536static void __exit usbtest_exit(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002537{
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002538 usb_deregister(&usbtest_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002539}
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002540module_exit(usbtest_exit);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002541
Martin Fuzzeyfabbf212010-10-01 00:20:42 +02002542MODULE_DESCRIPTION("USB Core/HCD Testing Driver");
2543MODULE_LICENSE("GPL");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002544