]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | #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> | |
378f058c | 8 | #include <linux/scatterlist.h> |
1cfab028 | 9 | #include <linux/mutex.h> |
32b36eea | 10 | #include <linux/timer.h> |
1da177e4 LT |
11 | #include <linux/usb.h> |
12 | ||
e5e47465 | 13 | #define SIMPLE_IO_TIMEOUT 10000 /* in milliseconds */ |
1da177e4 | 14 | |
d0b4652f AS |
15 | /*-------------------------------------------------------------------------*/ |
16 | ||
17 | static int override_alt = -1; | |
18 | module_param_named(alt, override_alt, int, 0644); | |
19 | MODULE_PARM_DESC(alt, ">= 0 to override altsetting selection"); | |
20 | ||
1da177e4 LT |
21 | /*-------------------------------------------------------------------------*/ |
22 | ||
fabbf219 | 23 | /* FIXME make these public somewhere; usbdevfs.h? */ |
1da177e4 | 24 | struct usbtest_param { |
fabbf219 | 25 | /* inputs */ |
1da177e4 LT |
26 | unsigned test_num; /* 0..(TEST_CASES-1) */ |
27 | unsigned iterations; | |
28 | unsigned length; | |
29 | unsigned vary; | |
30 | unsigned sglen; | |
31 | ||
fabbf219 | 32 | /* outputs */ |
1da177e4 LT |
33 | struct timeval duration; |
34 | }; | |
35 | #define USBTEST_REQUEST _IOWR('U', 100, struct usbtest_param) | |
36 | ||
37 | /*-------------------------------------------------------------------------*/ | |
38 | ||
39 | #define GENERIC /* let probe() bind using module params */ | |
40 | ||
41 | /* Some devices that can be used for testing will have "real" drivers. | |
42 | * Entries for those need to be enabled here by hand, after disabling | |
43 | * that "real" driver. | |
44 | */ | |
45 | //#define IBOT2 /* grab iBOT2 webcams */ | |
46 | //#define KEYSPAN_19Qi /* grab un-renumerated serial adapter */ | |
47 | ||
48 | /*-------------------------------------------------------------------------*/ | |
49 | ||
50 | struct usbtest_info { | |
51 | const char *name; | |
52 | u8 ep_in; /* bulk/intr source */ | |
53 | u8 ep_out; /* bulk/intr sink */ | |
fabbf219 MF |
54 | unsigned autoconf:1; |
55 | unsigned ctrl_out:1; | |
56 | unsigned iso:1; /* try iso in/out */ | |
457a0955 | 57 | unsigned intr:1; /* try interrupt in/out */ |
1da177e4 LT |
58 | int alt; |
59 | }; | |
60 | ||
61 | /* this is accessed only through usbfs ioctl calls. | |
62 | * one ioctl to issue a test ... one lock per device. | |
63 | * tests create other threads if they need them. | |
64 | * urbs and buffers are allocated dynamically, | |
65 | * and data generated deterministically. | |
66 | */ | |
67 | struct usbtest_dev { | |
68 | struct usb_interface *intf; | |
69 | struct usbtest_info *info; | |
70 | int in_pipe; | |
71 | int out_pipe; | |
72 | int in_iso_pipe; | |
73 | int out_iso_pipe; | |
457a0955 AV |
74 | int in_int_pipe; |
75 | int out_int_pipe; | |
1da177e4 | 76 | struct usb_endpoint_descriptor *iso_in, *iso_out; |
457a0955 | 77 | struct usb_endpoint_descriptor *int_in, *int_out; |
1cfab028 | 78 | struct mutex lock; |
1da177e4 LT |
79 | |
80 | #define TBUF_SIZE 256 | |
81 | u8 *buf; | |
82 | }; | |
83 | ||
fabbf219 | 84 | static struct usb_device *testdev_to_usbdev(struct usbtest_dev *test) |
1da177e4 | 85 | { |
fabbf219 | 86 | return interface_to_usbdev(test->intf); |
1da177e4 LT |
87 | } |
88 | ||
89 | /* set up all urbs so they can be used with either bulk or interrupt */ | |
90 | #define INTERRUPT_RATE 1 /* msec/transfer */ | |
91 | ||
28ffd79c DB |
92 | #define ERROR(tdev, fmt, args...) \ |
93 | dev_err(&(tdev)->intf->dev , fmt , ## args) | |
b6c63937 | 94 | #define WARNING(tdev, fmt, args...) \ |
28ffd79c | 95 | dev_warn(&(tdev)->intf->dev , fmt , ## args) |
1da177e4 | 96 | |
084fb206 | 97 | #define GUARD_BYTE 0xA5 |
41d3c0b8 | 98 | #define MAX_SGLEN 128 |
084fb206 | 99 | |
1da177e4 LT |
100 | /*-------------------------------------------------------------------------*/ |
101 | ||
102 | static int | |
fabbf219 | 103 | get_endpoints(struct usbtest_dev *dev, struct usb_interface *intf) |
1da177e4 LT |
104 | { |
105 | int tmp; | |
106 | struct usb_host_interface *alt; | |
107 | struct usb_host_endpoint *in, *out; | |
108 | struct usb_host_endpoint *iso_in, *iso_out; | |
457a0955 | 109 | struct usb_host_endpoint *int_in, *int_out; |
1da177e4 LT |
110 | struct usb_device *udev; |
111 | ||
112 | for (tmp = 0; tmp < intf->num_altsetting; tmp++) { | |
113 | unsigned ep; | |
114 | ||
115 | in = out = NULL; | |
116 | iso_in = iso_out = NULL; | |
457a0955 | 117 | int_in = int_out = NULL; |
1da177e4 LT |
118 | alt = intf->altsetting + tmp; |
119 | ||
d0b4652f AS |
120 | if (override_alt >= 0 && |
121 | override_alt != alt->desc.bAlternateSetting) | |
122 | continue; | |
123 | ||
1da177e4 | 124 | /* take the first altsetting with in-bulk + out-bulk; |
70f23fd6 | 125 | * ignore other endpoints and altsettings. |
1da177e4 LT |
126 | */ |
127 | for (ep = 0; ep < alt->desc.bNumEndpoints; ep++) { | |
128 | struct usb_host_endpoint *e; | |
129 | ||
130 | e = alt->endpoint + ep; | |
9a37a503 | 131 | switch (usb_endpoint_type(&e->desc)) { |
1da177e4 LT |
132 | case USB_ENDPOINT_XFER_BULK: |
133 | break; | |
457a0955 AV |
134 | case USB_ENDPOINT_XFER_INT: |
135 | if (dev->info->intr) | |
136 | goto try_intr; | |
1da177e4 LT |
137 | case USB_ENDPOINT_XFER_ISOC: |
138 | if (dev->info->iso) | |
139 | goto try_iso; | |
fabbf219 | 140 | /* FALLTHROUGH */ |
1da177e4 LT |
141 | default: |
142 | continue; | |
143 | } | |
4d823dd2 | 144 | if (usb_endpoint_dir_in(&e->desc)) { |
1da177e4 LT |
145 | if (!in) |
146 | in = e; | |
147 | } else { | |
148 | if (!out) | |
149 | out = e; | |
150 | } | |
151 | continue; | |
457a0955 AV |
152 | try_intr: |
153 | if (usb_endpoint_dir_in(&e->desc)) { | |
154 | if (!int_in) | |
155 | int_in = e; | |
156 | } else { | |
157 | if (!int_out) | |
158 | int_out = e; | |
159 | } | |
160 | continue; | |
1da177e4 | 161 | try_iso: |
4d823dd2 | 162 | if (usb_endpoint_dir_in(&e->desc)) { |
1da177e4 LT |
163 | if (!iso_in) |
164 | iso_in = e; | |
165 | } else { | |
166 | if (!iso_out) | |
167 | iso_out = e; | |
168 | } | |
169 | } | |
457a0955 | 170 | if ((in && out) || iso_in || iso_out || int_in || int_out) |
1da177e4 LT |
171 | goto found; |
172 | } | |
173 | return -EINVAL; | |
174 | ||
175 | found: | |
fabbf219 | 176 | udev = testdev_to_usbdev(dev); |
d0b4652f | 177 | dev->info->alt = alt->desc.bAlternateSetting; |
1da177e4 | 178 | if (alt->desc.bAlternateSetting != 0) { |
fabbf219 | 179 | tmp = usb_set_interface(udev, |
1da177e4 LT |
180 | alt->desc.bInterfaceNumber, |
181 | alt->desc.bAlternateSetting); | |
182 | if (tmp < 0) | |
183 | return tmp; | |
184 | } | |
185 | ||
186 | if (in) { | |
fabbf219 | 187 | dev->in_pipe = usb_rcvbulkpipe(udev, |
1da177e4 | 188 | in->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK); |
fabbf219 | 189 | dev->out_pipe = usb_sndbulkpipe(udev, |
1da177e4 LT |
190 | out->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK); |
191 | } | |
192 | if (iso_in) { | |
193 | dev->iso_in = &iso_in->desc; | |
fabbf219 | 194 | dev->in_iso_pipe = usb_rcvisocpipe(udev, |
1da177e4 LT |
195 | iso_in->desc.bEndpointAddress |
196 | & USB_ENDPOINT_NUMBER_MASK); | |
951fd8ee ML |
197 | } |
198 | ||
199 | if (iso_out) { | |
1da177e4 | 200 | dev->iso_out = &iso_out->desc; |
fabbf219 | 201 | dev->out_iso_pipe = usb_sndisocpipe(udev, |
1da177e4 LT |
202 | iso_out->desc.bEndpointAddress |
203 | & USB_ENDPOINT_NUMBER_MASK); | |
204 | } | |
457a0955 AV |
205 | |
206 | if (int_in) { | |
207 | dev->int_in = &int_in->desc; | |
208 | dev->in_int_pipe = usb_rcvintpipe(udev, | |
209 | int_in->desc.bEndpointAddress | |
210 | & USB_ENDPOINT_NUMBER_MASK); | |
211 | } | |
212 | ||
213 | if (int_out) { | |
214 | dev->int_out = &int_out->desc; | |
215 | dev->out_int_pipe = usb_sndintpipe(udev, | |
216 | int_out->desc.bEndpointAddress | |
217 | & USB_ENDPOINT_NUMBER_MASK); | |
218 | } | |
1da177e4 LT |
219 | return 0; |
220 | } | |
221 | ||
222 | /*-------------------------------------------------------------------------*/ | |
223 | ||
224 | /* Support for testing basic non-queued I/O streams. | |
225 | * | |
226 | * These just package urbs as requests that can be easily canceled. | |
227 | * Each urb's data buffer is dynamically allocated; callers can fill | |
228 | * them with non-zero test data (or test for it) when appropriate. | |
229 | */ | |
230 | ||
fabbf219 | 231 | static void simple_callback(struct urb *urb) |
1da177e4 | 232 | { |
cdc97792 | 233 | complete(urb->context); |
1da177e4 LT |
234 | } |
235 | ||
084fb206 | 236 | static struct urb *usbtest_alloc_urb( |
1da177e4 LT |
237 | struct usb_device *udev, |
238 | int pipe, | |
084fb206 MF |
239 | unsigned long bytes, |
240 | unsigned transfer_flags, | |
457a0955 AV |
241 | unsigned offset, |
242 | u8 bInterval) | |
1da177e4 LT |
243 | { |
244 | struct urb *urb; | |
245 | ||
fabbf219 | 246 | urb = usb_alloc_urb(0, GFP_KERNEL); |
1da177e4 LT |
247 | if (!urb) |
248 | return urb; | |
457a0955 AV |
249 | |
250 | if (bInterval) | |
251 | usb_fill_int_urb(urb, udev, pipe, NULL, bytes, simple_callback, | |
252 | NULL, bInterval); | |
253 | else | |
254 | usb_fill_bulk_urb(urb, udev, pipe, NULL, bytes, simple_callback, | |
255 | NULL); | |
256 | ||
1da177e4 LT |
257 | urb->interval = (udev->speed == USB_SPEED_HIGH) |
258 | ? (INTERRUPT_RATE << 3) | |
259 | : INTERRUPT_RATE; | |
084fb206 | 260 | urb->transfer_flags = transfer_flags; |
fabbf219 | 261 | if (usb_pipein(pipe)) |
1da177e4 | 262 | urb->transfer_flags |= URB_SHORT_NOT_OK; |
084fb206 MF |
263 | |
264 | if (urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP) | |
265 | urb->transfer_buffer = usb_alloc_coherent(udev, bytes + offset, | |
266 | GFP_KERNEL, &urb->transfer_dma); | |
267 | else | |
268 | urb->transfer_buffer = kmalloc(bytes + offset, GFP_KERNEL); | |
269 | ||
1da177e4 | 270 | if (!urb->transfer_buffer) { |
fabbf219 | 271 | usb_free_urb(urb); |
084fb206 MF |
272 | return NULL; |
273 | } | |
274 | ||
275 | /* To test unaligned transfers add an offset and fill the | |
276 | unused memory with a guard value */ | |
277 | if (offset) { | |
278 | memset(urb->transfer_buffer, GUARD_BYTE, offset); | |
279 | urb->transfer_buffer += offset; | |
280 | if (urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP) | |
281 | urb->transfer_dma += offset; | |
282 | } | |
283 | ||
284 | /* For inbound transfers use guard byte so that test fails if | |
285 | data not correctly copied */ | |
286 | memset(urb->transfer_buffer, | |
287 | usb_pipein(urb->pipe) ? GUARD_BYTE : 0, | |
288 | bytes); | |
1da177e4 LT |
289 | return urb; |
290 | } | |
291 | ||
084fb206 MF |
292 | static struct urb *simple_alloc_urb( |
293 | struct usb_device *udev, | |
294 | int pipe, | |
457a0955 AV |
295 | unsigned long bytes, |
296 | u8 bInterval) | |
084fb206 | 297 | { |
457a0955 AV |
298 | return usbtest_alloc_urb(udev, pipe, bytes, URB_NO_TRANSFER_DMA_MAP, 0, |
299 | bInterval); | |
084fb206 MF |
300 | } |
301 | ||
fabbf219 | 302 | static unsigned pattern; |
7f4e9854 VP |
303 | static unsigned mod_pattern; |
304 | module_param_named(pattern, mod_pattern, uint, S_IRUGO | S_IWUSR); | |
305 | MODULE_PARM_DESC(mod_pattern, "i/o pattern (0 == zeroes)"); | |
1da177e4 | 306 | |
fabbf219 | 307 | static inline void simple_fill_buf(struct urb *urb) |
1da177e4 LT |
308 | { |
309 | unsigned i; | |
310 | u8 *buf = urb->transfer_buffer; | |
311 | unsigned len = urb->transfer_buffer_length; | |
312 | ||
313 | switch (pattern) { | |
314 | default: | |
fabbf219 | 315 | /* FALLTHROUGH */ |
1da177e4 | 316 | case 0: |
fabbf219 | 317 | memset(buf, 0, len); |
1da177e4 LT |
318 | break; |
319 | case 1: /* mod63 */ | |
320 | for (i = 0; i < len; i++) | |
321 | *buf++ = (u8) (i % 63); | |
322 | break; | |
323 | } | |
324 | } | |
325 | ||
304b0b57 | 326 | static inline unsigned long buffer_offset(void *buf) |
084fb206 | 327 | { |
304b0b57 | 328 | return (unsigned long)buf & (ARCH_KMALLOC_MINALIGN - 1); |
084fb206 MF |
329 | } |
330 | ||
331 | static int check_guard_bytes(struct usbtest_dev *tdev, struct urb *urb) | |
332 | { | |
333 | u8 *buf = urb->transfer_buffer; | |
334 | u8 *guard = buf - buffer_offset(buf); | |
335 | unsigned i; | |
336 | ||
337 | for (i = 0; guard < buf; i++, guard++) { | |
338 | if (*guard != GUARD_BYTE) { | |
339 | ERROR(tdev, "guard byte[%d] %d (not %d)\n", | |
340 | i, *guard, GUARD_BYTE); | |
341 | return -EINVAL; | |
342 | } | |
343 | } | |
344 | return 0; | |
345 | } | |
346 | ||
347 | static int simple_check_buf(struct usbtest_dev *tdev, struct urb *urb) | |
1da177e4 LT |
348 | { |
349 | unsigned i; | |
350 | u8 expected; | |
351 | u8 *buf = urb->transfer_buffer; | |
352 | unsigned len = urb->actual_length; | |
353 | ||
084fb206 MF |
354 | int ret = check_guard_bytes(tdev, urb); |
355 | if (ret) | |
356 | return ret; | |
357 | ||
1da177e4 LT |
358 | for (i = 0; i < len; i++, buf++) { |
359 | switch (pattern) { | |
360 | /* all-zeroes has no synchronization issues */ | |
361 | case 0: | |
362 | expected = 0; | |
363 | break; | |
364 | /* mod63 stays in sync with short-terminated transfers, | |
365 | * or otherwise when host and gadget agree on how large | |
366 | * each usb transfer request should be. resync is done | |
367 | * with set_interface or set_config. | |
368 | */ | |
369 | case 1: /* mod63 */ | |
370 | expected = i % 63; | |
371 | break; | |
372 | /* always fail unsupported patterns */ | |
373 | default: | |
374 | expected = !*buf; | |
375 | break; | |
376 | } | |
377 | if (*buf == expected) | |
378 | continue; | |
28ffd79c | 379 | ERROR(tdev, "buf[%d] = %d (not %d)\n", i, *buf, expected); |
1da177e4 LT |
380 | return -EINVAL; |
381 | } | |
382 | return 0; | |
383 | } | |
384 | ||
fabbf219 | 385 | static void simple_free_urb(struct urb *urb) |
1da177e4 | 386 | { |
304b0b57 | 387 | unsigned long offset = buffer_offset(urb->transfer_buffer); |
084fb206 MF |
388 | |
389 | if (urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP) | |
390 | usb_free_coherent( | |
391 | urb->dev, | |
392 | urb->transfer_buffer_length + offset, | |
393 | urb->transfer_buffer - offset, | |
394 | urb->transfer_dma - offset); | |
395 | else | |
396 | kfree(urb->transfer_buffer - offset); | |
fabbf219 | 397 | usb_free_urb(urb); |
1da177e4 LT |
398 | } |
399 | ||
fabbf219 | 400 | static int simple_io( |
28ffd79c | 401 | struct usbtest_dev *tdev, |
1da177e4 LT |
402 | struct urb *urb, |
403 | int iterations, | |
404 | int vary, | |
405 | int expected, | |
406 | const char *label | |
407 | ) | |
408 | { | |
409 | struct usb_device *udev = urb->dev; | |
410 | int max = urb->transfer_buffer_length; | |
411 | struct completion completion; | |
412 | int retval = 0; | |
e5e47465 | 413 | unsigned long expire; |
1da177e4 LT |
414 | |
415 | urb->context = &completion; | |
416 | while (retval == 0 && iterations-- > 0) { | |
fabbf219 | 417 | init_completion(&completion); |
7c79d094 | 418 | if (usb_pipeout(urb->pipe)) { |
fabbf219 | 419 | simple_fill_buf(urb); |
7c79d094 SAS |
420 | urb->transfer_flags |= URB_ZERO_PACKET; |
421 | } | |
fabbf219 MF |
422 | retval = usb_submit_urb(urb, GFP_KERNEL); |
423 | if (retval != 0) | |
1da177e4 LT |
424 | break; |
425 | ||
e5e47465 RQ |
426 | expire = msecs_to_jiffies(SIMPLE_IO_TIMEOUT); |
427 | if (!wait_for_completion_timeout(&completion, expire)) { | |
428 | usb_kill_urb(urb); | |
429 | retval = (urb->status == -ENOENT ? | |
430 | -ETIMEDOUT : urb->status); | |
431 | } else { | |
432 | retval = urb->status; | |
433 | } | |
434 | ||
1da177e4 | 435 | urb->dev = udev; |
fabbf219 | 436 | if (retval == 0 && usb_pipein(urb->pipe)) |
28ffd79c | 437 | retval = simple_check_buf(tdev, urb); |
1da177e4 LT |
438 | |
439 | if (vary) { | |
440 | int len = urb->transfer_buffer_length; | |
441 | ||
442 | len += vary; | |
443 | len %= max; | |
444 | if (len == 0) | |
445 | len = (vary < max) ? vary : max; | |
446 | urb->transfer_buffer_length = len; | |
447 | } | |
448 | ||
449 | /* FIXME if endpoint halted, clear halt (and log) */ | |
450 | } | |
451 | urb->transfer_buffer_length = max; | |
452 | ||
453 | if (expected != retval) | |
28ffd79c | 454 | dev_err(&udev->dev, |
1da177e4 LT |
455 | "%s failed, iterations left %d, status %d (not %d)\n", |
456 | label, iterations, retval, expected); | |
457 | return retval; | |
458 | } | |
459 | ||
460 | ||
461 | /*-------------------------------------------------------------------------*/ | |
462 | ||
463 | /* We use scatterlist primitives to test queued I/O. | |
464 | * Yes, this also tests the scatterlist primitives. | |
465 | */ | |
466 | ||
fabbf219 | 467 | static void free_sglist(struct scatterlist *sg, int nents) |
1da177e4 LT |
468 | { |
469 | unsigned i; | |
28ffd79c | 470 | |
1da177e4 LT |
471 | if (!sg) |
472 | return; | |
473 | for (i = 0; i < nents; i++) { | |
45711f1a | 474 | if (!sg_page(&sg[i])) |
1da177e4 | 475 | continue; |
fabbf219 | 476 | kfree(sg_virt(&sg[i])); |
1da177e4 | 477 | } |
fabbf219 | 478 | kfree(sg); |
1da177e4 LT |
479 | } |
480 | ||
481 | static struct scatterlist * | |
fabbf219 | 482 | alloc_sglist(int nents, int max, int vary) |
1da177e4 LT |
483 | { |
484 | struct scatterlist *sg; | |
485 | unsigned i; | |
486 | unsigned size = max; | |
487 | ||
564e6989 DC |
488 | if (max == 0) |
489 | return NULL; | |
490 | ||
f55055b4 | 491 | sg = kmalloc_array(nents, sizeof(*sg), GFP_KERNEL); |
1da177e4 LT |
492 | if (!sg) |
493 | return NULL; | |
4756febb | 494 | sg_init_table(sg, nents); |
1da177e4 LT |
495 | |
496 | for (i = 0; i < nents; i++) { | |
497 | char *buf; | |
8b524901 | 498 | unsigned j; |
1da177e4 | 499 | |
fabbf219 | 500 | buf = kzalloc(size, GFP_KERNEL); |
1da177e4 | 501 | if (!buf) { |
fabbf219 | 502 | free_sglist(sg, i); |
1da177e4 LT |
503 | return NULL; |
504 | } | |
1da177e4 LT |
505 | |
506 | /* kmalloc pages are always physically contiguous! */ | |
4756febb | 507 | sg_set_buf(&sg[i], buf, size); |
1da177e4 | 508 | |
8b524901 DB |
509 | switch (pattern) { |
510 | case 0: | |
511 | /* already zeroed */ | |
512 | break; | |
513 | case 1: | |
514 | for (j = 0; j < size; j++) | |
515 | *buf++ = (u8) (j % 63); | |
516 | break; | |
517 | } | |
518 | ||
1da177e4 LT |
519 | if (vary) { |
520 | size += vary; | |
521 | size %= max; | |
522 | if (size == 0) | |
523 | size = (vary < max) ? vary : max; | |
524 | } | |
525 | } | |
526 | ||
527 | return sg; | |
528 | } | |
529 | ||
32b36eea AS |
530 | static void sg_timeout(unsigned long _req) |
531 | { | |
532 | struct usb_sg_request *req = (struct usb_sg_request *) _req; | |
533 | ||
534 | req->status = -ETIMEDOUT; | |
535 | usb_sg_cancel(req); | |
536 | } | |
537 | ||
fabbf219 | 538 | static int perform_sglist( |
28ffd79c | 539 | struct usbtest_dev *tdev, |
1da177e4 LT |
540 | unsigned iterations, |
541 | int pipe, | |
542 | struct usb_sg_request *req, | |
543 | struct scatterlist *sg, | |
544 | int nents | |
545 | ) | |
546 | { | |
28ffd79c | 547 | struct usb_device *udev = testdev_to_usbdev(tdev); |
1da177e4 | 548 | int retval = 0; |
32b36eea AS |
549 | struct timer_list sg_timer; |
550 | ||
551 | setup_timer_on_stack(&sg_timer, sg_timeout, (unsigned long) req); | |
1da177e4 LT |
552 | |
553 | while (retval == 0 && iterations-- > 0) { | |
fabbf219 | 554 | retval = usb_sg_init(req, udev, pipe, |
1da177e4 LT |
555 | (udev->speed == USB_SPEED_HIGH) |
556 | ? (INTERRUPT_RATE << 3) | |
557 | : INTERRUPT_RATE, | |
e94b1766 | 558 | sg, nents, 0, GFP_KERNEL); |
28ffd79c | 559 | |
1da177e4 LT |
560 | if (retval) |
561 | break; | |
32b36eea AS |
562 | mod_timer(&sg_timer, jiffies + |
563 | msecs_to_jiffies(SIMPLE_IO_TIMEOUT)); | |
fabbf219 | 564 | usb_sg_wait(req); |
32b36eea | 565 | del_timer_sync(&sg_timer); |
1da177e4 LT |
566 | retval = req->status; |
567 | ||
8b524901 DB |
568 | /* FIXME check resulting data pattern */ |
569 | ||
1da177e4 LT |
570 | /* FIXME if endpoint halted, clear halt (and log) */ |
571 | } | |
572 | ||
fabbf219 MF |
573 | /* FIXME for unlink or fault handling tests, don't report |
574 | * failure if retval is as we expected ... | |
575 | */ | |
1da177e4 | 576 | if (retval) |
28ffd79c DB |
577 | ERROR(tdev, "perform_sglist failed, " |
578 | "iterations left %d, status %d\n", | |
1da177e4 LT |
579 | iterations, retval); |
580 | return retval; | |
581 | } | |
582 | ||
583 | ||
584 | /*-------------------------------------------------------------------------*/ | |
585 | ||
586 | /* unqueued control message testing | |
587 | * | |
588 | * there's a nice set of device functional requirements in chapter 9 of the | |
589 | * usb 2.0 spec, which we can apply to ANY device, even ones that don't use | |
590 | * special test firmware. | |
591 | * | |
592 | * we know the device is configured (or suspended) by the time it's visible | |
593 | * through usbfs. we can't change that, so we won't test enumeration (which | |
594 | * worked 'well enough' to get here, this time), power management (ditto), | |
595 | * or remote wakeup (which needs human interaction). | |
596 | */ | |
597 | ||
598 | static unsigned realworld = 1; | |
fabbf219 MF |
599 | module_param(realworld, uint, 0); |
600 | MODULE_PARM_DESC(realworld, "clear to demand stricter spec compliance"); | |
1da177e4 | 601 | |
fabbf219 | 602 | static int get_altsetting(struct usbtest_dev *dev) |
1da177e4 LT |
603 | { |
604 | struct usb_interface *iface = dev->intf; | |
fabbf219 | 605 | struct usb_device *udev = interface_to_usbdev(iface); |
1da177e4 LT |
606 | int retval; |
607 | ||
fabbf219 | 608 | retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), |
1da177e4 | 609 | USB_REQ_GET_INTERFACE, USB_DIR_IN|USB_RECIP_INTERFACE, |
fabbf219 | 610 | 0, iface->altsetting[0].desc.bInterfaceNumber, |
1da177e4 LT |
611 | dev->buf, 1, USB_CTRL_GET_TIMEOUT); |
612 | switch (retval) { | |
613 | case 1: | |
fabbf219 | 614 | return dev->buf[0]; |
1da177e4 LT |
615 | case 0: |
616 | retval = -ERANGE; | |
fabbf219 | 617 | /* FALLTHROUGH */ |
1da177e4 LT |
618 | default: |
619 | return retval; | |
620 | } | |
621 | } | |
622 | ||
fabbf219 | 623 | static int set_altsetting(struct usbtest_dev *dev, int alternate) |
1da177e4 LT |
624 | { |
625 | struct usb_interface *iface = dev->intf; | |
626 | struct usb_device *udev; | |
627 | ||
628 | if (alternate < 0 || alternate >= 256) | |
629 | return -EINVAL; | |
630 | ||
fabbf219 MF |
631 | udev = interface_to_usbdev(iface); |
632 | return usb_set_interface(udev, | |
633 | iface->altsetting[0].desc.bInterfaceNumber, | |
1da177e4 LT |
634 | alternate); |
635 | } | |
636 | ||
28ffd79c | 637 | static int is_good_config(struct usbtest_dev *tdev, int len) |
1da177e4 LT |
638 | { |
639 | struct usb_config_descriptor *config; | |
28ffd79c | 640 | |
f55055b4 | 641 | if (len < sizeof(*config)) |
1da177e4 | 642 | return 0; |
28ffd79c | 643 | config = (struct usb_config_descriptor *) tdev->buf; |
1da177e4 LT |
644 | |
645 | switch (config->bDescriptorType) { | |
646 | case USB_DT_CONFIG: | |
647 | case USB_DT_OTHER_SPEED_CONFIG: | |
648 | if (config->bLength != 9) { | |
28ffd79c | 649 | ERROR(tdev, "bogus config descriptor length\n"); |
1da177e4 LT |
650 | return 0; |
651 | } | |
652 | /* this bit 'must be 1' but often isn't */ | |
653 | if (!realworld && !(config->bmAttributes & 0x80)) { | |
28ffd79c | 654 | ERROR(tdev, "high bit of config attributes not set\n"); |
1da177e4 LT |
655 | return 0; |
656 | } | |
657 | if (config->bmAttributes & 0x1f) { /* reserved == 0 */ | |
28ffd79c | 658 | ERROR(tdev, "reserved config bits set\n"); |
1da177e4 LT |
659 | return 0; |
660 | } | |
661 | break; | |
662 | default: | |
663 | return 0; | |
664 | } | |
665 | ||
fabbf219 | 666 | if (le16_to_cpu(config->wTotalLength) == len) /* read it all */ |
1da177e4 | 667 | return 1; |
fabbf219 | 668 | if (le16_to_cpu(config->wTotalLength) >= TBUF_SIZE) /* max partial read */ |
1da177e4 | 669 | return 1; |
28ffd79c | 670 | ERROR(tdev, "bogus config descriptor read size\n"); |
1da177e4 LT |
671 | return 0; |
672 | } | |
673 | ||
82f92672 HR |
674 | static int is_good_ext(struct usbtest_dev *tdev, u8 *buf) |
675 | { | |
676 | struct usb_ext_cap_descriptor *ext; | |
677 | u32 attr; | |
678 | ||
679 | ext = (struct usb_ext_cap_descriptor *) buf; | |
680 | ||
681 | if (ext->bLength != USB_DT_USB_EXT_CAP_SIZE) { | |
682 | ERROR(tdev, "bogus usb 2.0 extension descriptor length\n"); | |
683 | return 0; | |
684 | } | |
685 | ||
686 | attr = le32_to_cpu(ext->bmAttributes); | |
875bc23a HR |
687 | /* bits[1:15] is used and others are reserved */ |
688 | if (attr & ~0xfffe) { /* reserved == 0 */ | |
82f92672 HR |
689 | ERROR(tdev, "reserved bits set\n"); |
690 | return 0; | |
691 | } | |
692 | ||
693 | return 1; | |
694 | } | |
695 | ||
b8fef795 HR |
696 | static int is_good_ss_cap(struct usbtest_dev *tdev, u8 *buf) |
697 | { | |
698 | struct usb_ss_cap_descriptor *ss; | |
699 | ||
700 | ss = (struct usb_ss_cap_descriptor *) buf; | |
701 | ||
702 | if (ss->bLength != USB_DT_USB_SS_CAP_SIZE) { | |
703 | ERROR(tdev, "bogus superspeed device capability descriptor length\n"); | |
704 | return 0; | |
705 | } | |
706 | ||
707 | /* | |
708 | * only bit[1] of bmAttributes is used for LTM and others are | |
709 | * reserved | |
710 | */ | |
711 | if (ss->bmAttributes & ~0x02) { /* reserved == 0 */ | |
712 | ERROR(tdev, "reserved bits set in bmAttributes\n"); | |
713 | return 0; | |
714 | } | |
715 | ||
716 | /* bits[0:3] of wSpeedSupported is used and others are reserved */ | |
717 | if (le16_to_cpu(ss->wSpeedSupported) & ~0x0f) { /* reserved == 0 */ | |
718 | ERROR(tdev, "reserved bits set in wSpeedSupported\n"); | |
719 | return 0; | |
720 | } | |
721 | ||
722 | return 1; | |
723 | } | |
724 | ||
8e29217f HR |
725 | static int is_good_con_id(struct usbtest_dev *tdev, u8 *buf) |
726 | { | |
727 | struct usb_ss_container_id_descriptor *con_id; | |
728 | ||
729 | con_id = (struct usb_ss_container_id_descriptor *) buf; | |
730 | ||
731 | if (con_id->bLength != USB_DT_USB_SS_CONTN_ID_SIZE) { | |
732 | ERROR(tdev, "bogus container id descriptor length\n"); | |
733 | return 0; | |
734 | } | |
735 | ||
736 | if (con_id->bReserved) { /* reserved == 0 */ | |
737 | ERROR(tdev, "reserved bits set\n"); | |
738 | return 0; | |
739 | } | |
740 | ||
741 | return 1; | |
742 | } | |
743 | ||
1da177e4 LT |
744 | /* sanity test for standard requests working with usb_control_mesg() and some |
745 | * of the utility functions which use it. | |
746 | * | |
747 | * this doesn't test how endpoint halts behave or data toggles get set, since | |
748 | * we won't do I/O to bulk/interrupt endpoints here (which is how to change | |
749 | * halt or toggle). toggle testing is impractical without support from hcds. | |
750 | * | |
751 | * this avoids failing devices linux would normally work with, by not testing | |
752 | * config/altsetting operations for devices that only support their defaults. | |
753 | * such devices rarely support those needless operations. | |
754 | * | |
755 | * NOTE that since this is a sanity test, it's not examining boundary cases | |
756 | * to see if usbcore, hcd, and device all behave right. such testing would | |
757 | * involve varied read sizes and other operation sequences. | |
758 | */ | |
fabbf219 | 759 | static int ch9_postconfig(struct usbtest_dev *dev) |
1da177e4 LT |
760 | { |
761 | struct usb_interface *iface = dev->intf; | |
fabbf219 | 762 | struct usb_device *udev = interface_to_usbdev(iface); |
1da177e4 LT |
763 | int i, alt, retval; |
764 | ||
765 | /* [9.2.3] if there's more than one altsetting, we need to be able to | |
766 | * set and get each one. mostly trusts the descriptors from usbcore. | |
767 | */ | |
768 | for (i = 0; i < iface->num_altsetting; i++) { | |
769 | ||
770 | /* 9.2.3 constrains the range here */ | |
fabbf219 | 771 | alt = iface->altsetting[i].desc.bAlternateSetting; |
1da177e4 | 772 | if (alt < 0 || alt >= iface->num_altsetting) { |
28ffd79c | 773 | dev_err(&iface->dev, |
1da177e4 LT |
774 | "invalid alt [%d].bAltSetting = %d\n", |
775 | i, alt); | |
776 | } | |
777 | ||
778 | /* [real world] get/set unimplemented if there's only one */ | |
779 | if (realworld && iface->num_altsetting == 1) | |
780 | continue; | |
781 | ||
782 | /* [9.4.10] set_interface */ | |
fabbf219 | 783 | retval = set_altsetting(dev, alt); |
1da177e4 | 784 | if (retval) { |
28ffd79c | 785 | dev_err(&iface->dev, "can't set_interface = %d, %d\n", |
1da177e4 LT |
786 | alt, retval); |
787 | return retval; | |
788 | } | |
789 | ||
790 | /* [9.4.4] get_interface always works */ | |
fabbf219 | 791 | retval = get_altsetting(dev); |
1da177e4 | 792 | if (retval != alt) { |
28ffd79c | 793 | dev_err(&iface->dev, "get alt should be %d, was %d\n", |
1da177e4 LT |
794 | alt, retval); |
795 | return (retval < 0) ? retval : -EDOM; | |
796 | } | |
797 | ||
798 | } | |
799 | ||
800 | /* [real world] get_config unimplemented if there's only one */ | |
801 | if (!realworld || udev->descriptor.bNumConfigurations != 1) { | |
802 | int expected = udev->actconfig->desc.bConfigurationValue; | |
803 | ||
804 | /* [9.4.2] get_configuration always works | |
805 | * ... although some cheap devices (like one TI Hub I've got) | |
806 | * won't return config descriptors except before set_config. | |
807 | */ | |
fabbf219 | 808 | retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), |
1da177e4 LT |
809 | USB_REQ_GET_CONFIGURATION, |
810 | USB_DIR_IN | USB_RECIP_DEVICE, | |
811 | 0, 0, dev->buf, 1, USB_CTRL_GET_TIMEOUT); | |
fabbf219 | 812 | if (retval != 1 || dev->buf[0] != expected) { |
28ffd79c | 813 | dev_err(&iface->dev, "get config --> %d %d (1 %d)\n", |
ff7c79e4 | 814 | retval, dev->buf[0], expected); |
1da177e4 LT |
815 | return (retval < 0) ? retval : -EDOM; |
816 | } | |
817 | } | |
818 | ||
819 | /* there's always [9.4.3] a device descriptor [9.6.1] */ | |
fabbf219 | 820 | retval = usb_get_descriptor(udev, USB_DT_DEVICE, 0, |
f55055b4 HR |
821 | dev->buf, sizeof(udev->descriptor)); |
822 | if (retval != sizeof(udev->descriptor)) { | |
28ffd79c | 823 | dev_err(&iface->dev, "dev descriptor --> %d\n", retval); |
1da177e4 LT |
824 | return (retval < 0) ? retval : -EDOM; |
825 | } | |
826 | ||
9d3bd768 HR |
827 | /* |
828 | * there's always [9.4.3] a bos device descriptor [9.6.2] in USB | |
829 | * 3.0 spec | |
830 | */ | |
f625099f | 831 | if (le16_to_cpu(udev->descriptor.bcdUSB) >= 0x0210) { |
82f92672 HR |
832 | struct usb_bos_descriptor *bos = NULL; |
833 | struct usb_dev_cap_header *header = NULL; | |
834 | unsigned total, num, length; | |
835 | u8 *buf; | |
836 | ||
9d3bd768 HR |
837 | retval = usb_get_descriptor(udev, USB_DT_BOS, 0, dev->buf, |
838 | sizeof(*udev->bos->desc)); | |
839 | if (retval != sizeof(*udev->bos->desc)) { | |
840 | dev_err(&iface->dev, "bos descriptor --> %d\n", retval); | |
841 | return (retval < 0) ? retval : -EDOM; | |
842 | } | |
82f92672 HR |
843 | |
844 | bos = (struct usb_bos_descriptor *)dev->buf; | |
845 | total = le16_to_cpu(bos->wTotalLength); | |
846 | num = bos->bNumDeviceCaps; | |
847 | ||
848 | if (total > TBUF_SIZE) | |
849 | total = TBUF_SIZE; | |
850 | ||
851 | /* | |
852 | * get generic device-level capability descriptors [9.6.2] | |
853 | * in USB 3.0 spec | |
854 | */ | |
855 | retval = usb_get_descriptor(udev, USB_DT_BOS, 0, dev->buf, | |
856 | total); | |
857 | if (retval != total) { | |
858 | dev_err(&iface->dev, "bos descriptor set --> %d\n", | |
859 | retval); | |
860 | return (retval < 0) ? retval : -EDOM; | |
861 | } | |
862 | ||
863 | length = sizeof(*udev->bos->desc); | |
864 | buf = dev->buf; | |
865 | for (i = 0; i < num; i++) { | |
866 | buf += length; | |
867 | if (buf + sizeof(struct usb_dev_cap_header) > | |
868 | dev->buf + total) | |
869 | break; | |
870 | ||
871 | header = (struct usb_dev_cap_header *)buf; | |
872 | length = header->bLength; | |
873 | ||
874 | if (header->bDescriptorType != | |
875 | USB_DT_DEVICE_CAPABILITY) { | |
876 | dev_warn(&udev->dev, "not device capability descriptor, skip\n"); | |
877 | continue; | |
878 | } | |
879 | ||
880 | switch (header->bDevCapabilityType) { | |
881 | case USB_CAP_TYPE_EXT: | |
882 | if (buf + USB_DT_USB_EXT_CAP_SIZE > | |
883 | dev->buf + total || | |
884 | !is_good_ext(dev, buf)) { | |
885 | dev_err(&iface->dev, "bogus usb 2.0 extension descriptor\n"); | |
886 | return -EDOM; | |
887 | } | |
888 | break; | |
b8fef795 HR |
889 | case USB_SS_CAP_TYPE: |
890 | if (buf + USB_DT_USB_SS_CAP_SIZE > | |
891 | dev->buf + total || | |
892 | !is_good_ss_cap(dev, buf)) { | |
893 | dev_err(&iface->dev, "bogus superspeed device capability descriptor\n"); | |
894 | return -EDOM; | |
895 | } | |
896 | break; | |
8e29217f HR |
897 | case CONTAINER_ID_TYPE: |
898 | if (buf + USB_DT_USB_SS_CONTN_ID_SIZE > | |
899 | dev->buf + total || | |
900 | !is_good_con_id(dev, buf)) { | |
901 | dev_err(&iface->dev, "bogus container id descriptor\n"); | |
902 | return -EDOM; | |
903 | } | |
904 | break; | |
82f92672 HR |
905 | default: |
906 | break; | |
907 | } | |
908 | } | |
9d3bd768 HR |
909 | } |
910 | ||
1da177e4 LT |
911 | /* there's always [9.4.3] at least one config descriptor [9.6.3] */ |
912 | for (i = 0; i < udev->descriptor.bNumConfigurations; i++) { | |
fabbf219 | 913 | retval = usb_get_descriptor(udev, USB_DT_CONFIG, i, |
1da177e4 | 914 | dev->buf, TBUF_SIZE); |
28ffd79c DB |
915 | if (!is_good_config(dev, retval)) { |
916 | dev_err(&iface->dev, | |
1da177e4 LT |
917 | "config [%d] descriptor --> %d\n", |
918 | i, retval); | |
919 | return (retval < 0) ? retval : -EDOM; | |
920 | } | |
921 | ||
fabbf219 MF |
922 | /* FIXME cross-checking udev->config[i] to make sure usbcore |
923 | * parsed it right (etc) would be good testing paranoia | |
924 | */ | |
1da177e4 LT |
925 | } |
926 | ||
927 | /* and sometimes [9.2.6.6] speed dependent descriptors */ | |
928 | if (le16_to_cpu(udev->descriptor.bcdUSB) == 0x0200) { | |
fabbf219 | 929 | struct usb_qualifier_descriptor *d = NULL; |
1da177e4 LT |
930 | |
931 | /* device qualifier [9.6.2] */ | |
fabbf219 | 932 | retval = usb_get_descriptor(udev, |
1da177e4 | 933 | USB_DT_DEVICE_QUALIFIER, 0, dev->buf, |
fabbf219 | 934 | sizeof(struct usb_qualifier_descriptor)); |
1da177e4 LT |
935 | if (retval == -EPIPE) { |
936 | if (udev->speed == USB_SPEED_HIGH) { | |
28ffd79c | 937 | dev_err(&iface->dev, |
1da177e4 LT |
938 | "hs dev qualifier --> %d\n", |
939 | retval); | |
940 | return (retval < 0) ? retval : -EDOM; | |
941 | } | |
942 | /* usb2.0 but not high-speed capable; fine */ | |
fabbf219 | 943 | } else if (retval != sizeof(struct usb_qualifier_descriptor)) { |
28ffd79c | 944 | dev_err(&iface->dev, "dev qualifier --> %d\n", retval); |
1da177e4 LT |
945 | return (retval < 0) ? retval : -EDOM; |
946 | } else | |
947 | d = (struct usb_qualifier_descriptor *) dev->buf; | |
948 | ||
949 | /* might not have [9.6.2] any other-speed configs [9.6.4] */ | |
950 | if (d) { | |
951 | unsigned max = d->bNumConfigurations; | |
952 | for (i = 0; i < max; i++) { | |
fabbf219 | 953 | retval = usb_get_descriptor(udev, |
1da177e4 LT |
954 | USB_DT_OTHER_SPEED_CONFIG, i, |
955 | dev->buf, TBUF_SIZE); | |
28ffd79c DB |
956 | if (!is_good_config(dev, retval)) { |
957 | dev_err(&iface->dev, | |
1da177e4 LT |
958 | "other speed config --> %d\n", |
959 | retval); | |
960 | return (retval < 0) ? retval : -EDOM; | |
961 | } | |
962 | } | |
963 | } | |
964 | } | |
fabbf219 | 965 | /* FIXME fetch strings from at least the device descriptor */ |
1da177e4 LT |
966 | |
967 | /* [9.4.5] get_status always works */ | |
fabbf219 | 968 | retval = usb_get_status(udev, USB_RECIP_DEVICE, 0, dev->buf); |
15b7336e | 969 | if (retval) { |
28ffd79c | 970 | dev_err(&iface->dev, "get dev status --> %d\n", retval); |
15b7336e | 971 | return retval; |
1da177e4 LT |
972 | } |
973 | ||
fabbf219 MF |
974 | /* FIXME configuration.bmAttributes says if we could try to set/clear |
975 | * the device's remote wakeup feature ... if we can, test that here | |
976 | */ | |
1da177e4 | 977 | |
fabbf219 MF |
978 | retval = usb_get_status(udev, USB_RECIP_INTERFACE, |
979 | iface->altsetting[0].desc.bInterfaceNumber, dev->buf); | |
15b7336e | 980 | if (retval) { |
28ffd79c | 981 | dev_err(&iface->dev, "get interface status --> %d\n", retval); |
15b7336e | 982 | return retval; |
1da177e4 | 983 | } |
fabbf219 | 984 | /* FIXME get status for each endpoint in the interface */ |
28ffd79c | 985 | |
1da177e4 LT |
986 | return 0; |
987 | } | |
988 | ||
989 | /*-------------------------------------------------------------------------*/ | |
990 | ||
991 | /* use ch9 requests to test whether: | |
992 | * (a) queues work for control, keeping N subtests queued and | |
993 | * active (auto-resubmit) for M loops through the queue. | |
994 | * (b) protocol stalls (control-only) will autorecover. | |
995 | * it's not like bulk/intr; no halt clearing. | |
996 | * (c) short control reads are reported and handled. | |
997 | * (d) queues are always processed in-order | |
998 | */ | |
999 | ||
1000 | struct ctrl_ctx { | |
1001 | spinlock_t lock; | |
1002 | struct usbtest_dev *dev; | |
1003 | struct completion complete; | |
1004 | unsigned count; | |
1005 | unsigned pending; | |
1006 | int status; | |
1007 | struct urb **urb; | |
1008 | struct usbtest_param *param; | |
1009 | int last; | |
1010 | }; | |
1011 | ||
c952a8ba | 1012 | #define NUM_SUBCASES 16 /* how many test subcases here? */ |
1da177e4 LT |
1013 | |
1014 | struct subcase { | |
1015 | struct usb_ctrlrequest setup; | |
1016 | int number; | |
1017 | int expected; | |
1018 | }; | |
1019 | ||
fabbf219 | 1020 | static void ctrl_complete(struct urb *urb) |
1da177e4 LT |
1021 | { |
1022 | struct ctrl_ctx *ctx = urb->context; | |
1023 | struct usb_ctrlrequest *reqp; | |
1024 | struct subcase *subcase; | |
1025 | int status = urb->status; | |
1026 | ||
1027 | reqp = (struct usb_ctrlrequest *)urb->setup_packet; | |
fabbf219 | 1028 | subcase = container_of(reqp, struct subcase, setup); |
1da177e4 | 1029 | |
fabbf219 | 1030 | spin_lock(&ctx->lock); |
1da177e4 LT |
1031 | ctx->count--; |
1032 | ctx->pending--; | |
1033 | ||
1034 | /* queue must transfer and complete in fifo order, unless | |
1035 | * usb_unlink_urb() is used to unlink something not at the | |
1036 | * physical queue head (not tested). | |
1037 | */ | |
1038 | if (subcase->number > 0) { | |
1039 | if ((subcase->number - ctx->last) != 1) { | |
28ffd79c DB |
1040 | ERROR(ctx->dev, |
1041 | "subcase %d completed out of order, last %d\n", | |
1042 | subcase->number, ctx->last); | |
1da177e4 LT |
1043 | status = -EDOM; |
1044 | ctx->last = subcase->number; | |
1045 | goto error; | |
1046 | } | |
1047 | } | |
1048 | ctx->last = subcase->number; | |
1049 | ||
1050 | /* succeed or fault in only one way? */ | |
1051 | if (status == subcase->expected) | |
1052 | status = 0; | |
1053 | ||
1054 | /* async unlink for cleanup? */ | |
1055 | else if (status != -ECONNRESET) { | |
1056 | ||
1057 | /* some faults are allowed, not required */ | |
1058 | if (subcase->expected > 0 && ( | |
59d99785 GKH |
1059 | ((status == -subcase->expected /* happened */ |
1060 | || status == 0)))) /* didn't */ | |
1da177e4 LT |
1061 | status = 0; |
1062 | /* sometimes more than one fault is allowed */ | |
1063 | else if (subcase->number == 12 && status == -EPIPE) | |
1064 | status = 0; | |
1065 | else | |
28ffd79c | 1066 | ERROR(ctx->dev, "subtest %d error, status %d\n", |
1da177e4 LT |
1067 | subcase->number, status); |
1068 | } | |
1069 | ||
1070 | /* unexpected status codes mean errors; ideally, in hardware */ | |
1071 | if (status) { | |
1072 | error: | |
1073 | if (ctx->status == 0) { | |
1074 | int i; | |
1075 | ||
1076 | ctx->status = status; | |
28ffd79c DB |
1077 | ERROR(ctx->dev, "control queue %02x.%02x, err %d, " |
1078 | "%d left, subcase %d, len %d/%d\n", | |
1da177e4 | 1079 | reqp->bRequestType, reqp->bRequest, |
28ffd79c DB |
1080 | status, ctx->count, subcase->number, |
1081 | urb->actual_length, | |
1082 | urb->transfer_buffer_length); | |
1da177e4 LT |
1083 | |
1084 | /* FIXME this "unlink everything" exit route should | |
1085 | * be a separate test case. | |
1086 | */ | |
1087 | ||
1088 | /* unlink whatever's still pending */ | |
1089 | for (i = 1; i < ctx->param->sglen; i++) { | |
fabbf219 MF |
1090 | struct urb *u = ctx->urb[ |
1091 | (i + subcase->number) | |
1092 | % ctx->param->sglen]; | |
1da177e4 LT |
1093 | |
1094 | if (u == urb || !u->dev) | |
1095 | continue; | |
caa2a122 | 1096 | spin_unlock(&ctx->lock); |
fabbf219 | 1097 | status = usb_unlink_urb(u); |
caa2a122 | 1098 | spin_lock(&ctx->lock); |
1da177e4 LT |
1099 | switch (status) { |
1100 | case -EINPROGRESS: | |
1101 | case -EBUSY: | |
1102 | case -EIDRM: | |
1103 | continue; | |
1104 | default: | |
28ffd79c DB |
1105 | ERROR(ctx->dev, "urb unlink --> %d\n", |
1106 | status); | |
1da177e4 LT |
1107 | } |
1108 | } | |
1109 | status = ctx->status; | |
1110 | } | |
1111 | } | |
1112 | ||
1113 | /* resubmit if we need to, else mark this as done */ | |
1114 | if ((status == 0) && (ctx->pending < ctx->count)) { | |
fabbf219 MF |
1115 | status = usb_submit_urb(urb, GFP_ATOMIC); |
1116 | if (status != 0) { | |
28ffd79c DB |
1117 | ERROR(ctx->dev, |
1118 | "can't resubmit ctrl %02x.%02x, err %d\n", | |
1da177e4 LT |
1119 | reqp->bRequestType, reqp->bRequest, status); |
1120 | urb->dev = NULL; | |
1121 | } else | |
1122 | ctx->pending++; | |
1123 | } else | |
1124 | urb->dev = NULL; | |
28ffd79c | 1125 | |
1da177e4 LT |
1126 | /* signal completion when nothing's queued */ |
1127 | if (ctx->pending == 0) | |
fabbf219 MF |
1128 | complete(&ctx->complete); |
1129 | spin_unlock(&ctx->lock); | |
1da177e4 LT |
1130 | } |
1131 | ||
1132 | static int | |
fabbf219 | 1133 | test_ctrl_queue(struct usbtest_dev *dev, struct usbtest_param *param) |
1da177e4 | 1134 | { |
fabbf219 | 1135 | struct usb_device *udev = testdev_to_usbdev(dev); |
1da177e4 LT |
1136 | struct urb **urb; |
1137 | struct ctrl_ctx context; | |
1138 | int i; | |
1139 | ||
e65cdfae XW |
1140 | if (param->sglen == 0 || param->iterations > UINT_MAX / param->sglen) |
1141 | return -EOPNOTSUPP; | |
1142 | ||
fabbf219 | 1143 | spin_lock_init(&context.lock); |
1da177e4 | 1144 | context.dev = dev; |
fabbf219 | 1145 | init_completion(&context.complete); |
1da177e4 LT |
1146 | context.count = param->sglen * param->iterations; |
1147 | context.pending = 0; | |
1148 | context.status = -ENOMEM; | |
1149 | context.param = param; | |
1150 | context.last = -1; | |
1151 | ||
1152 | /* allocate and init the urbs we'll queue. | |
1153 | * as with bulk/intr sglists, sglen is the queue depth; it also | |
1154 | * controls which subtests run (more tests than sglen) or rerun. | |
1155 | */ | |
e94b1766 | 1156 | urb = kcalloc(param->sglen, sizeof(struct urb *), GFP_KERNEL); |
1da177e4 LT |
1157 | if (!urb) |
1158 | return -ENOMEM; | |
1da177e4 | 1159 | for (i = 0; i < param->sglen; i++) { |
fabbf219 | 1160 | int pipe = usb_rcvctrlpipe(udev, 0); |
1da177e4 LT |
1161 | unsigned len; |
1162 | struct urb *u; | |
1163 | struct usb_ctrlrequest req; | |
1164 | struct subcase *reqp; | |
6def7553 MS |
1165 | |
1166 | /* sign of this variable means: | |
1167 | * -: tested code must return this (negative) error code | |
1168 | * +: tested code may return this (negative too) error code | |
1169 | */ | |
1da177e4 LT |
1170 | int expected = 0; |
1171 | ||
1172 | /* requests here are mostly expected to succeed on any | |
1173 | * device, but some are chosen to trigger protocol stalls | |
1174 | * or short reads. | |
1175 | */ | |
f55055b4 | 1176 | memset(&req, 0, sizeof(req)); |
1da177e4 LT |
1177 | req.bRequest = USB_REQ_GET_DESCRIPTOR; |
1178 | req.bRequestType = USB_DIR_IN|USB_RECIP_DEVICE; | |
1179 | ||
1180 | switch (i % NUM_SUBCASES) { | |
fabbf219 MF |
1181 | case 0: /* get device descriptor */ |
1182 | req.wValue = cpu_to_le16(USB_DT_DEVICE << 8); | |
1183 | len = sizeof(struct usb_device_descriptor); | |
1da177e4 | 1184 | break; |
fabbf219 MF |
1185 | case 1: /* get first config descriptor (only) */ |
1186 | req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0); | |
1187 | len = sizeof(struct usb_config_descriptor); | |
1da177e4 | 1188 | break; |
fabbf219 | 1189 | case 2: /* get altsetting (OFTEN STALLS) */ |
1da177e4 LT |
1190 | req.bRequest = USB_REQ_GET_INTERFACE; |
1191 | req.bRequestType = USB_DIR_IN|USB_RECIP_INTERFACE; | |
fabbf219 | 1192 | /* index = 0 means first interface */ |
1da177e4 LT |
1193 | len = 1; |
1194 | expected = EPIPE; | |
1195 | break; | |
fabbf219 | 1196 | case 3: /* get interface status */ |
1da177e4 LT |
1197 | req.bRequest = USB_REQ_GET_STATUS; |
1198 | req.bRequestType = USB_DIR_IN|USB_RECIP_INTERFACE; | |
fabbf219 | 1199 | /* interface 0 */ |
1da177e4 LT |
1200 | len = 2; |
1201 | break; | |
fabbf219 | 1202 | case 4: /* get device status */ |
1da177e4 LT |
1203 | req.bRequest = USB_REQ_GET_STATUS; |
1204 | req.bRequestType = USB_DIR_IN|USB_RECIP_DEVICE; | |
1205 | len = 2; | |
1206 | break; | |
fabbf219 | 1207 | case 5: /* get device qualifier (MAY STALL) */ |
1da177e4 | 1208 | req.wValue = cpu_to_le16 (USB_DT_DEVICE_QUALIFIER << 8); |
fabbf219 | 1209 | len = sizeof(struct usb_qualifier_descriptor); |
1da177e4 LT |
1210 | if (udev->speed != USB_SPEED_HIGH) |
1211 | expected = EPIPE; | |
1212 | break; | |
fabbf219 MF |
1213 | case 6: /* get first config descriptor, plus interface */ |
1214 | req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0); | |
1215 | len = sizeof(struct usb_config_descriptor); | |
1216 | len += sizeof(struct usb_interface_descriptor); | |
1da177e4 | 1217 | break; |
fabbf219 | 1218 | case 7: /* get interface descriptor (ALWAYS STALLS) */ |
1da177e4 | 1219 | req.wValue = cpu_to_le16 (USB_DT_INTERFACE << 8); |
fabbf219 MF |
1220 | /* interface == 0 */ |
1221 | len = sizeof(struct usb_interface_descriptor); | |
28ffd79c | 1222 | expected = -EPIPE; |
1da177e4 | 1223 | break; |
fabbf219 MF |
1224 | /* NOTE: two consecutive stalls in the queue here. |
1225 | * that tests fault recovery a bit more aggressively. */ | |
1226 | case 8: /* clear endpoint halt (MAY STALL) */ | |
1da177e4 LT |
1227 | req.bRequest = USB_REQ_CLEAR_FEATURE; |
1228 | req.bRequestType = USB_RECIP_ENDPOINT; | |
fabbf219 MF |
1229 | /* wValue 0 == ep halt */ |
1230 | /* wIndex 0 == ep0 (shouldn't halt!) */ | |
1da177e4 | 1231 | len = 0; |
fabbf219 | 1232 | pipe = usb_sndctrlpipe(udev, 0); |
1da177e4 LT |
1233 | expected = EPIPE; |
1234 | break; | |
fabbf219 | 1235 | case 9: /* get endpoint status */ |
1da177e4 LT |
1236 | req.bRequest = USB_REQ_GET_STATUS; |
1237 | req.bRequestType = USB_DIR_IN|USB_RECIP_ENDPOINT; | |
fabbf219 | 1238 | /* endpoint 0 */ |
1da177e4 LT |
1239 | len = 2; |
1240 | break; | |
fabbf219 MF |
1241 | case 10: /* trigger short read (EREMOTEIO) */ |
1242 | req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0); | |
1da177e4 LT |
1243 | len = 1024; |
1244 | expected = -EREMOTEIO; | |
1245 | break; | |
fabbf219 MF |
1246 | /* NOTE: two consecutive _different_ faults in the queue. */ |
1247 | case 11: /* get endpoint descriptor (ALWAYS STALLS) */ | |
1248 | req.wValue = cpu_to_le16(USB_DT_ENDPOINT << 8); | |
1249 | /* endpoint == 0 */ | |
1250 | len = sizeof(struct usb_interface_descriptor); | |
1da177e4 LT |
1251 | expected = EPIPE; |
1252 | break; | |
fabbf219 MF |
1253 | /* NOTE: sometimes even a third fault in the queue! */ |
1254 | case 12: /* get string 0 descriptor (MAY STALL) */ | |
1255 | req.wValue = cpu_to_le16(USB_DT_STRING << 8); | |
1256 | /* string == 0, for language IDs */ | |
1257 | len = sizeof(struct usb_interface_descriptor); | |
1258 | /* may succeed when > 4 languages */ | |
1259 | expected = EREMOTEIO; /* or EPIPE, if no strings */ | |
1da177e4 | 1260 | break; |
fabbf219 MF |
1261 | case 13: /* short read, resembling case 10 */ |
1262 | req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0); | |
1263 | /* last data packet "should" be DATA1, not DATA0 */ | |
6a23ccd2 PZ |
1264 | if (udev->speed == USB_SPEED_SUPER) |
1265 | len = 1024 - 512; | |
1266 | else | |
1267 | len = 1024 - udev->descriptor.bMaxPacketSize0; | |
1da177e4 LT |
1268 | expected = -EREMOTEIO; |
1269 | break; | |
fabbf219 MF |
1270 | case 14: /* short read; try to fill the last packet */ |
1271 | req.wValue = cpu_to_le16((USB_DT_DEVICE << 8) | 0); | |
28ffd79c | 1272 | /* device descriptor size == 18 bytes */ |
1da177e4 | 1273 | len = udev->descriptor.bMaxPacketSize0; |
67e7d64b SAS |
1274 | if (udev->speed == USB_SPEED_SUPER) |
1275 | len = 512; | |
1da177e4 | 1276 | switch (len) { |
fabbf219 MF |
1277 | case 8: |
1278 | len = 24; | |
1279 | break; | |
1280 | case 16: | |
1281 | len = 32; | |
1282 | break; | |
1da177e4 LT |
1283 | } |
1284 | expected = -EREMOTEIO; | |
1285 | break; | |
c952a8ba HR |
1286 | case 15: |
1287 | req.wValue = cpu_to_le16(USB_DT_BOS << 8); | |
1288 | if (udev->bos) | |
1289 | len = le16_to_cpu(udev->bos->desc->wTotalLength); | |
1290 | else | |
1291 | len = sizeof(struct usb_bos_descriptor); | |
8cf43285 | 1292 | if (le16_to_cpu(udev->descriptor.bcdUSB) < 0x0201) |
c952a8ba HR |
1293 | expected = -EPIPE; |
1294 | break; | |
1da177e4 | 1295 | default: |
28ffd79c | 1296 | ERROR(dev, "bogus number of ctrl queue testcases!\n"); |
1da177e4 LT |
1297 | context.status = -EINVAL; |
1298 | goto cleanup; | |
1299 | } | |
fabbf219 | 1300 | req.wLength = cpu_to_le16(len); |
457a0955 | 1301 | urb[i] = u = simple_alloc_urb(udev, pipe, len, 0); |
1da177e4 LT |
1302 | if (!u) |
1303 | goto cleanup; | |
1304 | ||
f55055b4 | 1305 | reqp = kmalloc(sizeof(*reqp), GFP_KERNEL); |
1da177e4 LT |
1306 | if (!reqp) |
1307 | goto cleanup; | |
1308 | reqp->setup = req; | |
1309 | reqp->number = i % NUM_SUBCASES; | |
1310 | reqp->expected = expected; | |
1311 | u->setup_packet = (char *) &reqp->setup; | |
1312 | ||
1313 | u->context = &context; | |
1314 | u->complete = ctrl_complete; | |
1da177e4 LT |
1315 | } |
1316 | ||
1317 | /* queue the urbs */ | |
1318 | context.urb = urb; | |
fabbf219 | 1319 | spin_lock_irq(&context.lock); |
1da177e4 | 1320 | for (i = 0; i < param->sglen; i++) { |
fabbf219 | 1321 | context.status = usb_submit_urb(urb[i], GFP_ATOMIC); |
1da177e4 | 1322 | if (context.status != 0) { |
28ffd79c | 1323 | ERROR(dev, "can't submit urb[%d], status %d\n", |
1da177e4 LT |
1324 | i, context.status); |
1325 | context.count = context.pending; | |
1326 | break; | |
1327 | } | |
1328 | context.pending++; | |
1329 | } | |
fabbf219 | 1330 | spin_unlock_irq(&context.lock); |
1da177e4 LT |
1331 | |
1332 | /* FIXME set timer and time out; provide a disconnect hook */ | |
1333 | ||
1334 | /* wait for the last one to complete */ | |
1335 | if (context.pending > 0) | |
fabbf219 | 1336 | wait_for_completion(&context.complete); |
1da177e4 LT |
1337 | |
1338 | cleanup: | |
1339 | for (i = 0; i < param->sglen; i++) { | |
fabbf219 | 1340 | if (!urb[i]) |
1da177e4 | 1341 | continue; |
fabbf219 | 1342 | urb[i]->dev = udev; |
0ede76fc | 1343 | kfree(urb[i]->setup_packet); |
fabbf219 | 1344 | simple_free_urb(urb[i]); |
1da177e4 | 1345 | } |
fabbf219 | 1346 | kfree(urb); |
1da177e4 LT |
1347 | return context.status; |
1348 | } | |
1349 | #undef NUM_SUBCASES | |
1350 | ||
1351 | ||
1352 | /*-------------------------------------------------------------------------*/ | |
1353 | ||
fabbf219 | 1354 | static void unlink1_callback(struct urb *urb) |
1da177e4 LT |
1355 | { |
1356 | int status = urb->status; | |
1357 | ||
fabbf219 | 1358 | /* we "know" -EPIPE (stall) never happens */ |
1da177e4 | 1359 | if (!status) |
fabbf219 | 1360 | status = usb_submit_urb(urb, GFP_ATOMIC); |
1da177e4 LT |
1361 | if (status) { |
1362 | urb->status = status; | |
cdc97792 | 1363 | complete(urb->context); |
1da177e4 LT |
1364 | } |
1365 | } | |
1366 | ||
fabbf219 | 1367 | static int unlink1(struct usbtest_dev *dev, int pipe, int size, int async) |
1da177e4 LT |
1368 | { |
1369 | struct urb *urb; | |
1370 | struct completion completion; | |
1371 | int retval = 0; | |
1372 | ||
fabbf219 | 1373 | init_completion(&completion); |
457a0955 | 1374 | urb = simple_alloc_urb(testdev_to_usbdev(dev), pipe, size, 0); |
1da177e4 LT |
1375 | if (!urb) |
1376 | return -ENOMEM; | |
1da177e4 LT |
1377 | urb->context = &completion; |
1378 | urb->complete = unlink1_callback; | |
1379 | ||
e4d58f5d HR |
1380 | if (usb_pipeout(urb->pipe)) { |
1381 | simple_fill_buf(urb); | |
1382 | urb->transfer_flags |= URB_ZERO_PACKET; | |
1383 | } | |
1384 | ||
1da177e4 LT |
1385 | /* keep the endpoint busy. there are lots of hc/hcd-internal |
1386 | * states, and testing should get to all of them over time. | |
1387 | * | |
1388 | * FIXME want additional tests for when endpoint is STALLing | |
1389 | * due to errors, or is just NAKing requests. | |
1390 | */ | |
fabbf219 MF |
1391 | retval = usb_submit_urb(urb, GFP_KERNEL); |
1392 | if (retval != 0) { | |
28ffd79c | 1393 | dev_err(&dev->intf->dev, "submit fail %d\n", retval); |
1da177e4 LT |
1394 | return retval; |
1395 | } | |
1396 | ||
1397 | /* unlinking that should always work. variable delay tests more | |
1398 | * hcd states and code paths, even with little other system load. | |
1399 | */ | |
fabbf219 | 1400 | msleep(jiffies % (2 * INTERRUPT_RATE)); |
1da177e4 | 1401 | if (async) { |
3b6c023f MF |
1402 | while (!completion_done(&completion)) { |
1403 | retval = usb_unlink_urb(urb); | |
1404 | ||
a7683eb3 HR |
1405 | if (retval == 0 && usb_pipein(urb->pipe)) |
1406 | retval = simple_check_buf(dev, urb); | |
1407 | ||
3b6c023f MF |
1408 | switch (retval) { |
1409 | case -EBUSY: | |
1410 | case -EIDRM: | |
1411 | /* we can't unlink urbs while they're completing | |
1412 | * or if they've completed, and we haven't | |
1413 | * resubmitted. "normal" drivers would prevent | |
1414 | * resubmission, but since we're testing unlink | |
1415 | * paths, we can't. | |
1416 | */ | |
1417 | ERROR(dev, "unlink retry\n"); | |
1418 | continue; | |
1419 | case 0: | |
1420 | case -EINPROGRESS: | |
1421 | break; | |
1422 | ||
1423 | default: | |
1424 | dev_err(&dev->intf->dev, | |
1425 | "unlink fail %d\n", retval); | |
1426 | return retval; | |
1427 | } | |
1428 | ||
1429 | break; | |
1da177e4 LT |
1430 | } |
1431 | } else | |
fabbf219 | 1432 | usb_kill_urb(urb); |
1da177e4 | 1433 | |
fabbf219 | 1434 | wait_for_completion(&completion); |
1da177e4 | 1435 | retval = urb->status; |
fabbf219 | 1436 | simple_free_urb(urb); |
1da177e4 LT |
1437 | |
1438 | if (async) | |
1439 | return (retval == -ECONNRESET) ? 0 : retval - 1000; | |
1440 | else | |
1441 | return (retval == -ENOENT || retval == -EPERM) ? | |
1442 | 0 : retval - 2000; | |
1443 | } | |
1444 | ||
fabbf219 | 1445 | static int unlink_simple(struct usbtest_dev *dev, int pipe, int len) |
1da177e4 LT |
1446 | { |
1447 | int retval = 0; | |
1448 | ||
1449 | /* test sync and async paths */ | |
fabbf219 | 1450 | retval = unlink1(dev, pipe, len, 1); |
1da177e4 | 1451 | if (!retval) |
fabbf219 | 1452 | retval = unlink1(dev, pipe, len, 0); |
1da177e4 LT |
1453 | return retval; |
1454 | } | |
1455 | ||
1456 | /*-------------------------------------------------------------------------*/ | |
1457 | ||
869410f8 AS |
1458 | struct queued_ctx { |
1459 | struct completion complete; | |
1460 | atomic_t pending; | |
1461 | unsigned num; | |
1462 | int status; | |
1463 | struct urb **urbs; | |
1464 | }; | |
1465 | ||
1466 | static void unlink_queued_callback(struct urb *urb) | |
1467 | { | |
1468 | int status = urb->status; | |
1469 | struct queued_ctx *ctx = urb->context; | |
1470 | ||
1471 | if (ctx->status) | |
1472 | goto done; | |
1473 | if (urb == ctx->urbs[ctx->num - 4] || urb == ctx->urbs[ctx->num - 2]) { | |
1474 | if (status == -ECONNRESET) | |
1475 | goto done; | |
1476 | /* What error should we report if the URB completed normally? */ | |
1477 | } | |
1478 | if (status != 0) | |
1479 | ctx->status = status; | |
1480 | ||
1481 | done: | |
1482 | if (atomic_dec_and_test(&ctx->pending)) | |
1483 | complete(&ctx->complete); | |
1484 | } | |
1485 | ||
1486 | static int unlink_queued(struct usbtest_dev *dev, int pipe, unsigned num, | |
1487 | unsigned size) | |
1488 | { | |
1489 | struct queued_ctx ctx; | |
1490 | struct usb_device *udev = testdev_to_usbdev(dev); | |
1491 | void *buf; | |
1492 | dma_addr_t buf_dma; | |
1493 | int i; | |
1494 | int retval = -ENOMEM; | |
1495 | ||
1496 | init_completion(&ctx.complete); | |
1497 | atomic_set(&ctx.pending, 1); /* One more than the actual value */ | |
1498 | ctx.num = num; | |
1499 | ctx.status = 0; | |
1500 | ||
1501 | buf = usb_alloc_coherent(udev, size, GFP_KERNEL, &buf_dma); | |
1502 | if (!buf) | |
1503 | return retval; | |
1504 | memset(buf, 0, size); | |
1505 | ||
1506 | /* Allocate and init the urbs we'll queue */ | |
1507 | ctx.urbs = kcalloc(num, sizeof(struct urb *), GFP_KERNEL); | |
1508 | if (!ctx.urbs) | |
1509 | goto free_buf; | |
1510 | for (i = 0; i < num; i++) { | |
1511 | ctx.urbs[i] = usb_alloc_urb(0, GFP_KERNEL); | |
1512 | if (!ctx.urbs[i]) | |
1513 | goto free_urbs; | |
1514 | usb_fill_bulk_urb(ctx.urbs[i], udev, pipe, buf, size, | |
1515 | unlink_queued_callback, &ctx); | |
1516 | ctx.urbs[i]->transfer_dma = buf_dma; | |
1517 | ctx.urbs[i]->transfer_flags = URB_NO_TRANSFER_DMA_MAP; | |
e4d58f5d HR |
1518 | |
1519 | if (usb_pipeout(ctx.urbs[i]->pipe)) { | |
1520 | simple_fill_buf(ctx.urbs[i]); | |
1521 | ctx.urbs[i]->transfer_flags |= URB_ZERO_PACKET; | |
1522 | } | |
869410f8 AS |
1523 | } |
1524 | ||
1525 | /* Submit all the URBs and then unlink URBs num - 4 and num - 2. */ | |
1526 | for (i = 0; i < num; i++) { | |
1527 | atomic_inc(&ctx.pending); | |
1528 | retval = usb_submit_urb(ctx.urbs[i], GFP_KERNEL); | |
1529 | if (retval != 0) { | |
1530 | dev_err(&dev->intf->dev, "submit urbs[%d] fail %d\n", | |
1531 | i, retval); | |
1532 | atomic_dec(&ctx.pending); | |
1533 | ctx.status = retval; | |
1534 | break; | |
1535 | } | |
1536 | } | |
1537 | if (i == num) { | |
1538 | usb_unlink_urb(ctx.urbs[num - 4]); | |
1539 | usb_unlink_urb(ctx.urbs[num - 2]); | |
1540 | } else { | |
1541 | while (--i >= 0) | |
1542 | usb_unlink_urb(ctx.urbs[i]); | |
1543 | } | |
1544 | ||
1545 | if (atomic_dec_and_test(&ctx.pending)) /* The extra count */ | |
1546 | complete(&ctx.complete); | |
1547 | wait_for_completion(&ctx.complete); | |
1548 | retval = ctx.status; | |
1549 | ||
1550 | free_urbs: | |
1551 | for (i = 0; i < num; i++) | |
1552 | usb_free_urb(ctx.urbs[i]); | |
1553 | kfree(ctx.urbs); | |
1554 | free_buf: | |
1555 | usb_free_coherent(udev, size, buf, buf_dma); | |
1556 | return retval; | |
1557 | } | |
1558 | ||
1559 | /*-------------------------------------------------------------------------*/ | |
1560 | ||
28ffd79c | 1561 | static int verify_not_halted(struct usbtest_dev *tdev, int ep, struct urb *urb) |
1da177e4 LT |
1562 | { |
1563 | int retval; | |
1564 | u16 status; | |
1565 | ||
1566 | /* shouldn't look or act halted */ | |
fabbf219 | 1567 | retval = usb_get_status(urb->dev, USB_RECIP_ENDPOINT, ep, &status); |
1da177e4 | 1568 | if (retval < 0) { |
28ffd79c DB |
1569 | ERROR(tdev, "ep %02x couldn't get no-halt status, %d\n", |
1570 | ep, retval); | |
1da177e4 LT |
1571 | return retval; |
1572 | } | |
1573 | if (status != 0) { | |
28ffd79c | 1574 | ERROR(tdev, "ep %02x bogus status: %04x != 0\n", ep, status); |
1da177e4 LT |
1575 | return -EINVAL; |
1576 | } | |
28ffd79c | 1577 | retval = simple_io(tdev, urb, 1, 0, 0, __func__); |
1da177e4 LT |
1578 | if (retval != 0) |
1579 | return -EINVAL; | |
1580 | return 0; | |
1581 | } | |
1582 | ||
28ffd79c | 1583 | static int verify_halted(struct usbtest_dev *tdev, int ep, struct urb *urb) |
1da177e4 LT |
1584 | { |
1585 | int retval; | |
1586 | u16 status; | |
1587 | ||
1588 | /* should look and act halted */ | |
fabbf219 | 1589 | retval = usb_get_status(urb->dev, USB_RECIP_ENDPOINT, ep, &status); |
1da177e4 | 1590 | if (retval < 0) { |
28ffd79c DB |
1591 | ERROR(tdev, "ep %02x couldn't get halt status, %d\n", |
1592 | ep, retval); | |
1da177e4 LT |
1593 | return retval; |
1594 | } | |
1595 | if (status != 1) { | |
28ffd79c | 1596 | ERROR(tdev, "ep %02x bogus status: %04x != 1\n", ep, status); |
1da177e4 LT |
1597 | return -EINVAL; |
1598 | } | |
28ffd79c | 1599 | retval = simple_io(tdev, urb, 1, 0, -EPIPE, __func__); |
1da177e4 LT |
1600 | if (retval != -EPIPE) |
1601 | return -EINVAL; | |
28ffd79c | 1602 | retval = simple_io(tdev, urb, 1, 0, -EPIPE, "verify_still_halted"); |
1da177e4 LT |
1603 | if (retval != -EPIPE) |
1604 | return -EINVAL; | |
1605 | return 0; | |
1606 | } | |
1607 | ||
28ffd79c | 1608 | static int test_halt(struct usbtest_dev *tdev, int ep, struct urb *urb) |
1da177e4 LT |
1609 | { |
1610 | int retval; | |
1611 | ||
1612 | /* shouldn't look or act halted now */ | |
28ffd79c | 1613 | retval = verify_not_halted(tdev, ep, urb); |
1da177e4 LT |
1614 | if (retval < 0) |
1615 | return retval; | |
1616 | ||
1617 | /* set halt (protocol test only), verify it worked */ | |
fabbf219 | 1618 | retval = usb_control_msg(urb->dev, usb_sndctrlpipe(urb->dev, 0), |
1da177e4 LT |
1619 | USB_REQ_SET_FEATURE, USB_RECIP_ENDPOINT, |
1620 | USB_ENDPOINT_HALT, ep, | |
1621 | NULL, 0, USB_CTRL_SET_TIMEOUT); | |
1622 | if (retval < 0) { | |
28ffd79c | 1623 | ERROR(tdev, "ep %02x couldn't set halt, %d\n", ep, retval); |
1da177e4 LT |
1624 | return retval; |
1625 | } | |
28ffd79c | 1626 | retval = verify_halted(tdev, ep, urb); |
824d752b RQ |
1627 | if (retval < 0) { |
1628 | int ret; | |
1629 | ||
1630 | /* clear halt anyways, else further tests will fail */ | |
1631 | ret = usb_clear_halt(urb->dev, urb->pipe); | |
1632 | if (ret) | |
1633 | ERROR(tdev, "ep %02x couldn't clear halt, %d\n", | |
1634 | ep, ret); | |
1635 | ||
1da177e4 | 1636 | return retval; |
824d752b | 1637 | } |
1da177e4 LT |
1638 | |
1639 | /* clear halt (tests API + protocol), verify it worked */ | |
fabbf219 | 1640 | retval = usb_clear_halt(urb->dev, urb->pipe); |
1da177e4 | 1641 | if (retval < 0) { |
28ffd79c | 1642 | ERROR(tdev, "ep %02x couldn't clear halt, %d\n", ep, retval); |
1da177e4 LT |
1643 | return retval; |
1644 | } | |
28ffd79c | 1645 | retval = verify_not_halted(tdev, ep, urb); |
1da177e4 LT |
1646 | if (retval < 0) |
1647 | return retval; | |
1648 | ||
1649 | /* NOTE: could also verify SET_INTERFACE clear halts ... */ | |
1650 | ||
1651 | return 0; | |
1652 | } | |
1653 | ||
fabbf219 | 1654 | static int halt_simple(struct usbtest_dev *dev) |
1da177e4 | 1655 | { |
6a23ccd2 PZ |
1656 | int ep; |
1657 | int retval = 0; | |
1658 | struct urb *urb; | |
1659 | struct usb_device *udev = testdev_to_usbdev(dev); | |
1da177e4 | 1660 | |
6a23ccd2 | 1661 | if (udev->speed == USB_SPEED_SUPER) |
457a0955 | 1662 | urb = simple_alloc_urb(udev, 0, 1024, 0); |
6a23ccd2 | 1663 | else |
457a0955 | 1664 | urb = simple_alloc_urb(udev, 0, 512, 0); |
1da177e4 LT |
1665 | if (urb == NULL) |
1666 | return -ENOMEM; | |
1667 | ||
1668 | if (dev->in_pipe) { | |
fabbf219 | 1669 | ep = usb_pipeendpoint(dev->in_pipe) | USB_DIR_IN; |
1da177e4 | 1670 | urb->pipe = dev->in_pipe; |
28ffd79c | 1671 | retval = test_halt(dev, ep, urb); |
1da177e4 LT |
1672 | if (retval < 0) |
1673 | goto done; | |
1674 | } | |
1675 | ||
1676 | if (dev->out_pipe) { | |
fabbf219 | 1677 | ep = usb_pipeendpoint(dev->out_pipe); |
1da177e4 | 1678 | urb->pipe = dev->out_pipe; |
28ffd79c | 1679 | retval = test_halt(dev, ep, urb); |
1da177e4 LT |
1680 | } |
1681 | done: | |
fabbf219 | 1682 | simple_free_urb(urb); |
1da177e4 LT |
1683 | return retval; |
1684 | } | |
1685 | ||
1686 | /*-------------------------------------------------------------------------*/ | |
1687 | ||
1688 | /* Control OUT tests use the vendor control requests from Intel's | |
1689 | * USB 2.0 compliance test device: write a buffer, read it back. | |
1690 | * | |
1691 | * Intel's spec only _requires_ that it work for one packet, which | |
1692 | * is pretty weak. Some HCDs place limits here; most devices will | |
1693 | * need to be able to handle more than one OUT data packet. We'll | |
1694 | * try whatever we're told to try. | |
1695 | */ | |
fabbf219 | 1696 | static int ctrl_out(struct usbtest_dev *dev, |
084fb206 | 1697 | unsigned count, unsigned length, unsigned vary, unsigned offset) |
1da177e4 | 1698 | { |
f54fa84d OF |
1699 | unsigned i, j, len; |
1700 | int retval; | |
1da177e4 LT |
1701 | u8 *buf; |
1702 | char *what = "?"; | |
1703 | struct usb_device *udev; | |
f54fa84d | 1704 | |
ff7c79e4 | 1705 | if (length < 1 || length > 0xffff || vary >= length) |
1da177e4 LT |
1706 | return -EINVAL; |
1707 | ||
084fb206 | 1708 | buf = kmalloc(length + offset, GFP_KERNEL); |
1da177e4 LT |
1709 | if (!buf) |
1710 | return -ENOMEM; | |
1711 | ||
084fb206 | 1712 | buf += offset; |
fabbf219 | 1713 | udev = testdev_to_usbdev(dev); |
1da177e4 LT |
1714 | len = length; |
1715 | retval = 0; | |
1716 | ||
1717 | /* NOTE: hardware might well act differently if we pushed it | |
1718 | * with lots back-to-back queued requests. | |
1719 | */ | |
1720 | for (i = 0; i < count; i++) { | |
1721 | /* write patterned data */ | |
1722 | for (j = 0; j < len; j++) | |
169900f9 | 1723 | buf[j] = (u8)(i + j); |
fabbf219 | 1724 | retval = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), |
1da177e4 LT |
1725 | 0x5b, USB_DIR_OUT|USB_TYPE_VENDOR, |
1726 | 0, 0, buf, len, USB_CTRL_SET_TIMEOUT); | |
1727 | if (retval != len) { | |
1728 | what = "write"; | |
ff7c79e4 | 1729 | if (retval >= 0) { |
28ffd79c | 1730 | ERROR(dev, "ctrl_out, wlen %d (expected %d)\n", |
ff7c79e4 DB |
1731 | retval, len); |
1732 | retval = -EBADMSG; | |
1733 | } | |
1da177e4 LT |
1734 | break; |
1735 | } | |
1736 | ||
1737 | /* read it back -- assuming nothing intervened!! */ | |
fabbf219 | 1738 | retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), |
1da177e4 LT |
1739 | 0x5c, USB_DIR_IN|USB_TYPE_VENDOR, |
1740 | 0, 0, buf, len, USB_CTRL_GET_TIMEOUT); | |
1741 | if (retval != len) { | |
1742 | what = "read"; | |
ff7c79e4 | 1743 | if (retval >= 0) { |
28ffd79c | 1744 | ERROR(dev, "ctrl_out, rlen %d (expected %d)\n", |
ff7c79e4 DB |
1745 | retval, len); |
1746 | retval = -EBADMSG; | |
1747 | } | |
1da177e4 LT |
1748 | break; |
1749 | } | |
1750 | ||
1751 | /* fail if we can't verify */ | |
1752 | for (j = 0; j < len; j++) { | |
169900f9 | 1753 | if (buf[j] != (u8)(i + j)) { |
28ffd79c | 1754 | ERROR(dev, "ctrl_out, byte %d is %d not %d\n", |
169900f9 | 1755 | j, buf[j], (u8)(i + j)); |
1da177e4 LT |
1756 | retval = -EBADMSG; |
1757 | break; | |
1758 | } | |
1759 | } | |
1760 | if (retval < 0) { | |
1761 | what = "verify"; | |
1762 | break; | |
1763 | } | |
1764 | ||
1765 | len += vary; | |
ff7c79e4 DB |
1766 | |
1767 | /* [real world] the "zero bytes IN" case isn't really used. | |
dc0d5c1e | 1768 | * hardware can easily trip up in this weird case, since its |
ff7c79e4 DB |
1769 | * status stage is IN, not OUT like other ep0in transfers. |
1770 | */ | |
1da177e4 | 1771 | if (len > length) |
ff7c79e4 | 1772 | len = realworld ? 1 : 0; |
1da177e4 LT |
1773 | } |
1774 | ||
1775 | if (retval < 0) | |
fabbf219 | 1776 | ERROR(dev, "ctrl_out %s failed, code %d, count %d\n", |
1da177e4 LT |
1777 | what, retval, i); |
1778 | ||
084fb206 | 1779 | kfree(buf - offset); |
1da177e4 LT |
1780 | return retval; |
1781 | } | |
1782 | ||
1783 | /*-------------------------------------------------------------------------*/ | |
1784 | ||
1785 | /* ISO tests ... mimics common usage | |
1786 | * - buffer length is split into N packets (mostly maxpacket sized) | |
1787 | * - multi-buffers according to sglen | |
1788 | */ | |
1789 | ||
1790 | struct iso_context { | |
1791 | unsigned count; | |
1792 | unsigned pending; | |
1793 | spinlock_t lock; | |
1794 | struct completion done; | |
9da2150f | 1795 | int submit_error; |
1da177e4 | 1796 | unsigned long errors; |
9da2150f | 1797 | unsigned long packet_count; |
1da177e4 LT |
1798 | struct usbtest_dev *dev; |
1799 | }; | |
1800 | ||
fabbf219 | 1801 | static void iso_callback(struct urb *urb) |
1da177e4 LT |
1802 | { |
1803 | struct iso_context *ctx = urb->context; | |
1804 | ||
1805 | spin_lock(&ctx->lock); | |
1806 | ctx->count--; | |
1807 | ||
9da2150f | 1808 | ctx->packet_count += urb->number_of_packets; |
1da177e4 LT |
1809 | if (urb->error_count > 0) |
1810 | ctx->errors += urb->error_count; | |
9da2150f AS |
1811 | else if (urb->status != 0) |
1812 | ctx->errors += urb->number_of_packets; | |
40aed524 MF |
1813 | else if (urb->actual_length != urb->transfer_buffer_length) |
1814 | ctx->errors++; | |
084fb206 MF |
1815 | else if (check_guard_bytes(ctx->dev, urb) != 0) |
1816 | ctx->errors++; | |
1da177e4 | 1817 | |
9da2150f AS |
1818 | if (urb->status == 0 && ctx->count > (ctx->pending - 1) |
1819 | && !ctx->submit_error) { | |
fabbf219 | 1820 | int status = usb_submit_urb(urb, GFP_ATOMIC); |
1da177e4 LT |
1821 | switch (status) { |
1822 | case 0: | |
1823 | goto done; | |
1824 | default: | |
28ffd79c | 1825 | dev_err(&ctx->dev->intf->dev, |
1da177e4 LT |
1826 | "iso resubmit err %d\n", |
1827 | status); | |
1828 | /* FALLTHROUGH */ | |
1829 | case -ENODEV: /* disconnected */ | |
9da2150f AS |
1830 | case -ESHUTDOWN: /* endpoint disabled */ |
1831 | ctx->submit_error = 1; | |
1da177e4 LT |
1832 | break; |
1833 | } | |
1834 | } | |
1da177e4 LT |
1835 | |
1836 | ctx->pending--; | |
1837 | if (ctx->pending == 0) { | |
1838 | if (ctx->errors) | |
28ffd79c | 1839 | dev_err(&ctx->dev->intf->dev, |
9da2150f AS |
1840 | "iso test, %lu errors out of %lu\n", |
1841 | ctx->errors, ctx->packet_count); | |
fabbf219 | 1842 | complete(&ctx->done); |
1da177e4 LT |
1843 | } |
1844 | done: | |
1845 | spin_unlock(&ctx->lock); | |
1846 | } | |
1847 | ||
fabbf219 | 1848 | static struct urb *iso_alloc_urb( |
1da177e4 LT |
1849 | struct usb_device *udev, |
1850 | int pipe, | |
1851 | struct usb_endpoint_descriptor *desc, | |
084fb206 MF |
1852 | long bytes, |
1853 | unsigned offset | |
1da177e4 LT |
1854 | ) |
1855 | { | |
1856 | struct urb *urb; | |
1857 | unsigned i, maxp, packets; | |
1858 | ||
1859 | if (bytes < 0 || !desc) | |
1860 | return NULL; | |
29cc8897 KM |
1861 | maxp = 0x7ff & usb_endpoint_maxp(desc); |
1862 | maxp *= 1 + (0x3 & (usb_endpoint_maxp(desc) >> 11)); | |
dfa5ec79 | 1863 | packets = DIV_ROUND_UP(bytes, maxp); |
1da177e4 | 1864 | |
fabbf219 | 1865 | urb = usb_alloc_urb(packets, GFP_KERNEL); |
1da177e4 LT |
1866 | if (!urb) |
1867 | return urb; | |
1868 | urb->dev = udev; | |
1869 | urb->pipe = pipe; | |
1870 | ||
1871 | urb->number_of_packets = packets; | |
1872 | urb->transfer_buffer_length = bytes; | |
084fb206 MF |
1873 | urb->transfer_buffer = usb_alloc_coherent(udev, bytes + offset, |
1874 | GFP_KERNEL, | |
1875 | &urb->transfer_dma); | |
1da177e4 | 1876 | if (!urb->transfer_buffer) { |
fabbf219 | 1877 | usb_free_urb(urb); |
1da177e4 LT |
1878 | return NULL; |
1879 | } | |
084fb206 MF |
1880 | if (offset) { |
1881 | memset(urb->transfer_buffer, GUARD_BYTE, offset); | |
1882 | urb->transfer_buffer += offset; | |
1883 | urb->transfer_dma += offset; | |
1884 | } | |
1885 | /* For inbound transfers use guard byte so that test fails if | |
1886 | data not correctly copied */ | |
1887 | memset(urb->transfer_buffer, | |
1888 | usb_pipein(urb->pipe) ? GUARD_BYTE : 0, | |
1889 | bytes); | |
1890 | ||
1da177e4 LT |
1891 | for (i = 0; i < packets; i++) { |
1892 | /* here, only the last packet will be short */ | |
fabbf219 | 1893 | urb->iso_frame_desc[i].length = min((unsigned) bytes, maxp); |
1da177e4 LT |
1894 | bytes -= urb->iso_frame_desc[i].length; |
1895 | ||
1896 | urb->iso_frame_desc[i].offset = maxp * i; | |
1897 | } | |
1898 | ||
1899 | urb->complete = iso_callback; | |
fabbf219 | 1900 | /* urb->context = SET BY CALLER */ |
1da177e4 LT |
1901 | urb->interval = 1 << (desc->bInterval - 1); |
1902 | urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP; | |
1903 | return urb; | |
1904 | } | |
1905 | ||
1906 | static int | |
fabbf219 | 1907 | test_iso_queue(struct usbtest_dev *dev, struct usbtest_param *param, |
084fb206 | 1908 | int pipe, struct usb_endpoint_descriptor *desc, unsigned offset) |
1da177e4 LT |
1909 | { |
1910 | struct iso_context context; | |
1911 | struct usb_device *udev; | |
1912 | unsigned i; | |
1913 | unsigned long packets = 0; | |
9da2150f | 1914 | int status = 0; |
41d3c0b8 | 1915 | struct urb *urbs[param->sglen]; |
1da177e4 | 1916 | |
f55055b4 | 1917 | memset(&context, 0, sizeof(context)); |
1da177e4 | 1918 | context.count = param->iterations * param->sglen; |
1da177e4 | 1919 | context.dev = dev; |
fabbf219 MF |
1920 | init_completion(&context.done); |
1921 | spin_lock_init(&context.lock); | |
1da177e4 | 1922 | |
fabbf219 | 1923 | udev = testdev_to_usbdev(dev); |
28ffd79c | 1924 | dev_info(&dev->intf->dev, |
a0c9d0de | 1925 | "iso period %d %sframes, wMaxPacket %d, transactions: %d\n", |
1da177e4 LT |
1926 | 1 << (desc->bInterval - 1), |
1927 | (udev->speed == USB_SPEED_HIGH) ? "micro" : "", | |
a0c9d0de PC |
1928 | usb_endpoint_maxp(desc) & 0x7ff, |
1929 | 1 + (0x3 & (usb_endpoint_maxp(desc) >> 11))); | |
1da177e4 LT |
1930 | |
1931 | for (i = 0; i < param->sglen; i++) { | |
fabbf219 | 1932 | urbs[i] = iso_alloc_urb(udev, pipe, desc, |
084fb206 | 1933 | param->length, offset); |
fabbf219 | 1934 | if (!urbs[i]) { |
1da177e4 LT |
1935 | status = -ENOMEM; |
1936 | goto fail; | |
1937 | } | |
1938 | packets += urbs[i]->number_of_packets; | |
fabbf219 | 1939 | urbs[i]->context = &context; |
1da177e4 LT |
1940 | } |
1941 | packets *= param->iterations; | |
28ffd79c | 1942 | dev_info(&dev->intf->dev, |
a0c9d0de | 1943 | "total %lu msec (%lu packets)\n", |
1da177e4 LT |
1944 | (packets * (1 << (desc->bInterval - 1))) |
1945 | / ((udev->speed == USB_SPEED_HIGH) ? 8 : 1), | |
1946 | packets); | |
1947 | ||
fabbf219 | 1948 | spin_lock_irq(&context.lock); |
1da177e4 | 1949 | for (i = 0; i < param->sglen; i++) { |
9da2150f | 1950 | ++context.pending; |
fabbf219 | 1951 | status = usb_submit_urb(urbs[i], GFP_ATOMIC); |
1da177e4 | 1952 | if (status < 0) { |
fabbf219 | 1953 | ERROR(dev, "submit iso[%d], error %d\n", i, status); |
1da177e4 | 1954 | if (i == 0) { |
fabbf219 | 1955 | spin_unlock_irq(&context.lock); |
1da177e4 LT |
1956 | goto fail; |
1957 | } | |
1958 | ||
fabbf219 | 1959 | simple_free_urb(urbs[i]); |
e10e1bec | 1960 | urbs[i] = NULL; |
1da177e4 | 1961 | context.pending--; |
9da2150f AS |
1962 | context.submit_error = 1; |
1963 | break; | |
1da177e4 LT |
1964 | } |
1965 | } | |
fabbf219 | 1966 | spin_unlock_irq(&context.lock); |
1da177e4 | 1967 | |
fabbf219 | 1968 | wait_for_completion(&context.done); |
9da2150f | 1969 | |
e10e1bec ML |
1970 | for (i = 0; i < param->sglen; i++) { |
1971 | if (urbs[i]) | |
1972 | simple_free_urb(urbs[i]); | |
1973 | } | |
9da2150f AS |
1974 | /* |
1975 | * Isochronous transfers are expected to fail sometimes. As an | |
1976 | * arbitrary limit, we will report an error if any submissions | |
1977 | * fail or if the transfer failure rate is > 10%. | |
1978 | */ | |
1979 | if (status != 0) | |
1980 | ; | |
1981 | else if (context.submit_error) | |
1982 | status = -EACCES; | |
1983 | else if (context.errors > context.packet_count / 10) | |
1984 | status = -EIO; | |
1985 | return status; | |
1da177e4 LT |
1986 | |
1987 | fail: | |
1988 | for (i = 0; i < param->sglen; i++) { | |
fabbf219 MF |
1989 | if (urbs[i]) |
1990 | simple_free_urb(urbs[i]); | |
1da177e4 LT |
1991 | } |
1992 | return status; | |
1993 | } | |
1994 | ||
084fb206 MF |
1995 | static int test_unaligned_bulk( |
1996 | struct usbtest_dev *tdev, | |
1997 | int pipe, | |
1998 | unsigned length, | |
1999 | int iterations, | |
2000 | unsigned transfer_flags, | |
2001 | const char *label) | |
2002 | { | |
2003 | int retval; | |
2004 | struct urb *urb = usbtest_alloc_urb( | |
457a0955 | 2005 | testdev_to_usbdev(tdev), pipe, length, transfer_flags, 1, 0); |
084fb206 MF |
2006 | |
2007 | if (!urb) | |
2008 | return -ENOMEM; | |
2009 | ||
2010 | retval = simple_io(tdev, urb, iterations, 0, 0, label); | |
2011 | simple_free_urb(urb); | |
2012 | return retval; | |
2013 | } | |
2014 | ||
1da177e4 LT |
2015 | /*-------------------------------------------------------------------------*/ |
2016 | ||
2017 | /* We only have this one interface to user space, through usbfs. | |
2018 | * User mode code can scan usbfs to find N different devices (maybe on | |
2019 | * different busses) to use when testing, and allocate one thread per | |
2020 | * test. So discovery is simplified, and we have no device naming issues. | |
2021 | * | |
2022 | * Don't use these only as stress/load tests. Use them along with with | |
2023 | * other USB bus activity: plugging, unplugging, mousing, mp3 playback, | |
2024 | * video capture, and so on. Run different tests at different times, in | |
2025 | * different sequences. Nothing here should interact with other devices, | |
2026 | * except indirectly by consuming USB bandwidth and CPU resources for test | |
2027 | * threads and request completion. But the only way to know that for sure | |
2028 | * is to test when HC queues are in use by many devices. | |
28ffd79c DB |
2029 | * |
2030 | * WARNING: Because usbfs grabs udev->dev.sem before calling this ioctl(), | |
2031 | * it locks out usbcore in certain code paths. Notably, if you disconnect | |
37ebb549 | 2032 | * the device-under-test, hub_wq will wait block forever waiting for the |
28ffd79c DB |
2033 | * ioctl to complete ... so that usb_disconnect() can abort the pending |
2034 | * urbs and then call usbtest_disconnect(). To abort a test, you're best | |
2035 | * off just killing the userspace task and waiting for it to exit. | |
1da177e4 LT |
2036 | */ |
2037 | ||
2038 | static int | |
fabbf219 | 2039 | usbtest_ioctl(struct usb_interface *intf, unsigned int code, void *buf) |
1da177e4 | 2040 | { |
fabbf219 MF |
2041 | struct usbtest_dev *dev = usb_get_intfdata(intf); |
2042 | struct usb_device *udev = testdev_to_usbdev(dev); | |
1da177e4 LT |
2043 | struct usbtest_param *param = buf; |
2044 | int retval = -EOPNOTSUPP; | |
2045 | struct urb *urb; | |
2046 | struct scatterlist *sg; | |
2047 | struct usb_sg_request req; | |
2048 | struct timeval start; | |
2049 | unsigned i; | |
2050 | ||
fabbf219 | 2051 | /* FIXME USBDEVFS_CONNECTINFO doesn't say how fast the device is. */ |
1da177e4 | 2052 | |
7f4e9854 VP |
2053 | pattern = mod_pattern; |
2054 | ||
1da177e4 LT |
2055 | if (code != USBTEST_REQUEST) |
2056 | return -EOPNOTSUPP; | |
2057 | ||
8aafdf6a | 2058 | if (param->iterations <= 0) |
1da177e4 LT |
2059 | return -EINVAL; |
2060 | ||
41d3c0b8 PC |
2061 | if (param->sglen > MAX_SGLEN) |
2062 | return -EINVAL; | |
2063 | ||
1cfab028 | 2064 | if (mutex_lock_interruptible(&dev->lock)) |
1da177e4 LT |
2065 | return -ERESTARTSYS; |
2066 | ||
70a1c9e0 | 2067 | /* FIXME: What if a system sleep starts while a test is running? */ |
ff7c79e4 | 2068 | |
1da177e4 LT |
2069 | /* some devices, like ez-usb default devices, need a non-default |
2070 | * altsetting to have any active endpoints. some tests change | |
2071 | * altsettings; force a default so most tests don't need to check. | |
2072 | */ | |
2073 | if (dev->info->alt >= 0) { | |
28ffd79c | 2074 | int res; |
1da177e4 LT |
2075 | |
2076 | if (intf->altsetting->desc.bInterfaceNumber) { | |
1cfab028 | 2077 | mutex_unlock(&dev->lock); |
1da177e4 LT |
2078 | return -ENODEV; |
2079 | } | |
fabbf219 | 2080 | res = set_altsetting(dev, dev->info->alt); |
1da177e4 | 2081 | if (res) { |
fabbf219 | 2082 | dev_err(&intf->dev, |
1da177e4 LT |
2083 | "set altsetting to %d failed, %d\n", |
2084 | dev->info->alt, res); | |
1cfab028 | 2085 | mutex_unlock(&dev->lock); |
1da177e4 LT |
2086 | return res; |
2087 | } | |
2088 | } | |
2089 | ||
2090 | /* | |
2091 | * Just a bunch of test cases that every HCD is expected to handle. | |
2092 | * | |
2093 | * Some may need specific firmware, though it'd be good to have | |
2094 | * one firmware image to handle all the test cases. | |
2095 | * | |
2096 | * FIXME add more tests! cancel requests, verify the data, control | |
2097 | * queueing, concurrent read+write threads, and so on. | |
2098 | */ | |
fabbf219 | 2099 | do_gettimeofday(&start); |
1da177e4 LT |
2100 | switch (param->test_num) { |
2101 | ||
2102 | case 0: | |
28ffd79c | 2103 | dev_info(&intf->dev, "TEST 0: NOP\n"); |
1da177e4 LT |
2104 | retval = 0; |
2105 | break; | |
2106 | ||
2107 | /* Simple non-queued bulk I/O tests */ | |
2108 | case 1: | |
2109 | if (dev->out_pipe == 0) | |
2110 | break; | |
28ffd79c | 2111 | dev_info(&intf->dev, |
1da177e4 LT |
2112 | "TEST 1: write %d bytes %u times\n", |
2113 | param->length, param->iterations); | |
457a0955 | 2114 | urb = simple_alloc_urb(udev, dev->out_pipe, param->length, 0); |
1da177e4 LT |
2115 | if (!urb) { |
2116 | retval = -ENOMEM; | |
2117 | break; | |
2118 | } | |
fabbf219 | 2119 | /* FIRMWARE: bulk sink (maybe accepts short writes) */ |
28ffd79c | 2120 | retval = simple_io(dev, urb, param->iterations, 0, 0, "test1"); |
fabbf219 | 2121 | simple_free_urb(urb); |
1da177e4 LT |
2122 | break; |
2123 | case 2: | |
2124 | if (dev->in_pipe == 0) | |
2125 | break; | |
28ffd79c | 2126 | dev_info(&intf->dev, |
1da177e4 LT |
2127 | "TEST 2: read %d bytes %u times\n", |
2128 | param->length, param->iterations); | |
457a0955 | 2129 | urb = simple_alloc_urb(udev, dev->in_pipe, param->length, 0); |
1da177e4 LT |
2130 | if (!urb) { |
2131 | retval = -ENOMEM; | |
2132 | break; | |
2133 | } | |
fabbf219 | 2134 | /* FIRMWARE: bulk source (maybe generates short writes) */ |
28ffd79c | 2135 | retval = simple_io(dev, urb, param->iterations, 0, 0, "test2"); |
fabbf219 | 2136 | simple_free_urb(urb); |
1da177e4 LT |
2137 | break; |
2138 | case 3: | |
2139 | if (dev->out_pipe == 0 || param->vary == 0) | |
2140 | break; | |
28ffd79c | 2141 | dev_info(&intf->dev, |
1da177e4 LT |
2142 | "TEST 3: write/%d 0..%d bytes %u times\n", |
2143 | param->vary, param->length, param->iterations); | |
457a0955 | 2144 | urb = simple_alloc_urb(udev, dev->out_pipe, param->length, 0); |
1da177e4 LT |
2145 | if (!urb) { |
2146 | retval = -ENOMEM; | |
2147 | break; | |
2148 | } | |
fabbf219 | 2149 | /* FIRMWARE: bulk sink (maybe accepts short writes) */ |
28ffd79c | 2150 | retval = simple_io(dev, urb, param->iterations, param->vary, |
1da177e4 | 2151 | 0, "test3"); |
fabbf219 | 2152 | simple_free_urb(urb); |
1da177e4 LT |
2153 | break; |
2154 | case 4: | |
2155 | if (dev->in_pipe == 0 || param->vary == 0) | |
2156 | break; | |
28ffd79c | 2157 | dev_info(&intf->dev, |
1da177e4 LT |
2158 | "TEST 4: read/%d 0..%d bytes %u times\n", |
2159 | param->vary, param->length, param->iterations); | |
457a0955 | 2160 | urb = simple_alloc_urb(udev, dev->in_pipe, param->length, 0); |
1da177e4 LT |
2161 | if (!urb) { |
2162 | retval = -ENOMEM; | |
2163 | break; | |
2164 | } | |
fabbf219 | 2165 | /* FIRMWARE: bulk source (maybe generates short writes) */ |
28ffd79c | 2166 | retval = simple_io(dev, urb, param->iterations, param->vary, |
1da177e4 | 2167 | 0, "test4"); |
fabbf219 | 2168 | simple_free_urb(urb); |
1da177e4 LT |
2169 | break; |
2170 | ||
2171 | /* Queued bulk I/O tests */ | |
2172 | case 5: | |
2173 | if (dev->out_pipe == 0 || param->sglen == 0) | |
2174 | break; | |
28ffd79c | 2175 | dev_info(&intf->dev, |
1da177e4 LT |
2176 | "TEST 5: write %d sglists %d entries of %d bytes\n", |
2177 | param->iterations, | |
2178 | param->sglen, param->length); | |
fabbf219 | 2179 | sg = alloc_sglist(param->sglen, param->length, 0); |
1da177e4 LT |
2180 | if (!sg) { |
2181 | retval = -ENOMEM; | |
2182 | break; | |
2183 | } | |
fabbf219 | 2184 | /* FIRMWARE: bulk sink (maybe accepts short writes) */ |
28ffd79c | 2185 | retval = perform_sglist(dev, param->iterations, dev->out_pipe, |
1da177e4 | 2186 | &req, sg, param->sglen); |
fabbf219 | 2187 | free_sglist(sg, param->sglen); |
1da177e4 LT |
2188 | break; |
2189 | ||
2190 | case 6: | |
2191 | if (dev->in_pipe == 0 || param->sglen == 0) | |
2192 | break; | |
28ffd79c | 2193 | dev_info(&intf->dev, |
1da177e4 LT |
2194 | "TEST 6: read %d sglists %d entries of %d bytes\n", |
2195 | param->iterations, | |
2196 | param->sglen, param->length); | |
fabbf219 | 2197 | sg = alloc_sglist(param->sglen, param->length, 0); |
1da177e4 LT |
2198 | if (!sg) { |
2199 | retval = -ENOMEM; | |
2200 | break; | |
2201 | } | |
fabbf219 | 2202 | /* FIRMWARE: bulk source (maybe generates short writes) */ |
28ffd79c | 2203 | retval = perform_sglist(dev, param->iterations, dev->in_pipe, |
1da177e4 | 2204 | &req, sg, param->sglen); |
fabbf219 | 2205 | free_sglist(sg, param->sglen); |
1da177e4 LT |
2206 | break; |
2207 | case 7: | |
2208 | if (dev->out_pipe == 0 || param->sglen == 0 || param->vary == 0) | |
2209 | break; | |
28ffd79c | 2210 | dev_info(&intf->dev, |
1da177e4 LT |
2211 | "TEST 7: write/%d %d sglists %d entries 0..%d bytes\n", |
2212 | param->vary, param->iterations, | |
2213 | param->sglen, param->length); | |
fabbf219 | 2214 | sg = alloc_sglist(param->sglen, param->length, param->vary); |
1da177e4 LT |
2215 | if (!sg) { |
2216 | retval = -ENOMEM; | |
2217 | break; | |
2218 | } | |
fabbf219 | 2219 | /* FIRMWARE: bulk sink (maybe accepts short writes) */ |
28ffd79c | 2220 | retval = perform_sglist(dev, param->iterations, dev->out_pipe, |
1da177e4 | 2221 | &req, sg, param->sglen); |
fabbf219 | 2222 | free_sglist(sg, param->sglen); |
1da177e4 LT |
2223 | break; |
2224 | case 8: | |
2225 | if (dev->in_pipe == 0 || param->sglen == 0 || param->vary == 0) | |
2226 | break; | |
28ffd79c | 2227 | dev_info(&intf->dev, |
1da177e4 LT |
2228 | "TEST 8: read/%d %d sglists %d entries 0..%d bytes\n", |
2229 | param->vary, param->iterations, | |
2230 | param->sglen, param->length); | |
fabbf219 | 2231 | sg = alloc_sglist(param->sglen, param->length, param->vary); |
1da177e4 LT |
2232 | if (!sg) { |
2233 | retval = -ENOMEM; | |
2234 | break; | |
2235 | } | |
fabbf219 | 2236 | /* FIRMWARE: bulk source (maybe generates short writes) */ |
28ffd79c | 2237 | retval = perform_sglist(dev, param->iterations, dev->in_pipe, |
1da177e4 | 2238 | &req, sg, param->sglen); |
fabbf219 | 2239 | free_sglist(sg, param->sglen); |
1da177e4 LT |
2240 | break; |
2241 | ||
2242 | /* non-queued sanity tests for control (chapter 9 subset) */ | |
2243 | case 9: | |
2244 | retval = 0; | |
28ffd79c | 2245 | dev_info(&intf->dev, |
1da177e4 LT |
2246 | "TEST 9: ch9 (subset) control tests, %d times\n", |
2247 | param->iterations); | |
2248 | for (i = param->iterations; retval == 0 && i--; /* NOP */) | |
fabbf219 | 2249 | retval = ch9_postconfig(dev); |
1da177e4 | 2250 | if (retval) |
28ffd79c DB |
2251 | dev_err(&intf->dev, "ch9 subset failed, " |
2252 | "iterations left %d\n", i); | |
1da177e4 LT |
2253 | break; |
2254 | ||
2255 | /* queued control messaging */ | |
2256 | case 10: | |
1da177e4 | 2257 | retval = 0; |
28ffd79c | 2258 | dev_info(&intf->dev, |
1da177e4 LT |
2259 | "TEST 10: queue %d control calls, %d times\n", |
2260 | param->sglen, | |
2261 | param->iterations); | |
fabbf219 | 2262 | retval = test_ctrl_queue(dev, param); |
1da177e4 LT |
2263 | break; |
2264 | ||
2265 | /* simple non-queued unlinks (ring with one urb) */ | |
2266 | case 11: | |
2267 | if (dev->in_pipe == 0 || !param->length) | |
2268 | break; | |
2269 | retval = 0; | |
28ffd79c | 2270 | dev_info(&intf->dev, "TEST 11: unlink %d reads of %d\n", |
1da177e4 LT |
2271 | param->iterations, param->length); |
2272 | for (i = param->iterations; retval == 0 && i--; /* NOP */) | |
fabbf219 | 2273 | retval = unlink_simple(dev, dev->in_pipe, |
1da177e4 LT |
2274 | param->length); |
2275 | if (retval) | |
28ffd79c | 2276 | dev_err(&intf->dev, "unlink reads failed %d, " |
1da177e4 LT |
2277 | "iterations left %d\n", retval, i); |
2278 | break; | |
2279 | case 12: | |
2280 | if (dev->out_pipe == 0 || !param->length) | |
2281 | break; | |
2282 | retval = 0; | |
28ffd79c | 2283 | dev_info(&intf->dev, "TEST 12: unlink %d writes of %d\n", |
1da177e4 LT |
2284 | param->iterations, param->length); |
2285 | for (i = param->iterations; retval == 0 && i--; /* NOP */) | |
fabbf219 | 2286 | retval = unlink_simple(dev, dev->out_pipe, |
1da177e4 LT |
2287 | param->length); |
2288 | if (retval) | |
28ffd79c | 2289 | dev_err(&intf->dev, "unlink writes failed %d, " |
1da177e4 LT |
2290 | "iterations left %d\n", retval, i); |
2291 | break; | |
2292 | ||
2293 | /* ep halt tests */ | |
2294 | case 13: | |
2295 | if (dev->out_pipe == 0 && dev->in_pipe == 0) | |
2296 | break; | |
2297 | retval = 0; | |
28ffd79c | 2298 | dev_info(&intf->dev, "TEST 13: set/clear %d halts\n", |
1da177e4 LT |
2299 | param->iterations); |
2300 | for (i = param->iterations; retval == 0 && i--; /* NOP */) | |
fabbf219 | 2301 | retval = halt_simple(dev); |
28ffd79c | 2302 | |
1da177e4 | 2303 | if (retval) |
28ffd79c | 2304 | ERROR(dev, "halts failed, iterations left %d\n", i); |
1da177e4 LT |
2305 | break; |
2306 | ||
2307 | /* control write tests */ | |
2308 | case 14: | |
2309 | if (!dev->info->ctrl_out) | |
2310 | break; | |
28ffd79c | 2311 | dev_info(&intf->dev, "TEST 14: %d ep0out, %d..%d vary %d\n", |
ff7c79e4 DB |
2312 | param->iterations, |
2313 | realworld ? 1 : 0, param->length, | |
2314 | param->vary); | |
28ffd79c | 2315 | retval = ctrl_out(dev, param->iterations, |
084fb206 | 2316 | param->length, param->vary, 0); |
1da177e4 LT |
2317 | break; |
2318 | ||
2319 | /* iso write tests */ | |
2320 | case 15: | |
2321 | if (dev->out_iso_pipe == 0 || param->sglen == 0) | |
2322 | break; | |
28ffd79c | 2323 | dev_info(&intf->dev, |
1da177e4 LT |
2324 | "TEST 15: write %d iso, %d entries of %d bytes\n", |
2325 | param->iterations, | |
2326 | param->sglen, param->length); | |
fabbf219 MF |
2327 | /* FIRMWARE: iso sink */ |
2328 | retval = test_iso_queue(dev, param, | |
084fb206 | 2329 | dev->out_iso_pipe, dev->iso_out, 0); |
1da177e4 LT |
2330 | break; |
2331 | ||
2332 | /* iso read tests */ | |
2333 | case 16: | |
2334 | if (dev->in_iso_pipe == 0 || param->sglen == 0) | |
2335 | break; | |
28ffd79c | 2336 | dev_info(&intf->dev, |
1da177e4 LT |
2337 | "TEST 16: read %d iso, %d entries of %d bytes\n", |
2338 | param->iterations, | |
2339 | param->sglen, param->length); | |
fabbf219 MF |
2340 | /* FIRMWARE: iso source */ |
2341 | retval = test_iso_queue(dev, param, | |
084fb206 | 2342 | dev->in_iso_pipe, dev->iso_in, 0); |
1da177e4 LT |
2343 | break; |
2344 | ||
fabbf219 | 2345 | /* FIXME scatterlist cancel (needs helper thread) */ |
1da177e4 | 2346 | |
084fb206 MF |
2347 | /* Tests for bulk I/O using DMA mapping by core and odd address */ |
2348 | case 17: | |
2349 | if (dev->out_pipe == 0) | |
2350 | break; | |
2351 | dev_info(&intf->dev, | |
2352 | "TEST 17: write odd addr %d bytes %u times core map\n", | |
2353 | param->length, param->iterations); | |
2354 | ||
2355 | retval = test_unaligned_bulk( | |
2356 | dev, dev->out_pipe, | |
2357 | param->length, param->iterations, | |
2358 | 0, "test17"); | |
2359 | break; | |
2360 | ||
2361 | case 18: | |
2362 | if (dev->in_pipe == 0) | |
2363 | break; | |
2364 | dev_info(&intf->dev, | |
2365 | "TEST 18: read odd addr %d bytes %u times core map\n", | |
2366 | param->length, param->iterations); | |
2367 | ||
2368 | retval = test_unaligned_bulk( | |
2369 | dev, dev->in_pipe, | |
2370 | param->length, param->iterations, | |
2371 | 0, "test18"); | |
2372 | break; | |
2373 | ||
2374 | /* Tests for bulk I/O using premapped coherent buffer and odd address */ | |
2375 | case 19: | |
2376 | if (dev->out_pipe == 0) | |
2377 | break; | |
2378 | dev_info(&intf->dev, | |
2379 | "TEST 19: write odd addr %d bytes %u times premapped\n", | |
2380 | param->length, param->iterations); | |
2381 | ||
2382 | retval = test_unaligned_bulk( | |
2383 | dev, dev->out_pipe, | |
2384 | param->length, param->iterations, | |
2385 | URB_NO_TRANSFER_DMA_MAP, "test19"); | |
2386 | break; | |
2387 | ||
2388 | case 20: | |
2389 | if (dev->in_pipe == 0) | |
2390 | break; | |
2391 | dev_info(&intf->dev, | |
2392 | "TEST 20: read odd addr %d bytes %u times premapped\n", | |
2393 | param->length, param->iterations); | |
2394 | ||
2395 | retval = test_unaligned_bulk( | |
2396 | dev, dev->in_pipe, | |
2397 | param->length, param->iterations, | |
2398 | URB_NO_TRANSFER_DMA_MAP, "test20"); | |
2399 | break; | |
2400 | ||
2401 | /* control write tests with unaligned buffer */ | |
2402 | case 21: | |
2403 | if (!dev->info->ctrl_out) | |
2404 | break; | |
2405 | dev_info(&intf->dev, | |
2406 | "TEST 21: %d ep0out odd addr, %d..%d vary %d\n", | |
2407 | param->iterations, | |
2408 | realworld ? 1 : 0, param->length, | |
2409 | param->vary); | |
2410 | retval = ctrl_out(dev, param->iterations, | |
2411 | param->length, param->vary, 1); | |
2412 | break; | |
2413 | ||
2414 | /* unaligned iso tests */ | |
2415 | case 22: | |
2416 | if (dev->out_iso_pipe == 0 || param->sglen == 0) | |
2417 | break; | |
2418 | dev_info(&intf->dev, | |
2419 | "TEST 22: write %d iso odd, %d entries of %d bytes\n", | |
2420 | param->iterations, | |
2421 | param->sglen, param->length); | |
2422 | retval = test_iso_queue(dev, param, | |
2423 | dev->out_iso_pipe, dev->iso_out, 1); | |
2424 | break; | |
2425 | ||
2426 | case 23: | |
2427 | if (dev->in_iso_pipe == 0 || param->sglen == 0) | |
2428 | break; | |
2429 | dev_info(&intf->dev, | |
2430 | "TEST 23: read %d iso odd, %d entries of %d bytes\n", | |
2431 | param->iterations, | |
2432 | param->sglen, param->length); | |
2433 | retval = test_iso_queue(dev, param, | |
2434 | dev->in_iso_pipe, dev->iso_in, 1); | |
2435 | break; | |
2436 | ||
869410f8 AS |
2437 | /* unlink URBs from a bulk-OUT queue */ |
2438 | case 24: | |
2439 | if (dev->out_pipe == 0 || !param->length || param->sglen < 4) | |
2440 | break; | |
2441 | retval = 0; | |
2cb50000 | 2442 | dev_info(&intf->dev, "TEST 24: unlink from %d queues of " |
869410f8 AS |
2443 | "%d %d-byte writes\n", |
2444 | param->iterations, param->sglen, param->length); | |
2445 | for (i = param->iterations; retval == 0 && i > 0; --i) { | |
2446 | retval = unlink_queued(dev, dev->out_pipe, | |
2447 | param->sglen, param->length); | |
2448 | if (retval) { | |
2449 | dev_err(&intf->dev, | |
2450 | "unlink queued writes failed %d, " | |
2451 | "iterations left %d\n", retval, i); | |
2452 | break; | |
2453 | } | |
2454 | } | |
2455 | break; | |
2456 | ||
457a0955 AV |
2457 | /* Simple non-queued interrupt I/O tests */ |
2458 | case 25: | |
2459 | if (dev->out_int_pipe == 0) | |
2460 | break; | |
2461 | dev_info(&intf->dev, | |
2462 | "TEST 25: write %d bytes %u times\n", | |
2463 | param->length, param->iterations); | |
2464 | urb = simple_alloc_urb(udev, dev->out_int_pipe, param->length, | |
2465 | dev->int_out->bInterval); | |
2466 | if (!urb) { | |
2467 | retval = -ENOMEM; | |
2468 | break; | |
2469 | } | |
2470 | /* FIRMWARE: interrupt sink (maybe accepts short writes) */ | |
2471 | retval = simple_io(dev, urb, param->iterations, 0, 0, "test25"); | |
2472 | simple_free_urb(urb); | |
2473 | break; | |
2474 | case 26: | |
2475 | if (dev->in_int_pipe == 0) | |
2476 | break; | |
2477 | dev_info(&intf->dev, | |
2478 | "TEST 26: read %d bytes %u times\n", | |
2479 | param->length, param->iterations); | |
2480 | urb = simple_alloc_urb(udev, dev->in_int_pipe, param->length, | |
2481 | dev->int_in->bInterval); | |
2482 | if (!urb) { | |
2483 | retval = -ENOMEM; | |
2484 | break; | |
2485 | } | |
2486 | /* FIRMWARE: interrupt source (maybe generates short writes) */ | |
2487 | retval = simple_io(dev, urb, param->iterations, 0, 0, "test26"); | |
2488 | simple_free_urb(urb); | |
2489 | break; | |
1da177e4 | 2490 | } |
fabbf219 | 2491 | do_gettimeofday(¶m->duration); |
1da177e4 LT |
2492 | param->duration.tv_sec -= start.tv_sec; |
2493 | param->duration.tv_usec -= start.tv_usec; | |
2494 | if (param->duration.tv_usec < 0) { | |
2495 | param->duration.tv_usec += 1000 * 1000; | |
2496 | param->duration.tv_sec -= 1; | |
2497 | } | |
1cfab028 | 2498 | mutex_unlock(&dev->lock); |
1da177e4 LT |
2499 | return retval; |
2500 | } | |
2501 | ||
2502 | /*-------------------------------------------------------------------------*/ | |
2503 | ||
fabbf219 MF |
2504 | static unsigned force_interrupt; |
2505 | module_param(force_interrupt, uint, 0); | |
2506 | MODULE_PARM_DESC(force_interrupt, "0 = test default; else interrupt"); | |
1da177e4 LT |
2507 | |
2508 | #ifdef GENERIC | |
2509 | static unsigned short vendor; | |
2510 | module_param(vendor, ushort, 0); | |
fabbf219 | 2511 | MODULE_PARM_DESC(vendor, "vendor code (from usb-if)"); |
1da177e4 LT |
2512 | |
2513 | static unsigned short product; | |
2514 | module_param(product, ushort, 0); | |
fabbf219 | 2515 | MODULE_PARM_DESC(product, "product code (from vendor)"); |
1da177e4 LT |
2516 | #endif |
2517 | ||
2518 | static int | |
fabbf219 | 2519 | usbtest_probe(struct usb_interface *intf, const struct usb_device_id *id) |
1da177e4 LT |
2520 | { |
2521 | struct usb_device *udev; | |
2522 | struct usbtest_dev *dev; | |
2523 | struct usbtest_info *info; | |
2524 | char *rtest, *wtest; | |
2525 | char *irtest, *iwtest; | |
457a0955 | 2526 | char *intrtest, *intwtest; |
1da177e4 | 2527 | |
fabbf219 | 2528 | udev = interface_to_usbdev(intf); |
1da177e4 LT |
2529 | |
2530 | #ifdef GENERIC | |
2531 | /* specify devices by module parameters? */ | |
2532 | if (id->match_flags == 0) { | |
2533 | /* vendor match required, product match optional */ | |
2534 | if (!vendor || le16_to_cpu(udev->descriptor.idVendor) != (u16)vendor) | |
2535 | return -ENODEV; | |
2536 | if (product && le16_to_cpu(udev->descriptor.idProduct) != (u16)product) | |
2537 | return -ENODEV; | |
28ffd79c DB |
2538 | dev_info(&intf->dev, "matched module params, " |
2539 | "vend=0x%04x prod=0x%04x\n", | |
1da177e4 LT |
2540 | le16_to_cpu(udev->descriptor.idVendor), |
2541 | le16_to_cpu(udev->descriptor.idProduct)); | |
2542 | } | |
2543 | #endif | |
2544 | ||
e94b1766 | 2545 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); |
1da177e4 LT |
2546 | if (!dev) |
2547 | return -ENOMEM; | |
1da177e4 LT |
2548 | info = (struct usbtest_info *) id->driver_info; |
2549 | dev->info = info; | |
1cfab028 | 2550 | mutex_init(&dev->lock); |
1da177e4 LT |
2551 | |
2552 | dev->intf = intf; | |
2553 | ||
2554 | /* cacheline-aligned scratch for i/o */ | |
fabbf219 MF |
2555 | dev->buf = kmalloc(TBUF_SIZE, GFP_KERNEL); |
2556 | if (dev->buf == NULL) { | |
2557 | kfree(dev); | |
1da177e4 LT |
2558 | return -ENOMEM; |
2559 | } | |
2560 | ||
2561 | /* NOTE this doesn't yet test the handful of difference that are | |
2562 | * visible with high speed interrupts: bigger maxpacket (1K) and | |
2563 | * "high bandwidth" modes (up to 3 packets/uframe). | |
2564 | */ | |
2565 | rtest = wtest = ""; | |
2566 | irtest = iwtest = ""; | |
457a0955 | 2567 | intrtest = intwtest = ""; |
1da177e4 LT |
2568 | if (force_interrupt || udev->speed == USB_SPEED_LOW) { |
2569 | if (info->ep_in) { | |
fabbf219 | 2570 | dev->in_pipe = usb_rcvintpipe(udev, info->ep_in); |
1da177e4 LT |
2571 | rtest = " intr-in"; |
2572 | } | |
2573 | if (info->ep_out) { | |
fabbf219 | 2574 | dev->out_pipe = usb_sndintpipe(udev, info->ep_out); |
1da177e4 LT |
2575 | wtest = " intr-out"; |
2576 | } | |
2577 | } else { | |
d0b4652f | 2578 | if (override_alt >= 0 || info->autoconf) { |
1da177e4 LT |
2579 | int status; |
2580 | ||
fabbf219 | 2581 | status = get_endpoints(dev, intf); |
1da177e4 | 2582 | if (status < 0) { |
b6c63937 | 2583 | WARNING(dev, "couldn't get endpoints, %d\n", |
28ffd79c | 2584 | status); |
f4a728d0 JL |
2585 | kfree(dev->buf); |
2586 | kfree(dev); | |
1da177e4 LT |
2587 | return status; |
2588 | } | |
2589 | /* may find bulk or ISO pipes */ | |
2590 | } else { | |
2591 | if (info->ep_in) | |
fabbf219 | 2592 | dev->in_pipe = usb_rcvbulkpipe(udev, |
1da177e4 LT |
2593 | info->ep_in); |
2594 | if (info->ep_out) | |
fabbf219 | 2595 | dev->out_pipe = usb_sndbulkpipe(udev, |
1da177e4 LT |
2596 | info->ep_out); |
2597 | } | |
2598 | if (dev->in_pipe) | |
2599 | rtest = " bulk-in"; | |
2600 | if (dev->out_pipe) | |
2601 | wtest = " bulk-out"; | |
2602 | if (dev->in_iso_pipe) | |
2603 | irtest = " iso-in"; | |
2604 | if (dev->out_iso_pipe) | |
2605 | iwtest = " iso-out"; | |
457a0955 AV |
2606 | if (dev->in_int_pipe) |
2607 | intrtest = " int-in"; | |
2608 | if (dev->out_int_pipe) | |
2609 | intwtest = " int-out"; | |
1da177e4 LT |
2610 | } |
2611 | ||
fabbf219 MF |
2612 | usb_set_intfdata(intf, dev); |
2613 | dev_info(&intf->dev, "%s\n", info->name); | |
457a0955 | 2614 | dev_info(&intf->dev, "%s {control%s%s%s%s%s%s%s} tests%s\n", |
e538dfda | 2615 | usb_speed_string(udev->speed), |
1da177e4 LT |
2616 | info->ctrl_out ? " in/out" : "", |
2617 | rtest, wtest, | |
2618 | irtest, iwtest, | |
457a0955 | 2619 | intrtest, intwtest, |
1da177e4 LT |
2620 | info->alt >= 0 ? " (+alt)" : ""); |
2621 | return 0; | |
2622 | } | |
2623 | ||
fabbf219 | 2624 | static int usbtest_suspend(struct usb_interface *intf, pm_message_t message) |
ff7c79e4 | 2625 | { |
ff7c79e4 DB |
2626 | return 0; |
2627 | } | |
2628 | ||
fabbf219 | 2629 | static int usbtest_resume(struct usb_interface *intf) |
ff7c79e4 | 2630 | { |
ff7c79e4 DB |
2631 | return 0; |
2632 | } | |
2633 | ||
2634 | ||
fabbf219 | 2635 | static void usbtest_disconnect(struct usb_interface *intf) |
1da177e4 | 2636 | { |
fabbf219 | 2637 | struct usbtest_dev *dev = usb_get_intfdata(intf); |
1da177e4 | 2638 | |
fabbf219 MF |
2639 | usb_set_intfdata(intf, NULL); |
2640 | dev_dbg(&intf->dev, "disconnect\n"); | |
2641 | kfree(dev); | |
1da177e4 LT |
2642 | } |
2643 | ||
2644 | /* Basic testing only needs a device that can source or sink bulk traffic. | |
2645 | * Any device can test control transfers (default with GENERIC binding). | |
2646 | * | |
2647 | * Several entries work with the default EP0 implementation that's built | |
2648 | * into EZ-USB chips. There's a default vendor ID which can be overridden | |
2649 | * by (very) small config EEPROMS, but otherwise all these devices act | |
2650 | * identically until firmware is loaded: only EP0 works. It turns out | |
2651 | * to be easy to make other endpoints work, without modifying that EP0 | |
2652 | * behavior. For now, we expect that kind of firmware. | |
2653 | */ | |
2654 | ||
2655 | /* an21xx or fx versions of ez-usb */ | |
2656 | static struct usbtest_info ez1_info = { | |
2657 | .name = "EZ-USB device", | |
2658 | .ep_in = 2, | |
2659 | .ep_out = 2, | |
2660 | .alt = 1, | |
2661 | }; | |
2662 | ||
2663 | /* fx2 version of ez-usb */ | |
2664 | static struct usbtest_info ez2_info = { | |
2665 | .name = "FX2 device", | |
2666 | .ep_in = 6, | |
2667 | .ep_out = 2, | |
2668 | .alt = 1, | |
2669 | }; | |
2670 | ||
2671 | /* ezusb family device with dedicated usb test firmware, | |
2672 | */ | |
2673 | static struct usbtest_info fw_info = { | |
2674 | .name = "usb test device", | |
2675 | .ep_in = 2, | |
2676 | .ep_out = 2, | |
2677 | .alt = 1, | |
fabbf219 | 2678 | .autoconf = 1, /* iso and ctrl_out need autoconf */ |
1da177e4 | 2679 | .ctrl_out = 1, |
fabbf219 | 2680 | .iso = 1, /* iso_ep's are #8 in/out */ |
1da177e4 LT |
2681 | }; |
2682 | ||
2683 | /* peripheral running Linux and 'zero.c' test firmware, or | |
2684 | * its user-mode cousin. different versions of this use | |
2685 | * different hardware with the same vendor/product codes. | |
2686 | * host side MUST rely on the endpoint descriptors. | |
2687 | */ | |
2688 | static struct usbtest_info gz_info = { | |
2689 | .name = "Linux gadget zero", | |
2690 | .autoconf = 1, | |
2691 | .ctrl_out = 1, | |
4b85c624 | 2692 | .iso = 1, |
457a0955 | 2693 | .intr = 1, |
1da177e4 LT |
2694 | .alt = 0, |
2695 | }; | |
2696 | ||
2697 | static struct usbtest_info um_info = { | |
2698 | .name = "Linux user mode test driver", | |
2699 | .autoconf = 1, | |
2700 | .alt = -1, | |
2701 | }; | |
2702 | ||
2703 | static struct usbtest_info um2_info = { | |
2704 | .name = "Linux user mode ISO test driver", | |
2705 | .autoconf = 1, | |
2706 | .iso = 1, | |
2707 | .alt = -1, | |
2708 | }; | |
2709 | ||
2710 | #ifdef IBOT2 | |
2711 | /* this is a nice source of high speed bulk data; | |
2712 | * uses an FX2, with firmware provided in the device | |
2713 | */ | |
2714 | static struct usbtest_info ibot2_info = { | |
2715 | .name = "iBOT2 webcam", | |
2716 | .ep_in = 2, | |
2717 | .alt = -1, | |
2718 | }; | |
2719 | #endif | |
2720 | ||
2721 | #ifdef GENERIC | |
2722 | /* we can use any device to test control traffic */ | |
2723 | static struct usbtest_info generic_info = { | |
2724 | .name = "Generic USB device", | |
2725 | .alt = -1, | |
2726 | }; | |
2727 | #endif | |
2728 | ||
1da177e4 | 2729 | |
33b9e162 | 2730 | static const struct usb_device_id id_table[] = { |
1da177e4 | 2731 | |
1da177e4 LT |
2732 | /*-------------------------------------------------------------*/ |
2733 | ||
2734 | /* EZ-USB devices which download firmware to replace (or in our | |
2735 | * case augment) the default device implementation. | |
2736 | */ | |
2737 | ||
2738 | /* generic EZ-USB FX controller */ | |
fabbf219 | 2739 | { USB_DEVICE(0x0547, 0x2235), |
1da177e4 | 2740 | .driver_info = (unsigned long) &ez1_info, |
fabbf219 | 2741 | }, |
1da177e4 LT |
2742 | |
2743 | /* CY3671 development board with EZ-USB FX */ | |
fabbf219 | 2744 | { USB_DEVICE(0x0547, 0x0080), |
1da177e4 | 2745 | .driver_info = (unsigned long) &ez1_info, |
fabbf219 | 2746 | }, |
1da177e4 LT |
2747 | |
2748 | /* generic EZ-USB FX2 controller (or development board) */ | |
fabbf219 | 2749 | { USB_DEVICE(0x04b4, 0x8613), |
1da177e4 | 2750 | .driver_info = (unsigned long) &ez2_info, |
fabbf219 | 2751 | }, |
1da177e4 LT |
2752 | |
2753 | /* re-enumerated usb test device firmware */ | |
fabbf219 | 2754 | { USB_DEVICE(0xfff0, 0xfff0), |
1da177e4 | 2755 | .driver_info = (unsigned long) &fw_info, |
fabbf219 | 2756 | }, |
1da177e4 LT |
2757 | |
2758 | /* "Gadget Zero" firmware runs under Linux */ | |
fabbf219 | 2759 | { USB_DEVICE(0x0525, 0xa4a0), |
1da177e4 | 2760 | .driver_info = (unsigned long) &gz_info, |
fabbf219 | 2761 | }, |
1da177e4 LT |
2762 | |
2763 | /* so does a user-mode variant */ | |
fabbf219 | 2764 | { USB_DEVICE(0x0525, 0xa4a4), |
1da177e4 | 2765 | .driver_info = (unsigned long) &um_info, |
fabbf219 | 2766 | }, |
1da177e4 LT |
2767 | |
2768 | /* ... and a user-mode variant that talks iso */ | |
fabbf219 | 2769 | { USB_DEVICE(0x0525, 0xa4a3), |
1da177e4 | 2770 | .driver_info = (unsigned long) &um2_info, |
fabbf219 | 2771 | }, |
1da177e4 LT |
2772 | |
2773 | #ifdef KEYSPAN_19Qi | |
2774 | /* Keyspan 19qi uses an21xx (original EZ-USB) */ | |
fabbf219 MF |
2775 | /* this does not coexist with the real Keyspan 19qi driver! */ |
2776 | { USB_DEVICE(0x06cd, 0x010b), | |
1da177e4 | 2777 | .driver_info = (unsigned long) &ez1_info, |
fabbf219 | 2778 | }, |
1da177e4 LT |
2779 | #endif |
2780 | ||
2781 | /*-------------------------------------------------------------*/ | |
2782 | ||
2783 | #ifdef IBOT2 | |
2784 | /* iBOT2 makes a nice source of high speed bulk-in data */ | |
fabbf219 MF |
2785 | /* this does not coexist with a real iBOT2 driver! */ |
2786 | { USB_DEVICE(0x0b62, 0x0059), | |
1da177e4 | 2787 | .driver_info = (unsigned long) &ibot2_info, |
fabbf219 | 2788 | }, |
1da177e4 LT |
2789 | #endif |
2790 | ||
2791 | /*-------------------------------------------------------------*/ | |
2792 | ||
2793 | #ifdef GENERIC | |
2794 | /* module params can specify devices to use for control tests */ | |
2795 | { .driver_info = (unsigned long) &generic_info, }, | |
2796 | #endif | |
2797 | ||
2798 | /*-------------------------------------------------------------*/ | |
2799 | ||
2800 | { } | |
2801 | }; | |
fabbf219 | 2802 | MODULE_DEVICE_TABLE(usb, id_table); |
1da177e4 LT |
2803 | |
2804 | static struct usb_driver usbtest_driver = { | |
1da177e4 LT |
2805 | .name = "usbtest", |
2806 | .id_table = id_table, | |
2807 | .probe = usbtest_probe, | |
c532b29a | 2808 | .unlocked_ioctl = usbtest_ioctl, |
1da177e4 | 2809 | .disconnect = usbtest_disconnect, |
ff7c79e4 DB |
2810 | .suspend = usbtest_suspend, |
2811 | .resume = usbtest_resume, | |
1da177e4 LT |
2812 | }; |
2813 | ||
2814 | /*-------------------------------------------------------------------------*/ | |
2815 | ||
fabbf219 | 2816 | static int __init usbtest_init(void) |
1da177e4 LT |
2817 | { |
2818 | #ifdef GENERIC | |
2819 | if (vendor) | |
28ffd79c | 2820 | pr_debug("params: vend=0x%04x prod=0x%04x\n", vendor, product); |
1da177e4 | 2821 | #endif |
fabbf219 | 2822 | return usb_register(&usbtest_driver); |
1da177e4 | 2823 | } |
fabbf219 | 2824 | module_init(usbtest_init); |
1da177e4 | 2825 | |
fabbf219 | 2826 | static void __exit usbtest_exit(void) |
1da177e4 | 2827 | { |
fabbf219 | 2828 | usb_deregister(&usbtest_driver); |
1da177e4 | 2829 | } |
fabbf219 | 2830 | module_exit(usbtest_exit); |
1da177e4 | 2831 | |
fabbf219 MF |
2832 | MODULE_DESCRIPTION("USB Core/HCD Testing Driver"); |
2833 | MODULE_LICENSE("GPL"); | |
1da177e4 | 2834 |