usbtest.c 64.7 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/mm.h>
#include <linux/module.h>
#include <linux/moduleparam.h>
8
#include <linux/scatterlist.h>
9
#include <linux/mutex.h>
L
Linus Torvalds 已提交
10 11 12 13 14 15

#include <linux/usb.h>


/*-------------------------------------------------------------------------*/

M
Martin Fuzzey 已提交
16
/* FIXME make these public somewhere; usbdevfs.h? */
L
Linus Torvalds 已提交
17
struct usbtest_param {
M
Martin Fuzzey 已提交
18
	/* inputs */
L
Linus Torvalds 已提交
19 20 21 22 23 24
	unsigned		test_num;	/* 0..(TEST_CASES-1) */
	unsigned		iterations;
	unsigned		length;
	unsigned		vary;
	unsigned		sglen;

M
Martin Fuzzey 已提交
25
	/* outputs */
L
Linus Torvalds 已提交
26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46
	struct timeval		duration;
};
#define USBTEST_REQUEST	_IOWR('U', 100, struct usbtest_param)

/*-------------------------------------------------------------------------*/

#define	GENERIC		/* let probe() bind using module params */

/* Some devices that can be used for testing will have "real" drivers.
 * Entries for those need to be enabled here by hand, after disabling
 * that "real" driver.
 */
//#define	IBOT2		/* grab iBOT2 webcams */
//#define	KEYSPAN_19Qi	/* grab un-renumerated serial adapter */

/*-------------------------------------------------------------------------*/

struct usbtest_info {
	const char		*name;
	u8			ep_in;		/* bulk/intr source */
	u8			ep_out;		/* bulk/intr sink */
M
Martin Fuzzey 已提交
47 48 49
	unsigned		autoconf:1;
	unsigned		ctrl_out:1;
	unsigned		iso:1;		/* try iso in/out */
L
Linus Torvalds 已提交
50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66
	int			alt;
};

/* this is accessed only through usbfs ioctl calls.
 * one ioctl to issue a test ... one lock per device.
 * tests create other threads if they need them.
 * urbs and buffers are allocated dynamically,
 * and data generated deterministically.
 */
struct usbtest_dev {
	struct usb_interface	*intf;
	struct usbtest_info	*info;
	int			in_pipe;
	int			out_pipe;
	int			in_iso_pipe;
	int			out_iso_pipe;
	struct usb_endpoint_descriptor	*iso_in, *iso_out;
67
	struct mutex		lock;
L
Linus Torvalds 已提交
68 69 70 71 72

#define TBUF_SIZE	256
	u8			*buf;
};

M
Martin Fuzzey 已提交
73
static struct usb_device *testdev_to_usbdev(struct usbtest_dev *test)
L
Linus Torvalds 已提交
74
{
M
Martin Fuzzey 已提交
75
	return interface_to_usbdev(test->intf);
L
Linus Torvalds 已提交
76 77 78 79 80
}

/* set up all urbs so they can be used with either bulk or interrupt */
#define	INTERRUPT_RATE		1	/* msec/transfer */

81 82
#define ERROR(tdev, fmt, args...) \
	dev_err(&(tdev)->intf->dev , fmt , ## args)
83
#define WARNING(tdev, fmt, args...) \
84
	dev_warn(&(tdev)->intf->dev , fmt , ## args)
L
Linus Torvalds 已提交
85

86 87
#define GUARD_BYTE	0xA5

L
Linus Torvalds 已提交
88 89 90
/*-------------------------------------------------------------------------*/

static int
M
Martin Fuzzey 已提交
91
get_endpoints(struct usbtest_dev *dev, struct usb_interface *intf)
L
Linus Torvalds 已提交
92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118
{
	int				tmp;
	struct usb_host_interface	*alt;
	struct usb_host_endpoint	*in, *out;
	struct usb_host_endpoint	*iso_in, *iso_out;
	struct usb_device		*udev;

	for (tmp = 0; tmp < intf->num_altsetting; tmp++) {
		unsigned	ep;

		in = out = NULL;
		iso_in = iso_out = NULL;
		alt = intf->altsetting + tmp;

		/* take the first altsetting with in-bulk + out-bulk;
		 * ignore other endpoints and altsetttings.
		 */
		for (ep = 0; ep < alt->desc.bNumEndpoints; ep++) {
			struct usb_host_endpoint	*e;

			e = alt->endpoint + ep;
			switch (e->desc.bmAttributes) {
			case USB_ENDPOINT_XFER_BULK:
				break;
			case USB_ENDPOINT_XFER_ISOC:
				if (dev->info->iso)
					goto try_iso;
M
Martin Fuzzey 已提交
119
				/* FALLTHROUGH */
L
Linus Torvalds 已提交
120 121 122
			default:
				continue;
			}
123
			if (usb_endpoint_dir_in(&e->desc)) {
L
Linus Torvalds 已提交
124 125 126 127 128 129 130 131
				if (!in)
					in = e;
			} else {
				if (!out)
					out = e;
			}
			continue;
try_iso:
132
			if (usb_endpoint_dir_in(&e->desc)) {
L
Linus Torvalds 已提交
133 134 135 136 137 138 139
				if (!iso_in)
					iso_in = e;
			} else {
				if (!iso_out)
					iso_out = e;
			}
		}
140
		if ((in && out)  ||  iso_in || iso_out)
L
Linus Torvalds 已提交
141 142 143 144 145
			goto found;
	}
	return -EINVAL;

found:
M
Martin Fuzzey 已提交
146
	udev = testdev_to_usbdev(dev);
L
Linus Torvalds 已提交
147
	if (alt->desc.bAlternateSetting != 0) {
M
Martin Fuzzey 已提交
148
		tmp = usb_set_interface(udev,
L
Linus Torvalds 已提交
149 150 151 152 153 154 155
				alt->desc.bInterfaceNumber,
				alt->desc.bAlternateSetting);
		if (tmp < 0)
			return tmp;
	}

	if (in) {
M
Martin Fuzzey 已提交
156
		dev->in_pipe = usb_rcvbulkpipe(udev,
L
Linus Torvalds 已提交
157
			in->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK);
M
Martin Fuzzey 已提交
158
		dev->out_pipe = usb_sndbulkpipe(udev,
L
Linus Torvalds 已提交
159 160 161 162
			out->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK);
	}
	if (iso_in) {
		dev->iso_in = &iso_in->desc;
M
Martin Fuzzey 已提交
163
		dev->in_iso_pipe = usb_rcvisocpipe(udev,
L
Linus Torvalds 已提交
164 165
				iso_in->desc.bEndpointAddress
					& USB_ENDPOINT_NUMBER_MASK);
166 167 168
	}

	if (iso_out) {
L
Linus Torvalds 已提交
169
		dev->iso_out = &iso_out->desc;
M
Martin Fuzzey 已提交
170
		dev->out_iso_pipe = usb_sndisocpipe(udev,
L
Linus Torvalds 已提交
171 172 173 174 175 176 177 178 179 180 181 182 183 184 185
				iso_out->desc.bEndpointAddress
					& USB_ENDPOINT_NUMBER_MASK);
	}
	return 0;
}

/*-------------------------------------------------------------------------*/

/* Support for testing basic non-queued I/O streams.
 *
 * These just package urbs as requests that can be easily canceled.
 * Each urb's data buffer is dynamically allocated; callers can fill
 * them with non-zero test data (or test for it) when appropriate.
 */

M
Martin Fuzzey 已提交
186
static void simple_callback(struct urb *urb)
L
Linus Torvalds 已提交
187
{
188
	complete(urb->context);
L
Linus Torvalds 已提交
189 190
}

191
static struct urb *usbtest_alloc_urb(
L
Linus Torvalds 已提交
192 193
	struct usb_device	*udev,
	int			pipe,
194 195 196
	unsigned long		bytes,
	unsigned		transfer_flags,
	unsigned		offset)
L
Linus Torvalds 已提交
197 198 199
{
	struct urb		*urb;

M
Martin Fuzzey 已提交
200
	urb = usb_alloc_urb(0, GFP_KERNEL);
L
Linus Torvalds 已提交
201 202
	if (!urb)
		return urb;
M
Martin Fuzzey 已提交
203
	usb_fill_bulk_urb(urb, udev, pipe, NULL, bytes, simple_callback, NULL);
L
Linus Torvalds 已提交
204 205 206
	urb->interval = (udev->speed == USB_SPEED_HIGH)
			? (INTERRUPT_RATE << 3)
			: INTERRUPT_RATE;
207
	urb->transfer_flags = transfer_flags;
M
Martin Fuzzey 已提交
208
	if (usb_pipein(pipe))
L
Linus Torvalds 已提交
209
		urb->transfer_flags |= URB_SHORT_NOT_OK;
210 211 212 213 214 215 216

	if (urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP)
		urb->transfer_buffer = usb_alloc_coherent(udev, bytes + offset,
			GFP_KERNEL, &urb->transfer_dma);
	else
		urb->transfer_buffer = kmalloc(bytes + offset, GFP_KERNEL);

L
Linus Torvalds 已提交
217
	if (!urb->transfer_buffer) {
M
Martin Fuzzey 已提交
218
		usb_free_urb(urb);
219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235
		return NULL;
	}

	/* To test unaligned transfers add an offset and fill the
		unused memory with a guard value */
	if (offset) {
		memset(urb->transfer_buffer, GUARD_BYTE, offset);
		urb->transfer_buffer += offset;
		if (urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP)
			urb->transfer_dma += offset;
	}

	/* For inbound transfers use guard byte so that test fails if
		data not correctly copied */
	memset(urb->transfer_buffer,
			usb_pipein(urb->pipe) ? GUARD_BYTE : 0,
			bytes);
L
Linus Torvalds 已提交
236 237 238
	return urb;
}

239 240 241 242 243 244 245 246
static struct urb *simple_alloc_urb(
	struct usb_device	*udev,
	int			pipe,
	unsigned long		bytes)
{
	return usbtest_alloc_urb(udev, pipe, bytes, URB_NO_TRANSFER_DMA_MAP, 0);
}

M
Martin Fuzzey 已提交
247
static unsigned pattern;
248 249 250
static unsigned mod_pattern;
module_param_named(pattern, mod_pattern, uint, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(mod_pattern, "i/o pattern (0 == zeroes)");
L
Linus Torvalds 已提交
251

M
Martin Fuzzey 已提交
252
static inline void simple_fill_buf(struct urb *urb)
L
Linus Torvalds 已提交
253 254 255 256 257 258 259
{
	unsigned	i;
	u8		*buf = urb->transfer_buffer;
	unsigned	len = urb->transfer_buffer_length;

	switch (pattern) {
	default:
M
Martin Fuzzey 已提交
260
		/* FALLTHROUGH */
L
Linus Torvalds 已提交
261
	case 0:
M
Martin Fuzzey 已提交
262
		memset(buf, 0, len);
L
Linus Torvalds 已提交
263 264 265 266 267 268 269 270
		break;
	case 1:			/* mod63 */
		for (i = 0; i < len; i++)
			*buf++ = (u8) (i % 63);
		break;
	}
}

271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292
static inline unsigned buffer_offset(void *buf)
{
	return (unsigned)buf & (ARCH_KMALLOC_MINALIGN - 1);
}

static int check_guard_bytes(struct usbtest_dev *tdev, struct urb *urb)
{
	u8 *buf = urb->transfer_buffer;
	u8 *guard = buf - buffer_offset(buf);
	unsigned i;

	for (i = 0; guard < buf; i++, guard++) {
		if (*guard != GUARD_BYTE) {
			ERROR(tdev, "guard byte[%d] %d (not %d)\n",
				i, *guard, GUARD_BYTE);
			return -EINVAL;
		}
	}
	return 0;
}

static int simple_check_buf(struct usbtest_dev *tdev, struct urb *urb)
L
Linus Torvalds 已提交
293 294 295 296 297 298
{
	unsigned	i;
	u8		expected;
	u8		*buf = urb->transfer_buffer;
	unsigned	len = urb->actual_length;

299 300 301 302
	int ret = check_guard_bytes(tdev, urb);
	if (ret)
		return ret;

L
Linus Torvalds 已提交
303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323
	for (i = 0; i < len; i++, buf++) {
		switch (pattern) {
		/* all-zeroes has no synchronization issues */
		case 0:
			expected = 0;
			break;
		/* mod63 stays in sync with short-terminated transfers,
		 * or otherwise when host and gadget agree on how large
		 * each usb transfer request should be.  resync is done
		 * with set_interface or set_config.
		 */
		case 1:			/* mod63 */
			expected = i % 63;
			break;
		/* always fail unsupported patterns */
		default:
			expected = !*buf;
			break;
		}
		if (*buf == expected)
			continue;
324
		ERROR(tdev, "buf[%d] = %d (not %d)\n", i, *buf, expected);
L
Linus Torvalds 已提交
325 326 327 328 329
		return -EINVAL;
	}
	return 0;
}

M
Martin Fuzzey 已提交
330
static void simple_free_urb(struct urb *urb)
L
Linus Torvalds 已提交
331
{
332 333 334 335 336 337 338 339 340 341
	unsigned offset = buffer_offset(urb->transfer_buffer);

	if (urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP)
		usb_free_coherent(
			urb->dev,
			urb->transfer_buffer_length + offset,
			urb->transfer_buffer - offset,
			urb->transfer_dma - offset);
	else
		kfree(urb->transfer_buffer - offset);
M
Martin Fuzzey 已提交
342
	usb_free_urb(urb);
L
Linus Torvalds 已提交
343 344
}

M
Martin Fuzzey 已提交
345
static int simple_io(
346
	struct usbtest_dev	*tdev,
L
Linus Torvalds 已提交
347 348 349 350 351 352 353 354 355 356 357 358 359 360
	struct urb		*urb,
	int			iterations,
	int			vary,
	int			expected,
	const char		*label
)
{
	struct usb_device	*udev = urb->dev;
	int			max = urb->transfer_buffer_length;
	struct completion	completion;
	int			retval = 0;

	urb->context = &completion;
	while (retval == 0 && iterations-- > 0) {
M
Martin Fuzzey 已提交
361 362 363 364 365
		init_completion(&completion);
		if (usb_pipeout(urb->pipe))
			simple_fill_buf(urb);
		retval = usb_submit_urb(urb, GFP_KERNEL);
		if (retval != 0)
L
Linus Torvalds 已提交
366 367 368
			break;

		/* NOTE:  no timeouts; can't be broken out of by interrupt */
M
Martin Fuzzey 已提交
369
		wait_for_completion(&completion);
L
Linus Torvalds 已提交
370 371
		retval = urb->status;
		urb->dev = udev;
M
Martin Fuzzey 已提交
372
		if (retval == 0 && usb_pipein(urb->pipe))
373
			retval = simple_check_buf(tdev, urb);
L
Linus Torvalds 已提交
374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389

		if (vary) {
			int	len = urb->transfer_buffer_length;

			len += vary;
			len %= max;
			if (len == 0)
				len = (vary < max) ? vary : max;
			urb->transfer_buffer_length = len;
		}

		/* FIXME if endpoint halted, clear halt (and log) */
	}
	urb->transfer_buffer_length = max;

	if (expected != retval)
390
		dev_err(&udev->dev,
L
Linus Torvalds 已提交
391 392 393 394 395 396 397 398 399 400 401 402
			"%s failed, iterations left %d, status %d (not %d)\n",
				label, iterations, retval, expected);
	return retval;
}


/*-------------------------------------------------------------------------*/

/* We use scatterlist primitives to test queued I/O.
 * Yes, this also tests the scatterlist primitives.
 */

M
Martin Fuzzey 已提交
403
static void free_sglist(struct scatterlist *sg, int nents)
L
Linus Torvalds 已提交
404 405
{
	unsigned		i;
406

L
Linus Torvalds 已提交
407 408 409
	if (!sg)
		return;
	for (i = 0; i < nents; i++) {
J
Jens Axboe 已提交
410
		if (!sg_page(&sg[i]))
L
Linus Torvalds 已提交
411
			continue;
M
Martin Fuzzey 已提交
412
		kfree(sg_virt(&sg[i]));
L
Linus Torvalds 已提交
413
	}
M
Martin Fuzzey 已提交
414
	kfree(sg);
L
Linus Torvalds 已提交
415 416 417
}

static struct scatterlist *
M
Martin Fuzzey 已提交
418
alloc_sglist(int nents, int max, int vary)
L
Linus Torvalds 已提交
419 420 421 422 423
{
	struct scatterlist	*sg;
	unsigned		i;
	unsigned		size = max;

M
Martin Fuzzey 已提交
424
	sg = kmalloc(nents * sizeof *sg, GFP_KERNEL);
L
Linus Torvalds 已提交
425 426
	if (!sg)
		return NULL;
427
	sg_init_table(sg, nents);
L
Linus Torvalds 已提交
428 429 430

	for (i = 0; i < nents; i++) {
		char		*buf;
431
		unsigned	j;
L
Linus Torvalds 已提交
432

M
Martin Fuzzey 已提交
433
		buf = kzalloc(size, GFP_KERNEL);
L
Linus Torvalds 已提交
434
		if (!buf) {
M
Martin Fuzzey 已提交
435
			free_sglist(sg, i);
L
Linus Torvalds 已提交
436 437 438 439
			return NULL;
		}

		/* kmalloc pages are always physically contiguous! */
440
		sg_set_buf(&sg[i], buf, size);
L
Linus Torvalds 已提交
441

442 443 444 445 446 447 448 449 450 451
		switch (pattern) {
		case 0:
			/* already zeroed */
			break;
		case 1:
			for (j = 0; j < size; j++)
				*buf++ = (u8) (j % 63);
			break;
		}

L
Linus Torvalds 已提交
452 453 454 455 456 457 458 459 460 461 462
		if (vary) {
			size += vary;
			size %= max;
			if (size == 0)
				size = (vary < max) ? vary : max;
		}
	}

	return sg;
}

M
Martin Fuzzey 已提交
463
static int perform_sglist(
464
	struct usbtest_dev	*tdev,
L
Linus Torvalds 已提交
465 466 467 468 469 470 471
	unsigned		iterations,
	int			pipe,
	struct usb_sg_request	*req,
	struct scatterlist	*sg,
	int			nents
)
{
472
	struct usb_device	*udev = testdev_to_usbdev(tdev);
L
Linus Torvalds 已提交
473 474 475
	int			retval = 0;

	while (retval == 0 && iterations-- > 0) {
M
Martin Fuzzey 已提交
476
		retval = usb_sg_init(req, udev, pipe,
L
Linus Torvalds 已提交
477 478 479
				(udev->speed == USB_SPEED_HIGH)
					? (INTERRUPT_RATE << 3)
					: INTERRUPT_RATE,
480
				sg, nents, 0, GFP_KERNEL);
481

L
Linus Torvalds 已提交
482 483
		if (retval)
			break;
M
Martin Fuzzey 已提交
484
		usb_sg_wait(req);
L
Linus Torvalds 已提交
485 486
		retval = req->status;

487 488
		/* FIXME check resulting data pattern */

L
Linus Torvalds 已提交
489 490 491
		/* FIXME if endpoint halted, clear halt (and log) */
	}

M
Martin Fuzzey 已提交
492 493 494
	/* FIXME for unlink or fault handling tests, don't report
	 * failure if retval is as we expected ...
	 */
L
Linus Torvalds 已提交
495
	if (retval)
496 497
		ERROR(tdev, "perform_sglist failed, "
				"iterations left %d, status %d\n",
L
Linus Torvalds 已提交
498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517
				iterations, retval);
	return retval;
}


/*-------------------------------------------------------------------------*/

/* unqueued control message testing
 *
 * there's a nice set of device functional requirements in chapter 9 of the
 * usb 2.0 spec, which we can apply to ANY device, even ones that don't use
 * special test firmware.
 *
 * we know the device is configured (or suspended) by the time it's visible
 * through usbfs.  we can't change that, so we won't test enumeration (which
 * worked 'well enough' to get here, this time), power management (ditto),
 * or remote wakeup (which needs human interaction).
 */

static unsigned realworld = 1;
M
Martin Fuzzey 已提交
518 519
module_param(realworld, uint, 0);
MODULE_PARM_DESC(realworld, "clear to demand stricter spec compliance");
L
Linus Torvalds 已提交
520

M
Martin Fuzzey 已提交
521
static int get_altsetting(struct usbtest_dev *dev)
L
Linus Torvalds 已提交
522 523
{
	struct usb_interface	*iface = dev->intf;
M
Martin Fuzzey 已提交
524
	struct usb_device	*udev = interface_to_usbdev(iface);
L
Linus Torvalds 已提交
525 526
	int			retval;

M
Martin Fuzzey 已提交
527
	retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
L
Linus Torvalds 已提交
528
			USB_REQ_GET_INTERFACE, USB_DIR_IN|USB_RECIP_INTERFACE,
M
Martin Fuzzey 已提交
529
			0, iface->altsetting[0].desc.bInterfaceNumber,
L
Linus Torvalds 已提交
530 531 532
			dev->buf, 1, USB_CTRL_GET_TIMEOUT);
	switch (retval) {
	case 1:
M
Martin Fuzzey 已提交
533
		return dev->buf[0];
L
Linus Torvalds 已提交
534 535
	case 0:
		retval = -ERANGE;
M
Martin Fuzzey 已提交
536
		/* FALLTHROUGH */
L
Linus Torvalds 已提交
537 538 539 540 541
	default:
		return retval;
	}
}

M
Martin Fuzzey 已提交
542
static int set_altsetting(struct usbtest_dev *dev, int alternate)
L
Linus Torvalds 已提交
543 544 545 546 547 548 549
{
	struct usb_interface		*iface = dev->intf;
	struct usb_device		*udev;

	if (alternate < 0 || alternate >= 256)
		return -EINVAL;

M
Martin Fuzzey 已提交
550 551 552
	udev = interface_to_usbdev(iface);
	return usb_set_interface(udev,
			iface->altsetting[0].desc.bInterfaceNumber,
L
Linus Torvalds 已提交
553 554 555
			alternate);
}

556
static int is_good_config(struct usbtest_dev *tdev, int len)
L
Linus Torvalds 已提交
557 558
{
	struct usb_config_descriptor	*config;
559

L
Linus Torvalds 已提交
560 561
	if (len < sizeof *config)
		return 0;
562
	config = (struct usb_config_descriptor *) tdev->buf;
L
Linus Torvalds 已提交
563 564 565 566 567

	switch (config->bDescriptorType) {
	case USB_DT_CONFIG:
	case USB_DT_OTHER_SPEED_CONFIG:
		if (config->bLength != 9) {
568
			ERROR(tdev, "bogus config descriptor length\n");
L
Linus Torvalds 已提交
569 570 571 572
			return 0;
		}
		/* this bit 'must be 1' but often isn't */
		if (!realworld && !(config->bmAttributes & 0x80)) {
573
			ERROR(tdev, "high bit of config attributes not set\n");
L
Linus Torvalds 已提交
574 575 576
			return 0;
		}
		if (config->bmAttributes & 0x1f) {	/* reserved == 0 */
577
			ERROR(tdev, "reserved config bits set\n");
L
Linus Torvalds 已提交
578 579 580 581 582 583 584
			return 0;
		}
		break;
	default:
		return 0;
	}

M
Martin Fuzzey 已提交
585
	if (le16_to_cpu(config->wTotalLength) == len)	/* read it all */
L
Linus Torvalds 已提交
586
		return 1;
M
Martin Fuzzey 已提交
587
	if (le16_to_cpu(config->wTotalLength) >= TBUF_SIZE)	/* max partial read */
L
Linus Torvalds 已提交
588
		return 1;
589
	ERROR(tdev, "bogus config descriptor read size\n");
L
Linus Torvalds 已提交
590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607
	return 0;
}

/* sanity test for standard requests working with usb_control_mesg() and some
 * of the utility functions which use it.
 *
 * this doesn't test how endpoint halts behave or data toggles get set, since
 * we won't do I/O to bulk/interrupt endpoints here (which is how to change
 * halt or toggle).  toggle testing is impractical without support from hcds.
 *
 * this avoids failing devices linux would normally work with, by not testing
 * config/altsetting operations for devices that only support their defaults.
 * such devices rarely support those needless operations.
 *
 * NOTE that since this is a sanity test, it's not examining boundary cases
 * to see if usbcore, hcd, and device all behave right.  such testing would
 * involve varied read sizes and other operation sequences.
 */
M
Martin Fuzzey 已提交
608
static int ch9_postconfig(struct usbtest_dev *dev)
L
Linus Torvalds 已提交
609 610
{
	struct usb_interface	*iface = dev->intf;
M
Martin Fuzzey 已提交
611
	struct usb_device	*udev = interface_to_usbdev(iface);
L
Linus Torvalds 已提交
612 613 614 615 616 617 618 619
	int			i, alt, retval;

	/* [9.2.3] if there's more than one altsetting, we need to be able to
	 * set and get each one.  mostly trusts the descriptors from usbcore.
	 */
	for (i = 0; i < iface->num_altsetting; i++) {

		/* 9.2.3 constrains the range here */
M
Martin Fuzzey 已提交
620
		alt = iface->altsetting[i].desc.bAlternateSetting;
L
Linus Torvalds 已提交
621
		if (alt < 0 || alt >= iface->num_altsetting) {
622
			dev_err(&iface->dev,
L
Linus Torvalds 已提交
623 624 625 626 627 628 629 630 631
					"invalid alt [%d].bAltSetting = %d\n",
					i, alt);
		}

		/* [real world] get/set unimplemented if there's only one */
		if (realworld && iface->num_altsetting == 1)
			continue;

		/* [9.4.10] set_interface */
M
Martin Fuzzey 已提交
632
		retval = set_altsetting(dev, alt);
L
Linus Torvalds 已提交
633
		if (retval) {
634
			dev_err(&iface->dev, "can't set_interface = %d, %d\n",
L
Linus Torvalds 已提交
635 636 637 638 639
					alt, retval);
			return retval;
		}

		/* [9.4.4] get_interface always works */
M
Martin Fuzzey 已提交
640
		retval = get_altsetting(dev);
L
Linus Torvalds 已提交
641
		if (retval != alt) {
642
			dev_err(&iface->dev, "get alt should be %d, was %d\n",
L
Linus Torvalds 已提交
643 644 645 646 647 648 649 650 651 652 653 654 655 656
					alt, retval);
			return (retval < 0) ? retval : -EDOM;
		}

	}

	/* [real world] get_config unimplemented if there's only one */
	if (!realworld || udev->descriptor.bNumConfigurations != 1) {
		int	expected = udev->actconfig->desc.bConfigurationValue;

		/* [9.4.2] get_configuration always works
		 * ... although some cheap devices (like one TI Hub I've got)
		 * won't return config descriptors except before set_config.
		 */
M
Martin Fuzzey 已提交
657
		retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
L
Linus Torvalds 已提交
658 659 660
				USB_REQ_GET_CONFIGURATION,
				USB_DIR_IN | USB_RECIP_DEVICE,
				0, 0, dev->buf, 1, USB_CTRL_GET_TIMEOUT);
M
Martin Fuzzey 已提交
661
		if (retval != 1 || dev->buf[0] != expected) {
662
			dev_err(&iface->dev, "get config --> %d %d (1 %d)\n",
D
David Brownell 已提交
663
				retval, dev->buf[0], expected);
L
Linus Torvalds 已提交
664 665 666 667 668
			return (retval < 0) ? retval : -EDOM;
		}
	}

	/* there's always [9.4.3] a device descriptor [9.6.1] */
M
Martin Fuzzey 已提交
669
	retval = usb_get_descriptor(udev, USB_DT_DEVICE, 0,
L
Linus Torvalds 已提交
670 671
			dev->buf, sizeof udev->descriptor);
	if (retval != sizeof udev->descriptor) {
672
		dev_err(&iface->dev, "dev descriptor --> %d\n", retval);
L
Linus Torvalds 已提交
673 674 675 676 677
		return (retval < 0) ? retval : -EDOM;
	}

	/* there's always [9.4.3] at least one config descriptor [9.6.3] */
	for (i = 0; i < udev->descriptor.bNumConfigurations; i++) {
M
Martin Fuzzey 已提交
678
		retval = usb_get_descriptor(udev, USB_DT_CONFIG, i,
L
Linus Torvalds 已提交
679
				dev->buf, TBUF_SIZE);
680 681
		if (!is_good_config(dev, retval)) {
			dev_err(&iface->dev,
L
Linus Torvalds 已提交
682 683 684 685 686
					"config [%d] descriptor --> %d\n",
					i, retval);
			return (retval < 0) ? retval : -EDOM;
		}

M
Martin Fuzzey 已提交
687 688 689
		/* FIXME cross-checking udev->config[i] to make sure usbcore
		 * parsed it right (etc) would be good testing paranoia
		 */
L
Linus Torvalds 已提交
690 691 692 693
	}

	/* and sometimes [9.2.6.6] speed dependent descriptors */
	if (le16_to_cpu(udev->descriptor.bcdUSB) == 0x0200) {
M
Martin Fuzzey 已提交
694
		struct usb_qualifier_descriptor *d = NULL;
L
Linus Torvalds 已提交
695 696

		/* device qualifier [9.6.2] */
M
Martin Fuzzey 已提交
697
		retval = usb_get_descriptor(udev,
L
Linus Torvalds 已提交
698
				USB_DT_DEVICE_QUALIFIER, 0, dev->buf,
M
Martin Fuzzey 已提交
699
				sizeof(struct usb_qualifier_descriptor));
L
Linus Torvalds 已提交
700 701
		if (retval == -EPIPE) {
			if (udev->speed == USB_SPEED_HIGH) {
702
				dev_err(&iface->dev,
L
Linus Torvalds 已提交
703 704 705 706 707
						"hs dev qualifier --> %d\n",
						retval);
				return (retval < 0) ? retval : -EDOM;
			}
			/* usb2.0 but not high-speed capable; fine */
M
Martin Fuzzey 已提交
708
		} else if (retval != sizeof(struct usb_qualifier_descriptor)) {
709
			dev_err(&iface->dev, "dev qualifier --> %d\n", retval);
L
Linus Torvalds 已提交
710 711 712 713 714 715 716 717
			return (retval < 0) ? retval : -EDOM;
		} else
			d = (struct usb_qualifier_descriptor *) dev->buf;

		/* might not have [9.6.2] any other-speed configs [9.6.4] */
		if (d) {
			unsigned max = d->bNumConfigurations;
			for (i = 0; i < max; i++) {
M
Martin Fuzzey 已提交
718
				retval = usb_get_descriptor(udev,
L
Linus Torvalds 已提交
719 720
					USB_DT_OTHER_SPEED_CONFIG, i,
					dev->buf, TBUF_SIZE);
721 722
				if (!is_good_config(dev, retval)) {
					dev_err(&iface->dev,
L
Linus Torvalds 已提交
723 724 725 726 727 728 729
						"other speed config --> %d\n",
						retval);
					return (retval < 0) ? retval : -EDOM;
				}
			}
		}
	}
M
Martin Fuzzey 已提交
730
	/* FIXME fetch strings from at least the device descriptor */
L
Linus Torvalds 已提交
731 732

	/* [9.4.5] get_status always works */
M
Martin Fuzzey 已提交
733
	retval = usb_get_status(udev, USB_RECIP_DEVICE, 0, dev->buf);
L
Linus Torvalds 已提交
734
	if (retval != 2) {
735
		dev_err(&iface->dev, "get dev status --> %d\n", retval);
L
Linus Torvalds 已提交
736 737 738
		return (retval < 0) ? retval : -EDOM;
	}

M
Martin Fuzzey 已提交
739 740 741
	/* FIXME configuration.bmAttributes says if we could try to set/clear
	 * the device's remote wakeup feature ... if we can, test that here
	 */
L
Linus Torvalds 已提交
742

M
Martin Fuzzey 已提交
743 744
	retval = usb_get_status(udev, USB_RECIP_INTERFACE,
			iface->altsetting[0].desc.bInterfaceNumber, dev->buf);
L
Linus Torvalds 已提交
745
	if (retval != 2) {
746
		dev_err(&iface->dev, "get interface status --> %d\n", retval);
L
Linus Torvalds 已提交
747 748
		return (retval < 0) ? retval : -EDOM;
	}
M
Martin Fuzzey 已提交
749
	/* FIXME get status for each endpoint in the interface */
750

L
Linus Torvalds 已提交
751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784
	return 0;
}

/*-------------------------------------------------------------------------*/

/* use ch9 requests to test whether:
 *   (a) queues work for control, keeping N subtests queued and
 *       active (auto-resubmit) for M loops through the queue.
 *   (b) protocol stalls (control-only) will autorecover.
 *       it's not like bulk/intr; no halt clearing.
 *   (c) short control reads are reported and handled.
 *   (d) queues are always processed in-order
 */

struct ctrl_ctx {
	spinlock_t		lock;
	struct usbtest_dev	*dev;
	struct completion	complete;
	unsigned		count;
	unsigned		pending;
	int			status;
	struct urb		**urb;
	struct usbtest_param	*param;
	int			last;
};

#define NUM_SUBCASES	15		/* how many test subcases here? */

struct subcase {
	struct usb_ctrlrequest	setup;
	int			number;
	int			expected;
};

M
Martin Fuzzey 已提交
785
static void ctrl_complete(struct urb *urb)
L
Linus Torvalds 已提交
786 787 788 789 790 791 792
{
	struct ctrl_ctx		*ctx = urb->context;
	struct usb_ctrlrequest	*reqp;
	struct subcase		*subcase;
	int			status = urb->status;

	reqp = (struct usb_ctrlrequest *)urb->setup_packet;
M
Martin Fuzzey 已提交
793
	subcase = container_of(reqp, struct subcase, setup);
L
Linus Torvalds 已提交
794

M
Martin Fuzzey 已提交
795
	spin_lock(&ctx->lock);
L
Linus Torvalds 已提交
796 797 798 799 800 801 802 803 804
	ctx->count--;
	ctx->pending--;

	/* queue must transfer and complete in fifo order, unless
	 * usb_unlink_urb() is used to unlink something not at the
	 * physical queue head (not tested).
	 */
	if (subcase->number > 0) {
		if ((subcase->number - ctx->last) != 1) {
805 806 807
			ERROR(ctx->dev,
				"subcase %d completed out of order, last %d\n",
				subcase->number, ctx->last);
L
Linus Torvalds 已提交
808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823
			status = -EDOM;
			ctx->last = subcase->number;
			goto error;
		}
	}
	ctx->last = subcase->number;

	/* succeed or fault in only one way? */
	if (status == subcase->expected)
		status = 0;

	/* async unlink for cleanup? */
	else if (status != -ECONNRESET) {

		/* some faults are allowed, not required */
		if (subcase->expected > 0 && (
824 825
			  ((status == -subcase->expected	/* happened */
			   || status == 0))))			/* didn't */
L
Linus Torvalds 已提交
826 827 828 829 830
			status = 0;
		/* sometimes more than one fault is allowed */
		else if (subcase->number == 12 && status == -EPIPE)
			status = 0;
		else
831
			ERROR(ctx->dev, "subtest %d error, status %d\n",
L
Linus Torvalds 已提交
832 833 834 835 836 837 838 839 840 841
					subcase->number, status);
	}

	/* unexpected status codes mean errors; ideally, in hardware */
	if (status) {
error:
		if (ctx->status == 0) {
			int		i;

			ctx->status = status;
842 843
			ERROR(ctx->dev, "control queue %02x.%02x, err %d, "
					"%d left, subcase %d, len %d/%d\n",
L
Linus Torvalds 已提交
844
					reqp->bRequestType, reqp->bRequest,
845 846 847
					status, ctx->count, subcase->number,
					urb->actual_length,
					urb->transfer_buffer_length);
L
Linus Torvalds 已提交
848 849 850 851 852 853 854

			/* FIXME this "unlink everything" exit route should
			 * be a separate test case.
			 */

			/* unlink whatever's still pending */
			for (i = 1; i < ctx->param->sglen; i++) {
M
Martin Fuzzey 已提交
855 856 857
				struct urb *u = ctx->urb[
							(i + subcase->number)
							% ctx->param->sglen];
L
Linus Torvalds 已提交
858 859 860

				if (u == urb || !u->dev)
					continue;
861
				spin_unlock(&ctx->lock);
M
Martin Fuzzey 已提交
862
				status = usb_unlink_urb(u);
863
				spin_lock(&ctx->lock);
L
Linus Torvalds 已提交
864 865 866 867 868 869
				switch (status) {
				case -EINPROGRESS:
				case -EBUSY:
				case -EIDRM:
					continue;
				default:
870 871
					ERROR(ctx->dev, "urb unlink --> %d\n",
							status);
L
Linus Torvalds 已提交
872 873 874 875 876 877 878 879
				}
			}
			status = ctx->status;
		}
	}

	/* resubmit if we need to, else mark this as done */
	if ((status == 0) && (ctx->pending < ctx->count)) {
M
Martin Fuzzey 已提交
880 881
		status = usb_submit_urb(urb, GFP_ATOMIC);
		if (status != 0) {
882 883
			ERROR(ctx->dev,
				"can't resubmit ctrl %02x.%02x, err %d\n",
L
Linus Torvalds 已提交
884 885 886 887 888 889
				reqp->bRequestType, reqp->bRequest, status);
			urb->dev = NULL;
		} else
			ctx->pending++;
	} else
		urb->dev = NULL;
890

L
Linus Torvalds 已提交
891 892
	/* signal completion when nothing's queued */
	if (ctx->pending == 0)
M
Martin Fuzzey 已提交
893 894
		complete(&ctx->complete);
	spin_unlock(&ctx->lock);
L
Linus Torvalds 已提交
895 896 897
}

static int
M
Martin Fuzzey 已提交
898
test_ctrl_queue(struct usbtest_dev *dev, struct usbtest_param *param)
L
Linus Torvalds 已提交
899
{
M
Martin Fuzzey 已提交
900
	struct usb_device	*udev = testdev_to_usbdev(dev);
L
Linus Torvalds 已提交
901 902 903 904
	struct urb		**urb;
	struct ctrl_ctx		context;
	int			i;

M
Martin Fuzzey 已提交
905
	spin_lock_init(&context.lock);
L
Linus Torvalds 已提交
906
	context.dev = dev;
M
Martin Fuzzey 已提交
907
	init_completion(&context.complete);
L
Linus Torvalds 已提交
908 909 910 911 912 913 914 915 916 917
	context.count = param->sglen * param->iterations;
	context.pending = 0;
	context.status = -ENOMEM;
	context.param = param;
	context.last = -1;

	/* allocate and init the urbs we'll queue.
	 * as with bulk/intr sglists, sglen is the queue depth; it also
	 * controls which subtests run (more tests than sglen) or rerun.
	 */
918
	urb = kcalloc(param->sglen, sizeof(struct urb *), GFP_KERNEL);
L
Linus Torvalds 已提交
919 920 921
	if (!urb)
		return -ENOMEM;
	for (i = 0; i < param->sglen; i++) {
M
Martin Fuzzey 已提交
922
		int			pipe = usb_rcvctrlpipe(udev, 0);
L
Linus Torvalds 已提交
923 924 925 926
		unsigned		len;
		struct urb		*u;
		struct usb_ctrlrequest	req;
		struct subcase		*reqp;
927 928 929 930 931

		/* sign of this variable means:
		 *  -: tested code must return this (negative) error code
		 *  +: tested code may return this (negative too) error code
		 */
L
Linus Torvalds 已提交
932 933 934 935 936 937
		int			expected = 0;

		/* requests here are mostly expected to succeed on any
		 * device, but some are chosen to trigger protocol stalls
		 * or short reads.
		 */
M
Martin Fuzzey 已提交
938
		memset(&req, 0, sizeof req);
L
Linus Torvalds 已提交
939 940 941 942
		req.bRequest = USB_REQ_GET_DESCRIPTOR;
		req.bRequestType = USB_DIR_IN|USB_RECIP_DEVICE;

		switch (i % NUM_SUBCASES) {
M
Martin Fuzzey 已提交
943 944 945
		case 0:		/* get device descriptor */
			req.wValue = cpu_to_le16(USB_DT_DEVICE << 8);
			len = sizeof(struct usb_device_descriptor);
L
Linus Torvalds 已提交
946
			break;
M
Martin Fuzzey 已提交
947 948 949
		case 1:		/* get first config descriptor (only) */
			req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
			len = sizeof(struct usb_config_descriptor);
L
Linus Torvalds 已提交
950
			break;
M
Martin Fuzzey 已提交
951
		case 2:		/* get altsetting (OFTEN STALLS) */
L
Linus Torvalds 已提交
952 953
			req.bRequest = USB_REQ_GET_INTERFACE;
			req.bRequestType = USB_DIR_IN|USB_RECIP_INTERFACE;
M
Martin Fuzzey 已提交
954
			/* index = 0 means first interface */
L
Linus Torvalds 已提交
955 956 957
			len = 1;
			expected = EPIPE;
			break;
M
Martin Fuzzey 已提交
958
		case 3:		/* get interface status */
L
Linus Torvalds 已提交
959 960
			req.bRequest = USB_REQ_GET_STATUS;
			req.bRequestType = USB_DIR_IN|USB_RECIP_INTERFACE;
M
Martin Fuzzey 已提交
961
			/* interface 0 */
L
Linus Torvalds 已提交
962 963
			len = 2;
			break;
M
Martin Fuzzey 已提交
964
		case 4:		/* get device status */
L
Linus Torvalds 已提交
965 966 967 968
			req.bRequest = USB_REQ_GET_STATUS;
			req.bRequestType = USB_DIR_IN|USB_RECIP_DEVICE;
			len = 2;
			break;
M
Martin Fuzzey 已提交
969
		case 5:		/* get device qualifier (MAY STALL) */
L
Linus Torvalds 已提交
970
			req.wValue = cpu_to_le16 (USB_DT_DEVICE_QUALIFIER << 8);
M
Martin Fuzzey 已提交
971
			len = sizeof(struct usb_qualifier_descriptor);
L
Linus Torvalds 已提交
972 973 974
			if (udev->speed != USB_SPEED_HIGH)
				expected = EPIPE;
			break;
M
Martin Fuzzey 已提交
975 976 977 978
		case 6:		/* get first config descriptor, plus interface */
			req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
			len = sizeof(struct usb_config_descriptor);
			len += sizeof(struct usb_interface_descriptor);
L
Linus Torvalds 已提交
979
			break;
M
Martin Fuzzey 已提交
980
		case 7:		/* get interface descriptor (ALWAYS STALLS) */
L
Linus Torvalds 已提交
981
			req.wValue = cpu_to_le16 (USB_DT_INTERFACE << 8);
M
Martin Fuzzey 已提交
982 983
			/* interface == 0 */
			len = sizeof(struct usb_interface_descriptor);
984
			expected = -EPIPE;
L
Linus Torvalds 已提交
985
			break;
M
Martin Fuzzey 已提交
986 987 988
		/* NOTE: two consecutive stalls in the queue here.
		 *  that tests fault recovery a bit more aggressively. */
		case 8:		/* clear endpoint halt (MAY STALL) */
L
Linus Torvalds 已提交
989 990
			req.bRequest = USB_REQ_CLEAR_FEATURE;
			req.bRequestType = USB_RECIP_ENDPOINT;
M
Martin Fuzzey 已提交
991 992
			/* wValue 0 == ep halt */
			/* wIndex 0 == ep0 (shouldn't halt!) */
L
Linus Torvalds 已提交
993
			len = 0;
M
Martin Fuzzey 已提交
994
			pipe = usb_sndctrlpipe(udev, 0);
L
Linus Torvalds 已提交
995 996
			expected = EPIPE;
			break;
M
Martin Fuzzey 已提交
997
		case 9:		/* get endpoint status */
L
Linus Torvalds 已提交
998 999
			req.bRequest = USB_REQ_GET_STATUS;
			req.bRequestType = USB_DIR_IN|USB_RECIP_ENDPOINT;
M
Martin Fuzzey 已提交
1000
			/* endpoint 0 */
L
Linus Torvalds 已提交
1001 1002
			len = 2;
			break;
M
Martin Fuzzey 已提交
1003 1004
		case 10:	/* trigger short read (EREMOTEIO) */
			req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
L
Linus Torvalds 已提交
1005 1006 1007
			len = 1024;
			expected = -EREMOTEIO;
			break;
M
Martin Fuzzey 已提交
1008 1009 1010 1011 1012
		/* NOTE: two consecutive _different_ faults in the queue. */
		case 11:	/* get endpoint descriptor (ALWAYS STALLS) */
			req.wValue = cpu_to_le16(USB_DT_ENDPOINT << 8);
			/* endpoint == 0 */
			len = sizeof(struct usb_interface_descriptor);
L
Linus Torvalds 已提交
1013 1014
			expected = EPIPE;
			break;
M
Martin Fuzzey 已提交
1015 1016 1017 1018 1019 1020 1021
		/* NOTE: sometimes even a third fault in the queue! */
		case 12:	/* get string 0 descriptor (MAY STALL) */
			req.wValue = cpu_to_le16(USB_DT_STRING << 8);
			/* string == 0, for language IDs */
			len = sizeof(struct usb_interface_descriptor);
			/* may succeed when > 4 languages */
			expected = EREMOTEIO;	/* or EPIPE, if no strings */
L
Linus Torvalds 已提交
1022
			break;
M
Martin Fuzzey 已提交
1023 1024 1025
		case 13:	/* short read, resembling case 10 */
			req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
			/* last data packet "should" be DATA1, not DATA0 */
L
Linus Torvalds 已提交
1026 1027 1028
			len = 1024 - udev->descriptor.bMaxPacketSize0;
			expected = -EREMOTEIO;
			break;
M
Martin Fuzzey 已提交
1029 1030
		case 14:	/* short read; try to fill the last packet */
			req.wValue = cpu_to_le16((USB_DT_DEVICE << 8) | 0);
1031
			/* device descriptor size == 18 bytes */
L
Linus Torvalds 已提交
1032 1033
			len = udev->descriptor.bMaxPacketSize0;
			switch (len) {
M
Martin Fuzzey 已提交
1034 1035 1036 1037 1038 1039
			case 8:
				len = 24;
				break;
			case 16:
				len = 32;
				break;
L
Linus Torvalds 已提交
1040 1041 1042 1043
			}
			expected = -EREMOTEIO;
			break;
		default:
1044
			ERROR(dev, "bogus number of ctrl queue testcases!\n");
L
Linus Torvalds 已提交
1045 1046 1047
			context.status = -EINVAL;
			goto cleanup;
		}
M
Martin Fuzzey 已提交
1048 1049
		req.wLength = cpu_to_le16(len);
		urb[i] = u = simple_alloc_urb(udev, pipe, len);
L
Linus Torvalds 已提交
1050 1051 1052
		if (!u)
			goto cleanup;

1053
		reqp = kmalloc(sizeof *reqp, GFP_KERNEL);
L
Linus Torvalds 已提交
1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066
		if (!reqp)
			goto cleanup;
		reqp->setup = req;
		reqp->number = i % NUM_SUBCASES;
		reqp->expected = expected;
		u->setup_packet = (char *) &reqp->setup;

		u->context = &context;
		u->complete = ctrl_complete;
	}

	/* queue the urbs */
	context.urb = urb;
M
Martin Fuzzey 已提交
1067
	spin_lock_irq(&context.lock);
L
Linus Torvalds 已提交
1068
	for (i = 0; i < param->sglen; i++) {
M
Martin Fuzzey 已提交
1069
		context.status = usb_submit_urb(urb[i], GFP_ATOMIC);
L
Linus Torvalds 已提交
1070
		if (context.status != 0) {
1071
			ERROR(dev, "can't submit urb[%d], status %d\n",
L
Linus Torvalds 已提交
1072 1073 1074 1075 1076 1077
					i, context.status);
			context.count = context.pending;
			break;
		}
		context.pending++;
	}
M
Martin Fuzzey 已提交
1078
	spin_unlock_irq(&context.lock);
L
Linus Torvalds 已提交
1079 1080 1081 1082 1083

	/* FIXME  set timer and time out; provide a disconnect hook */

	/* wait for the last one to complete */
	if (context.pending > 0)
M
Martin Fuzzey 已提交
1084
		wait_for_completion(&context.complete);
L
Linus Torvalds 已提交
1085 1086 1087

cleanup:
	for (i = 0; i < param->sglen; i++) {
M
Martin Fuzzey 已提交
1088
		if (!urb[i])
L
Linus Torvalds 已提交
1089
			continue;
M
Martin Fuzzey 已提交
1090
		urb[i]->dev = udev;
1091
		kfree(urb[i]->setup_packet);
M
Martin Fuzzey 已提交
1092
		simple_free_urb(urb[i]);
L
Linus Torvalds 已提交
1093
	}
M
Martin Fuzzey 已提交
1094
	kfree(urb);
L
Linus Torvalds 已提交
1095 1096 1097 1098 1099 1100 1101
	return context.status;
}
#undef NUM_SUBCASES


/*-------------------------------------------------------------------------*/

M
Martin Fuzzey 已提交
1102
static void unlink1_callback(struct urb *urb)
L
Linus Torvalds 已提交
1103 1104 1105
{
	int	status = urb->status;

M
Martin Fuzzey 已提交
1106
	/* we "know" -EPIPE (stall) never happens */
L
Linus Torvalds 已提交
1107
	if (!status)
M
Martin Fuzzey 已提交
1108
		status = usb_submit_urb(urb, GFP_ATOMIC);
L
Linus Torvalds 已提交
1109 1110
	if (status) {
		urb->status = status;
1111
		complete(urb->context);
L
Linus Torvalds 已提交
1112 1113 1114
	}
}

M
Martin Fuzzey 已提交
1115
static int unlink1(struct usbtest_dev *dev, int pipe, int size, int async)
L
Linus Torvalds 已提交
1116 1117 1118 1119 1120
{
	struct urb		*urb;
	struct completion	completion;
	int			retval = 0;

M
Martin Fuzzey 已提交
1121 1122
	init_completion(&completion);
	urb = simple_alloc_urb(testdev_to_usbdev(dev), pipe, size);
L
Linus Torvalds 已提交
1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133
	if (!urb)
		return -ENOMEM;
	urb->context = &completion;
	urb->complete = unlink1_callback;

	/* keep the endpoint busy.  there are lots of hc/hcd-internal
	 * states, and testing should get to all of them over time.
	 *
	 * FIXME want additional tests for when endpoint is STALLing
	 * due to errors, or is just NAKing requests.
	 */
M
Martin Fuzzey 已提交
1134 1135
	retval = usb_submit_urb(urb, GFP_KERNEL);
	if (retval != 0) {
1136
		dev_err(&dev->intf->dev, "submit fail %d\n", retval);
L
Linus Torvalds 已提交
1137 1138 1139 1140 1141 1142
		return retval;
	}

	/* unlinking that should always work.  variable delay tests more
	 * hcd states and code paths, even with little other system load.
	 */
M
Martin Fuzzey 已提交
1143
	msleep(jiffies % (2 * INTERRUPT_RATE));
L
Linus Torvalds 已提交
1144
	if (async) {
1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169
		while (!completion_done(&completion)) {
			retval = usb_unlink_urb(urb);

			switch (retval) {
			case -EBUSY:
			case -EIDRM:
				/* we can't unlink urbs while they're completing
				 * or if they've completed, and we haven't
				 * resubmitted. "normal" drivers would prevent
				 * resubmission, but since we're testing unlink
				 * paths, we can't.
				 */
				ERROR(dev, "unlink retry\n");
				continue;
			case 0:
			case -EINPROGRESS:
				break;

			default:
				dev_err(&dev->intf->dev,
					"unlink fail %d\n", retval);
				return retval;
			}

			break;
L
Linus Torvalds 已提交
1170 1171
		}
	} else
M
Martin Fuzzey 已提交
1172
		usb_kill_urb(urb);
L
Linus Torvalds 已提交
1173

M
Martin Fuzzey 已提交
1174
	wait_for_completion(&completion);
L
Linus Torvalds 已提交
1175
	retval = urb->status;
M
Martin Fuzzey 已提交
1176
	simple_free_urb(urb);
L
Linus Torvalds 已提交
1177 1178 1179 1180 1181 1182 1183 1184

	if (async)
		return (retval == -ECONNRESET) ? 0 : retval - 1000;
	else
		return (retval == -ENOENT || retval == -EPERM) ?
				0 : retval - 2000;
}

M
Martin Fuzzey 已提交
1185
static int unlink_simple(struct usbtest_dev *dev, int pipe, int len)
L
Linus Torvalds 已提交
1186 1187 1188 1189
{
	int			retval = 0;

	/* test sync and async paths */
M
Martin Fuzzey 已提交
1190
	retval = unlink1(dev, pipe, len, 1);
L
Linus Torvalds 已提交
1191
	if (!retval)
M
Martin Fuzzey 已提交
1192
		retval = unlink1(dev, pipe, len, 0);
L
Linus Torvalds 已提交
1193 1194 1195 1196 1197
	return retval;
}

/*-------------------------------------------------------------------------*/

1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295
struct queued_ctx {
	struct completion	complete;
	atomic_t		pending;
	unsigned		num;
	int			status;
	struct urb		**urbs;
};

static void unlink_queued_callback(struct urb *urb)
{
	int			status = urb->status;
	struct queued_ctx	*ctx = urb->context;

	if (ctx->status)
		goto done;
	if (urb == ctx->urbs[ctx->num - 4] || urb == ctx->urbs[ctx->num - 2]) {
		if (status == -ECONNRESET)
			goto done;
		/* What error should we report if the URB completed normally? */
	}
	if (status != 0)
		ctx->status = status;

 done:
	if (atomic_dec_and_test(&ctx->pending))
		complete(&ctx->complete);
}

static int unlink_queued(struct usbtest_dev *dev, int pipe, unsigned num,
		unsigned size)
{
	struct queued_ctx	ctx;
	struct usb_device	*udev = testdev_to_usbdev(dev);
	void			*buf;
	dma_addr_t		buf_dma;
	int			i;
	int			retval = -ENOMEM;

	init_completion(&ctx.complete);
	atomic_set(&ctx.pending, 1);	/* One more than the actual value */
	ctx.num = num;
	ctx.status = 0;

	buf = usb_alloc_coherent(udev, size, GFP_KERNEL, &buf_dma);
	if (!buf)
		return retval;
	memset(buf, 0, size);

	/* Allocate and init the urbs we'll queue */
	ctx.urbs = kcalloc(num, sizeof(struct urb *), GFP_KERNEL);
	if (!ctx.urbs)
		goto free_buf;
	for (i = 0; i < num; i++) {
		ctx.urbs[i] = usb_alloc_urb(0, GFP_KERNEL);
		if (!ctx.urbs[i])
			goto free_urbs;
		usb_fill_bulk_urb(ctx.urbs[i], udev, pipe, buf, size,
				unlink_queued_callback, &ctx);
		ctx.urbs[i]->transfer_dma = buf_dma;
		ctx.urbs[i]->transfer_flags = URB_NO_TRANSFER_DMA_MAP;
	}

	/* Submit all the URBs and then unlink URBs num - 4 and num - 2. */
	for (i = 0; i < num; i++) {
		atomic_inc(&ctx.pending);
		retval = usb_submit_urb(ctx.urbs[i], GFP_KERNEL);
		if (retval != 0) {
			dev_err(&dev->intf->dev, "submit urbs[%d] fail %d\n",
					i, retval);
			atomic_dec(&ctx.pending);
			ctx.status = retval;
			break;
		}
	}
	if (i == num) {
		usb_unlink_urb(ctx.urbs[num - 4]);
		usb_unlink_urb(ctx.urbs[num - 2]);
	} else {
		while (--i >= 0)
			usb_unlink_urb(ctx.urbs[i]);
	}

	if (atomic_dec_and_test(&ctx.pending))		/* The extra count */
		complete(&ctx.complete);
	wait_for_completion(&ctx.complete);
	retval = ctx.status;

 free_urbs:
	for (i = 0; i < num; i++)
		usb_free_urb(ctx.urbs[i]);
	kfree(ctx.urbs);
 free_buf:
	usb_free_coherent(udev, size, buf, buf_dma);
	return retval;
}

/*-------------------------------------------------------------------------*/

1296
static int verify_not_halted(struct usbtest_dev *tdev, int ep, struct urb *urb)
L
Linus Torvalds 已提交
1297 1298 1299 1300 1301
{
	int	retval;
	u16	status;

	/* shouldn't look or act halted */
M
Martin Fuzzey 已提交
1302
	retval = usb_get_status(urb->dev, USB_RECIP_ENDPOINT, ep, &status);
L
Linus Torvalds 已提交
1303
	if (retval < 0) {
1304 1305
		ERROR(tdev, "ep %02x couldn't get no-halt status, %d\n",
				ep, retval);
L
Linus Torvalds 已提交
1306 1307 1308
		return retval;
	}
	if (status != 0) {
1309
		ERROR(tdev, "ep %02x bogus status: %04x != 0\n", ep, status);
L
Linus Torvalds 已提交
1310 1311
		return -EINVAL;
	}
1312
	retval = simple_io(tdev, urb, 1, 0, 0, __func__);
L
Linus Torvalds 已提交
1313 1314 1315 1316 1317
	if (retval != 0)
		return -EINVAL;
	return 0;
}

1318
static int verify_halted(struct usbtest_dev *tdev, int ep, struct urb *urb)
L
Linus Torvalds 已提交
1319 1320 1321 1322 1323
{
	int	retval;
	u16	status;

	/* should look and act halted */
M
Martin Fuzzey 已提交
1324
	retval = usb_get_status(urb->dev, USB_RECIP_ENDPOINT, ep, &status);
L
Linus Torvalds 已提交
1325
	if (retval < 0) {
1326 1327
		ERROR(tdev, "ep %02x couldn't get halt status, %d\n",
				ep, retval);
L
Linus Torvalds 已提交
1328 1329
		return retval;
	}
1330
	le16_to_cpus(&status);
L
Linus Torvalds 已提交
1331
	if (status != 1) {
1332
		ERROR(tdev, "ep %02x bogus status: %04x != 1\n", ep, status);
L
Linus Torvalds 已提交
1333 1334
		return -EINVAL;
	}
1335
	retval = simple_io(tdev, urb, 1, 0, -EPIPE, __func__);
L
Linus Torvalds 已提交
1336 1337
	if (retval != -EPIPE)
		return -EINVAL;
1338
	retval = simple_io(tdev, urb, 1, 0, -EPIPE, "verify_still_halted");
L
Linus Torvalds 已提交
1339 1340 1341 1342 1343
	if (retval != -EPIPE)
		return -EINVAL;
	return 0;
}

1344
static int test_halt(struct usbtest_dev *tdev, int ep, struct urb *urb)
L
Linus Torvalds 已提交
1345 1346 1347 1348
{
	int	retval;

	/* shouldn't look or act halted now */
1349
	retval = verify_not_halted(tdev, ep, urb);
L
Linus Torvalds 已提交
1350 1351 1352 1353
	if (retval < 0)
		return retval;

	/* set halt (protocol test only), verify it worked */
M
Martin Fuzzey 已提交
1354
	retval = usb_control_msg(urb->dev, usb_sndctrlpipe(urb->dev, 0),
L
Linus Torvalds 已提交
1355 1356 1357 1358
			USB_REQ_SET_FEATURE, USB_RECIP_ENDPOINT,
			USB_ENDPOINT_HALT, ep,
			NULL, 0, USB_CTRL_SET_TIMEOUT);
	if (retval < 0) {
1359
		ERROR(tdev, "ep %02x couldn't set halt, %d\n", ep, retval);
L
Linus Torvalds 已提交
1360 1361
		return retval;
	}
1362
	retval = verify_halted(tdev, ep, urb);
L
Linus Torvalds 已提交
1363 1364 1365 1366
	if (retval < 0)
		return retval;

	/* clear halt (tests API + protocol), verify it worked */
M
Martin Fuzzey 已提交
1367
	retval = usb_clear_halt(urb->dev, urb->pipe);
L
Linus Torvalds 已提交
1368
	if (retval < 0) {
1369
		ERROR(tdev, "ep %02x couldn't clear halt, %d\n", ep, retval);
L
Linus Torvalds 已提交
1370 1371
		return retval;
	}
1372
	retval = verify_not_halted(tdev, ep, urb);
L
Linus Torvalds 已提交
1373 1374 1375 1376 1377 1378 1379 1380
	if (retval < 0)
		return retval;

	/* NOTE:  could also verify SET_INTERFACE clear halts ... */

	return 0;
}

M
Martin Fuzzey 已提交
1381
static int halt_simple(struct usbtest_dev *dev)
L
Linus Torvalds 已提交
1382 1383 1384 1385 1386
{
	int		ep;
	int		retval = 0;
	struct urb	*urb;

M
Martin Fuzzey 已提交
1387
	urb = simple_alloc_urb(testdev_to_usbdev(dev), 0, 512);
L
Linus Torvalds 已提交
1388 1389 1390 1391
	if (urb == NULL)
		return -ENOMEM;

	if (dev->in_pipe) {
M
Martin Fuzzey 已提交
1392
		ep = usb_pipeendpoint(dev->in_pipe) | USB_DIR_IN;
L
Linus Torvalds 已提交
1393
		urb->pipe = dev->in_pipe;
1394
		retval = test_halt(dev, ep, urb);
L
Linus Torvalds 已提交
1395 1396 1397 1398 1399
		if (retval < 0)
			goto done;
	}

	if (dev->out_pipe) {
M
Martin Fuzzey 已提交
1400
		ep = usb_pipeendpoint(dev->out_pipe);
L
Linus Torvalds 已提交
1401
		urb->pipe = dev->out_pipe;
1402
		retval = test_halt(dev, ep, urb);
L
Linus Torvalds 已提交
1403 1404
	}
done:
M
Martin Fuzzey 已提交
1405
	simple_free_urb(urb);
L
Linus Torvalds 已提交
1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418
	return retval;
}

/*-------------------------------------------------------------------------*/

/* Control OUT tests use the vendor control requests from Intel's
 * USB 2.0 compliance test device:  write a buffer, read it back.
 *
 * Intel's spec only _requires_ that it work for one packet, which
 * is pretty weak.   Some HCDs place limits here; most devices will
 * need to be able to handle more than one OUT data packet.  We'll
 * try whatever we're told to try.
 */
M
Martin Fuzzey 已提交
1419
static int ctrl_out(struct usbtest_dev *dev,
1420
		unsigned count, unsigned length, unsigned vary, unsigned offset)
L
Linus Torvalds 已提交
1421
{
1422 1423
	unsigned		i, j, len;
	int			retval;
L
Linus Torvalds 已提交
1424 1425 1426
	u8			*buf;
	char			*what = "?";
	struct usb_device	*udev;
1427

D
David Brownell 已提交
1428
	if (length < 1 || length > 0xffff || vary >= length)
L
Linus Torvalds 已提交
1429 1430
		return -EINVAL;

1431
	buf = kmalloc(length + offset, GFP_KERNEL);
L
Linus Torvalds 已提交
1432 1433 1434
	if (!buf)
		return -ENOMEM;

1435
	buf += offset;
M
Martin Fuzzey 已提交
1436
	udev = testdev_to_usbdev(dev);
L
Linus Torvalds 已提交
1437 1438 1439 1440 1441 1442 1443 1444 1445
	len = length;
	retval = 0;

	/* NOTE:  hardware might well act differently if we pushed it
	 * with lots back-to-back queued requests.
	 */
	for (i = 0; i < count; i++) {
		/* write patterned data */
		for (j = 0; j < len; j++)
M
Martin Fuzzey 已提交
1446 1447
			buf[j] = i + j;
		retval = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
L
Linus Torvalds 已提交
1448 1449 1450 1451
				0x5b, USB_DIR_OUT|USB_TYPE_VENDOR,
				0, 0, buf, len, USB_CTRL_SET_TIMEOUT);
		if (retval != len) {
			what = "write";
D
David Brownell 已提交
1452
			if (retval >= 0) {
1453
				ERROR(dev, "ctrl_out, wlen %d (expected %d)\n",
D
David Brownell 已提交
1454 1455 1456
						retval, len);
				retval = -EBADMSG;
			}
L
Linus Torvalds 已提交
1457 1458 1459 1460
			break;
		}

		/* read it back -- assuming nothing intervened!!  */
M
Martin Fuzzey 已提交
1461
		retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
L
Linus Torvalds 已提交
1462 1463 1464 1465
				0x5c, USB_DIR_IN|USB_TYPE_VENDOR,
				0, 0, buf, len, USB_CTRL_GET_TIMEOUT);
		if (retval != len) {
			what = "read";
D
David Brownell 已提交
1466
			if (retval >= 0) {
1467
				ERROR(dev, "ctrl_out, rlen %d (expected %d)\n",
D
David Brownell 已提交
1468 1469 1470
						retval, len);
				retval = -EBADMSG;
			}
L
Linus Torvalds 已提交
1471 1472 1473 1474 1475
			break;
		}

		/* fail if we can't verify */
		for (j = 0; j < len; j++) {
M
Martin Fuzzey 已提交
1476
			if (buf[j] != (u8) (i + j)) {
1477
				ERROR(dev, "ctrl_out, byte %d is %d not %d\n",
M
Martin Fuzzey 已提交
1478
					j, buf[j], (u8) i + j);
L
Linus Torvalds 已提交
1479 1480 1481 1482 1483 1484 1485 1486 1487 1488
				retval = -EBADMSG;
				break;
			}
		}
		if (retval < 0) {
			what = "verify";
			break;
		}

		len += vary;
D
David Brownell 已提交
1489 1490

		/* [real world] the "zero bytes IN" case isn't really used.
J
Joe Perches 已提交
1491
		 * hardware can easily trip up in this weird case, since its
D
David Brownell 已提交
1492 1493
		 * status stage is IN, not OUT like other ep0in transfers.
		 */
L
Linus Torvalds 已提交
1494
		if (len > length)
D
David Brownell 已提交
1495
			len = realworld ? 1 : 0;
L
Linus Torvalds 已提交
1496 1497 1498
	}

	if (retval < 0)
M
Martin Fuzzey 已提交
1499
		ERROR(dev, "ctrl_out %s failed, code %d, count %d\n",
L
Linus Torvalds 已提交
1500 1501
			what, retval, i);

1502
	kfree(buf - offset);
L
Linus Torvalds 已提交
1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517
	return retval;
}

/*-------------------------------------------------------------------------*/

/* ISO tests ... mimics common usage
 *  - buffer length is split into N packets (mostly maxpacket sized)
 *  - multi-buffers according to sglen
 */

struct iso_context {
	unsigned		count;
	unsigned		pending;
	spinlock_t		lock;
	struct completion	done;
1518
	int			submit_error;
L
Linus Torvalds 已提交
1519
	unsigned long		errors;
1520
	unsigned long		packet_count;
L
Linus Torvalds 已提交
1521 1522 1523
	struct usbtest_dev	*dev;
};

M
Martin Fuzzey 已提交
1524
static void iso_callback(struct urb *urb)
L
Linus Torvalds 已提交
1525 1526 1527 1528 1529 1530
{
	struct iso_context	*ctx = urb->context;

	spin_lock(&ctx->lock);
	ctx->count--;

1531
	ctx->packet_count += urb->number_of_packets;
L
Linus Torvalds 已提交
1532 1533
	if (urb->error_count > 0)
		ctx->errors += urb->error_count;
1534 1535
	else if (urb->status != 0)
		ctx->errors += urb->number_of_packets;
1536 1537
	else if (urb->actual_length != urb->transfer_buffer_length)
		ctx->errors++;
1538 1539
	else if (check_guard_bytes(ctx->dev, urb) != 0)
		ctx->errors++;
L
Linus Torvalds 已提交
1540

1541 1542
	if (urb->status == 0 && ctx->count > (ctx->pending - 1)
			&& !ctx->submit_error) {
M
Martin Fuzzey 已提交
1543
		int status = usb_submit_urb(urb, GFP_ATOMIC);
L
Linus Torvalds 已提交
1544 1545 1546 1547
		switch (status) {
		case 0:
			goto done;
		default:
1548
			dev_err(&ctx->dev->intf->dev,
L
Linus Torvalds 已提交
1549 1550 1551 1552
					"iso resubmit err %d\n",
					status);
			/* FALLTHROUGH */
		case -ENODEV:			/* disconnected */
1553 1554
		case -ESHUTDOWN:		/* endpoint disabled */
			ctx->submit_error = 1;
L
Linus Torvalds 已提交
1555 1556 1557 1558 1559 1560 1561
			break;
		}
	}

	ctx->pending--;
	if (ctx->pending == 0) {
		if (ctx->errors)
1562
			dev_err(&ctx->dev->intf->dev,
1563 1564
				"iso test, %lu errors out of %lu\n",
				ctx->errors, ctx->packet_count);
M
Martin Fuzzey 已提交
1565
		complete(&ctx->done);
L
Linus Torvalds 已提交
1566 1567 1568 1569 1570
	}
done:
	spin_unlock(&ctx->lock);
}

M
Martin Fuzzey 已提交
1571
static struct urb *iso_alloc_urb(
L
Linus Torvalds 已提交
1572 1573 1574
	struct usb_device	*udev,
	int			pipe,
	struct usb_endpoint_descriptor	*desc,
1575 1576
	long			bytes,
	unsigned offset
L
Linus Torvalds 已提交
1577 1578 1579 1580 1581 1582 1583 1584 1585
)
{
	struct urb		*urb;
	unsigned		i, maxp, packets;

	if (bytes < 0 || !desc)
		return NULL;
	maxp = 0x7ff & le16_to_cpu(desc->wMaxPacketSize);
	maxp *= 1 + (0x3 & (le16_to_cpu(desc->wMaxPacketSize) >> 11));
J
Julia Lawall 已提交
1586
	packets = DIV_ROUND_UP(bytes, maxp);
L
Linus Torvalds 已提交
1587

M
Martin Fuzzey 已提交
1588
	urb = usb_alloc_urb(packets, GFP_KERNEL);
L
Linus Torvalds 已提交
1589 1590 1591 1592 1593 1594 1595
	if (!urb)
		return urb;
	urb->dev = udev;
	urb->pipe = pipe;

	urb->number_of_packets = packets;
	urb->transfer_buffer_length = bytes;
1596 1597 1598
	urb->transfer_buffer = usb_alloc_coherent(udev, bytes + offset,
							GFP_KERNEL,
							&urb->transfer_dma);
L
Linus Torvalds 已提交
1599
	if (!urb->transfer_buffer) {
M
Martin Fuzzey 已提交
1600
		usb_free_urb(urb);
L
Linus Torvalds 已提交
1601 1602
		return NULL;
	}
1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613
	if (offset) {
		memset(urb->transfer_buffer, GUARD_BYTE, offset);
		urb->transfer_buffer += offset;
		urb->transfer_dma += offset;
	}
	/* For inbound transfers use guard byte so that test fails if
		data not correctly copied */
	memset(urb->transfer_buffer,
			usb_pipein(urb->pipe) ? GUARD_BYTE : 0,
			bytes);

L
Linus Torvalds 已提交
1614 1615
	for (i = 0; i < packets; i++) {
		/* here, only the last packet will be short */
M
Martin Fuzzey 已提交
1616
		urb->iso_frame_desc[i].length = min((unsigned) bytes, maxp);
L
Linus Torvalds 已提交
1617 1618 1619 1620 1621 1622
		bytes -= urb->iso_frame_desc[i].length;

		urb->iso_frame_desc[i].offset = maxp * i;
	}

	urb->complete = iso_callback;
M
Martin Fuzzey 已提交
1623
	/* urb->context = SET BY CALLER */
L
Linus Torvalds 已提交
1624 1625 1626 1627 1628 1629
	urb->interval = 1 << (desc->bInterval - 1);
	urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP;
	return urb;
}

static int
M
Martin Fuzzey 已提交
1630
test_iso_queue(struct usbtest_dev *dev, struct usbtest_param *param,
1631
		int pipe, struct usb_endpoint_descriptor *desc, unsigned offset)
L
Linus Torvalds 已提交
1632 1633 1634 1635 1636
{
	struct iso_context	context;
	struct usb_device	*udev;
	unsigned		i;
	unsigned long		packets = 0;
1637
	int			status = 0;
L
Linus Torvalds 已提交
1638 1639 1640 1641 1642
	struct urb		*urbs[10];	/* FIXME no limit */

	if (param->sglen > 10)
		return -EDOM;

1643
	memset(&context, 0, sizeof context);
L
Linus Torvalds 已提交
1644 1645
	context.count = param->iterations * param->sglen;
	context.dev = dev;
M
Martin Fuzzey 已提交
1646 1647
	init_completion(&context.done);
	spin_lock_init(&context.lock);
L
Linus Torvalds 已提交
1648

M
Martin Fuzzey 已提交
1649 1650
	memset(urbs, 0, sizeof urbs);
	udev = testdev_to_usbdev(dev);
1651
	dev_info(&dev->intf->dev,
L
Linus Torvalds 已提交
1652 1653 1654 1655 1656 1657
		"... iso period %d %sframes, wMaxPacket %04x\n",
		1 << (desc->bInterval - 1),
		(udev->speed == USB_SPEED_HIGH) ? "micro" : "",
		le16_to_cpu(desc->wMaxPacketSize));

	for (i = 0; i < param->sglen; i++) {
M
Martin Fuzzey 已提交
1658
		urbs[i] = iso_alloc_urb(udev, pipe, desc,
1659
					param->length, offset);
M
Martin Fuzzey 已提交
1660
		if (!urbs[i]) {
L
Linus Torvalds 已提交
1661 1662 1663 1664
			status = -ENOMEM;
			goto fail;
		}
		packets += urbs[i]->number_of_packets;
M
Martin Fuzzey 已提交
1665
		urbs[i]->context = &context;
L
Linus Torvalds 已提交
1666 1667
	}
	packets *= param->iterations;
1668
	dev_info(&dev->intf->dev,
L
Linus Torvalds 已提交
1669 1670 1671 1672 1673
		"... total %lu msec (%lu packets)\n",
		(packets * (1 << (desc->bInterval - 1)))
			/ ((udev->speed == USB_SPEED_HIGH) ? 8 : 1),
		packets);

M
Martin Fuzzey 已提交
1674
	spin_lock_irq(&context.lock);
L
Linus Torvalds 已提交
1675
	for (i = 0; i < param->sglen; i++) {
1676
		++context.pending;
M
Martin Fuzzey 已提交
1677
		status = usb_submit_urb(urbs[i], GFP_ATOMIC);
L
Linus Torvalds 已提交
1678
		if (status < 0) {
M
Martin Fuzzey 已提交
1679
			ERROR(dev, "submit iso[%d], error %d\n", i, status);
L
Linus Torvalds 已提交
1680
			if (i == 0) {
M
Martin Fuzzey 已提交
1681
				spin_unlock_irq(&context.lock);
L
Linus Torvalds 已提交
1682 1683 1684
				goto fail;
			}

M
Martin Fuzzey 已提交
1685
			simple_free_urb(urbs[i]);
1686
			urbs[i] = NULL;
L
Linus Torvalds 已提交
1687
			context.pending--;
1688 1689
			context.submit_error = 1;
			break;
L
Linus Torvalds 已提交
1690 1691
		}
	}
M
Martin Fuzzey 已提交
1692
	spin_unlock_irq(&context.lock);
L
Linus Torvalds 已提交
1693

M
Martin Fuzzey 已提交
1694
	wait_for_completion(&context.done);
1695

1696 1697 1698 1699
	for (i = 0; i < param->sglen; i++) {
		if (urbs[i])
			simple_free_urb(urbs[i]);
	}
1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711
	/*
	 * Isochronous transfers are expected to fail sometimes.  As an
	 * arbitrary limit, we will report an error if any submissions
	 * fail or if the transfer failure rate is > 10%.
	 */
	if (status != 0)
		;
	else if (context.submit_error)
		status = -EACCES;
	else if (context.errors > context.packet_count / 10)
		status = -EIO;
	return status;
L
Linus Torvalds 已提交
1712 1713 1714

fail:
	for (i = 0; i < param->sglen; i++) {
M
Martin Fuzzey 已提交
1715 1716
		if (urbs[i])
			simple_free_urb(urbs[i]);
L
Linus Torvalds 已提交
1717 1718 1719 1720
	}
	return status;
}

1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740
static int test_unaligned_bulk(
	struct usbtest_dev *tdev,
	int pipe,
	unsigned length,
	int iterations,
	unsigned transfer_flags,
	const char *label)
{
	int retval;
	struct urb *urb = usbtest_alloc_urb(
		testdev_to_usbdev(tdev), pipe, length, transfer_flags, 1);

	if (!urb)
		return -ENOMEM;

	retval = simple_io(tdev, urb, iterations, 0, 0, label);
	simple_free_urb(urb);
	return retval;
}

L
Linus Torvalds 已提交
1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754
/*-------------------------------------------------------------------------*/

/* We only have this one interface to user space, through usbfs.
 * User mode code can scan usbfs to find N different devices (maybe on
 * different busses) to use when testing, and allocate one thread per
 * test.  So discovery is simplified, and we have no device naming issues.
 *
 * Don't use these only as stress/load tests.  Use them along with with
 * other USB bus activity:  plugging, unplugging, mousing, mp3 playback,
 * video capture, and so on.  Run different tests at different times, in
 * different sequences.  Nothing here should interact with other devices,
 * except indirectly by consuming USB bandwidth and CPU resources for test
 * threads and request completion.  But the only way to know that for sure
 * is to test when HC queues are in use by many devices.
1755 1756 1757 1758 1759 1760 1761
 *
 * WARNING:  Because usbfs grabs udev->dev.sem before calling this ioctl(),
 * it locks out usbcore in certain code paths.  Notably, if you disconnect
 * the device-under-test, khubd will wait block forever waiting for the
 * ioctl to complete ... so that usb_disconnect() can abort the pending
 * urbs and then call usbtest_disconnect().  To abort a test, you're best
 * off just killing the userspace task and waiting for it to exit.
L
Linus Torvalds 已提交
1762 1763
 */

1764
/* No BKL needed */
L
Linus Torvalds 已提交
1765
static int
M
Martin Fuzzey 已提交
1766
usbtest_ioctl(struct usb_interface *intf, unsigned int code, void *buf)
L
Linus Torvalds 已提交
1767
{
M
Martin Fuzzey 已提交
1768 1769
	struct usbtest_dev	*dev = usb_get_intfdata(intf);
	struct usb_device	*udev = testdev_to_usbdev(dev);
L
Linus Torvalds 已提交
1770 1771 1772 1773 1774 1775 1776 1777
	struct usbtest_param	*param = buf;
	int			retval = -EOPNOTSUPP;
	struct urb		*urb;
	struct scatterlist	*sg;
	struct usb_sg_request	req;
	struct timeval		start;
	unsigned		i;

M
Martin Fuzzey 已提交
1778
	/* FIXME USBDEVFS_CONNECTINFO doesn't say how fast the device is. */
L
Linus Torvalds 已提交
1779

1780 1781
	pattern = mod_pattern;

L
Linus Torvalds 已提交
1782 1783 1784
	if (code != USBTEST_REQUEST)
		return -EOPNOTSUPP;

1785
	if (param->iterations <= 0)
L
Linus Torvalds 已提交
1786 1787
		return -EINVAL;

1788
	if (mutex_lock_interruptible(&dev->lock))
L
Linus Torvalds 已提交
1789 1790
		return -ERESTARTSYS;

A
Alan Stern 已提交
1791
	/* FIXME: What if a system sleep starts while a test is running? */
D
David Brownell 已提交
1792

L
Linus Torvalds 已提交
1793 1794 1795 1796 1797
	/* some devices, like ez-usb default devices, need a non-default
	 * altsetting to have any active endpoints.  some tests change
	 * altsettings; force a default so most tests don't need to check.
	 */
	if (dev->info->alt >= 0) {
1798
		int	res;
L
Linus Torvalds 已提交
1799 1800

		if (intf->altsetting->desc.bInterfaceNumber) {
1801
			mutex_unlock(&dev->lock);
L
Linus Torvalds 已提交
1802 1803
			return -ENODEV;
		}
M
Martin Fuzzey 已提交
1804
		res = set_altsetting(dev, dev->info->alt);
L
Linus Torvalds 已提交
1805
		if (res) {
M
Martin Fuzzey 已提交
1806
			dev_err(&intf->dev,
L
Linus Torvalds 已提交
1807 1808
					"set altsetting to %d failed, %d\n",
					dev->info->alt, res);
1809
			mutex_unlock(&dev->lock);
L
Linus Torvalds 已提交
1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822
			return res;
		}
	}

	/*
	 * Just a bunch of test cases that every HCD is expected to handle.
	 *
	 * Some may need specific firmware, though it'd be good to have
	 * one firmware image to handle all the test cases.
	 *
	 * FIXME add more tests!  cancel requests, verify the data, control
	 * queueing, concurrent read+write threads, and so on.
	 */
M
Martin Fuzzey 已提交
1823
	do_gettimeofday(&start);
L
Linus Torvalds 已提交
1824 1825 1826
	switch (param->test_num) {

	case 0:
1827
		dev_info(&intf->dev, "TEST 0:  NOP\n");
L
Linus Torvalds 已提交
1828 1829 1830 1831 1832 1833 1834
		retval = 0;
		break;

	/* Simple non-queued bulk I/O tests */
	case 1:
		if (dev->out_pipe == 0)
			break;
1835
		dev_info(&intf->dev,
L
Linus Torvalds 已提交
1836 1837
				"TEST 1:  write %d bytes %u times\n",
				param->length, param->iterations);
M
Martin Fuzzey 已提交
1838
		urb = simple_alloc_urb(udev, dev->out_pipe, param->length);
L
Linus Torvalds 已提交
1839 1840 1841 1842
		if (!urb) {
			retval = -ENOMEM;
			break;
		}
M
Martin Fuzzey 已提交
1843
		/* FIRMWARE:  bulk sink (maybe accepts short writes) */
1844
		retval = simple_io(dev, urb, param->iterations, 0, 0, "test1");
M
Martin Fuzzey 已提交
1845
		simple_free_urb(urb);
L
Linus Torvalds 已提交
1846 1847 1848 1849
		break;
	case 2:
		if (dev->in_pipe == 0)
			break;
1850
		dev_info(&intf->dev,
L
Linus Torvalds 已提交
1851 1852
				"TEST 2:  read %d bytes %u times\n",
				param->length, param->iterations);
M
Martin Fuzzey 已提交
1853
		urb = simple_alloc_urb(udev, dev->in_pipe, param->length);
L
Linus Torvalds 已提交
1854 1855 1856 1857
		if (!urb) {
			retval = -ENOMEM;
			break;
		}
M
Martin Fuzzey 已提交
1858
		/* FIRMWARE:  bulk source (maybe generates short writes) */
1859
		retval = simple_io(dev, urb, param->iterations, 0, 0, "test2");
M
Martin Fuzzey 已提交
1860
		simple_free_urb(urb);
L
Linus Torvalds 已提交
1861 1862 1863 1864
		break;
	case 3:
		if (dev->out_pipe == 0 || param->vary == 0)
			break;
1865
		dev_info(&intf->dev,
L
Linus Torvalds 已提交
1866 1867
				"TEST 3:  write/%d 0..%d bytes %u times\n",
				param->vary, param->length, param->iterations);
M
Martin Fuzzey 已提交
1868
		urb = simple_alloc_urb(udev, dev->out_pipe, param->length);
L
Linus Torvalds 已提交
1869 1870 1871 1872
		if (!urb) {
			retval = -ENOMEM;
			break;
		}
M
Martin Fuzzey 已提交
1873
		/* FIRMWARE:  bulk sink (maybe accepts short writes) */
1874
		retval = simple_io(dev, urb, param->iterations, param->vary,
L
Linus Torvalds 已提交
1875
					0, "test3");
M
Martin Fuzzey 已提交
1876
		simple_free_urb(urb);
L
Linus Torvalds 已提交
1877 1878 1879 1880
		break;
	case 4:
		if (dev->in_pipe == 0 || param->vary == 0)
			break;
1881
		dev_info(&intf->dev,
L
Linus Torvalds 已提交
1882 1883
				"TEST 4:  read/%d 0..%d bytes %u times\n",
				param->vary, param->length, param->iterations);
M
Martin Fuzzey 已提交
1884
		urb = simple_alloc_urb(udev, dev->in_pipe, param->length);
L
Linus Torvalds 已提交
1885 1886 1887 1888
		if (!urb) {
			retval = -ENOMEM;
			break;
		}
M
Martin Fuzzey 已提交
1889
		/* FIRMWARE:  bulk source (maybe generates short writes) */
1890
		retval = simple_io(dev, urb, param->iterations, param->vary,
L
Linus Torvalds 已提交
1891
					0, "test4");
M
Martin Fuzzey 已提交
1892
		simple_free_urb(urb);
L
Linus Torvalds 已提交
1893 1894 1895 1896 1897 1898
		break;

	/* Queued bulk I/O tests */
	case 5:
		if (dev->out_pipe == 0 || param->sglen == 0)
			break;
1899
		dev_info(&intf->dev,
L
Linus Torvalds 已提交
1900 1901 1902
			"TEST 5:  write %d sglists %d entries of %d bytes\n",
				param->iterations,
				param->sglen, param->length);
M
Martin Fuzzey 已提交
1903
		sg = alloc_sglist(param->sglen, param->length, 0);
L
Linus Torvalds 已提交
1904 1905 1906 1907
		if (!sg) {
			retval = -ENOMEM;
			break;
		}
M
Martin Fuzzey 已提交
1908
		/* FIRMWARE:  bulk sink (maybe accepts short writes) */
1909
		retval = perform_sglist(dev, param->iterations, dev->out_pipe,
L
Linus Torvalds 已提交
1910
				&req, sg, param->sglen);
M
Martin Fuzzey 已提交
1911
		free_sglist(sg, param->sglen);
L
Linus Torvalds 已提交
1912 1913 1914 1915 1916
		break;

	case 6:
		if (dev->in_pipe == 0 || param->sglen == 0)
			break;
1917
		dev_info(&intf->dev,
L
Linus Torvalds 已提交
1918 1919 1920
			"TEST 6:  read %d sglists %d entries of %d bytes\n",
				param->iterations,
				param->sglen, param->length);
M
Martin Fuzzey 已提交
1921
		sg = alloc_sglist(param->sglen, param->length, 0);
L
Linus Torvalds 已提交
1922 1923 1924 1925
		if (!sg) {
			retval = -ENOMEM;
			break;
		}
M
Martin Fuzzey 已提交
1926
		/* FIRMWARE:  bulk source (maybe generates short writes) */
1927
		retval = perform_sglist(dev, param->iterations, dev->in_pipe,
L
Linus Torvalds 已提交
1928
				&req, sg, param->sglen);
M
Martin Fuzzey 已提交
1929
		free_sglist(sg, param->sglen);
L
Linus Torvalds 已提交
1930 1931 1932 1933
		break;
	case 7:
		if (dev->out_pipe == 0 || param->sglen == 0 || param->vary == 0)
			break;
1934
		dev_info(&intf->dev,
L
Linus Torvalds 已提交
1935 1936 1937
			"TEST 7:  write/%d %d sglists %d entries 0..%d bytes\n",
				param->vary, param->iterations,
				param->sglen, param->length);
M
Martin Fuzzey 已提交
1938
		sg = alloc_sglist(param->sglen, param->length, param->vary);
L
Linus Torvalds 已提交
1939 1940 1941 1942
		if (!sg) {
			retval = -ENOMEM;
			break;
		}
M
Martin Fuzzey 已提交
1943
		/* FIRMWARE:  bulk sink (maybe accepts short writes) */
1944
		retval = perform_sglist(dev, param->iterations, dev->out_pipe,
L
Linus Torvalds 已提交
1945
				&req, sg, param->sglen);
M
Martin Fuzzey 已提交
1946
		free_sglist(sg, param->sglen);
L
Linus Torvalds 已提交
1947 1948 1949 1950
		break;
	case 8:
		if (dev->in_pipe == 0 || param->sglen == 0 || param->vary == 0)
			break;
1951
		dev_info(&intf->dev,
L
Linus Torvalds 已提交
1952 1953 1954
			"TEST 8:  read/%d %d sglists %d entries 0..%d bytes\n",
				param->vary, param->iterations,
				param->sglen, param->length);
M
Martin Fuzzey 已提交
1955
		sg = alloc_sglist(param->sglen, param->length, param->vary);
L
Linus Torvalds 已提交
1956 1957 1958 1959
		if (!sg) {
			retval = -ENOMEM;
			break;
		}
M
Martin Fuzzey 已提交
1960
		/* FIRMWARE:  bulk source (maybe generates short writes) */
1961
		retval = perform_sglist(dev, param->iterations, dev->in_pipe,
L
Linus Torvalds 已提交
1962
				&req, sg, param->sglen);
M
Martin Fuzzey 已提交
1963
		free_sglist(sg, param->sglen);
L
Linus Torvalds 已提交
1964 1965 1966 1967 1968
		break;

	/* non-queued sanity tests for control (chapter 9 subset) */
	case 9:
		retval = 0;
1969
		dev_info(&intf->dev,
L
Linus Torvalds 已提交
1970 1971 1972
			"TEST 9:  ch9 (subset) control tests, %d times\n",
				param->iterations);
		for (i = param->iterations; retval == 0 && i--; /* NOP */)
M
Martin Fuzzey 已提交
1973
			retval = ch9_postconfig(dev);
L
Linus Torvalds 已提交
1974
		if (retval)
1975 1976
			dev_err(&intf->dev, "ch9 subset failed, "
					"iterations left %d\n", i);
L
Linus Torvalds 已提交
1977 1978 1979 1980 1981 1982 1983
		break;

	/* queued control messaging */
	case 10:
		if (param->sglen == 0)
			break;
		retval = 0;
1984
		dev_info(&intf->dev,
L
Linus Torvalds 已提交
1985 1986 1987
				"TEST 10:  queue %d control calls, %d times\n",
				param->sglen,
				param->iterations);
M
Martin Fuzzey 已提交
1988
		retval = test_ctrl_queue(dev, param);
L
Linus Torvalds 已提交
1989 1990 1991 1992 1993 1994 1995
		break;

	/* simple non-queued unlinks (ring with one urb) */
	case 11:
		if (dev->in_pipe == 0 || !param->length)
			break;
		retval = 0;
1996
		dev_info(&intf->dev, "TEST 11:  unlink %d reads of %d\n",
L
Linus Torvalds 已提交
1997 1998
				param->iterations, param->length);
		for (i = param->iterations; retval == 0 && i--; /* NOP */)
M
Martin Fuzzey 已提交
1999
			retval = unlink_simple(dev, dev->in_pipe,
L
Linus Torvalds 已提交
2000 2001
						param->length);
		if (retval)
2002
			dev_err(&intf->dev, "unlink reads failed %d, "
L
Linus Torvalds 已提交
2003 2004 2005 2006 2007 2008
				"iterations left %d\n", retval, i);
		break;
	case 12:
		if (dev->out_pipe == 0 || !param->length)
			break;
		retval = 0;
2009
		dev_info(&intf->dev, "TEST 12:  unlink %d writes of %d\n",
L
Linus Torvalds 已提交
2010 2011
				param->iterations, param->length);
		for (i = param->iterations; retval == 0 && i--; /* NOP */)
M
Martin Fuzzey 已提交
2012
			retval = unlink_simple(dev, dev->out_pipe,
L
Linus Torvalds 已提交
2013 2014
						param->length);
		if (retval)
2015
			dev_err(&intf->dev, "unlink writes failed %d, "
L
Linus Torvalds 已提交
2016 2017 2018 2019 2020 2021 2022 2023
				"iterations left %d\n", retval, i);
		break;

	/* ep halt tests */
	case 13:
		if (dev->out_pipe == 0 && dev->in_pipe == 0)
			break;
		retval = 0;
2024
		dev_info(&intf->dev, "TEST 13:  set/clear %d halts\n",
L
Linus Torvalds 已提交
2025 2026
				param->iterations);
		for (i = param->iterations; retval == 0 && i--; /* NOP */)
M
Martin Fuzzey 已提交
2027
			retval = halt_simple(dev);
2028

L
Linus Torvalds 已提交
2029
		if (retval)
2030
			ERROR(dev, "halts failed, iterations left %d\n", i);
L
Linus Torvalds 已提交
2031 2032 2033 2034 2035 2036
		break;

	/* control write tests */
	case 14:
		if (!dev->info->ctrl_out)
			break;
2037
		dev_info(&intf->dev, "TEST 14:  %d ep0out, %d..%d vary %d\n",
D
David Brownell 已提交
2038 2039 2040
				param->iterations,
				realworld ? 1 : 0, param->length,
				param->vary);
2041
		retval = ctrl_out(dev, param->iterations,
2042
				param->length, param->vary, 0);
L
Linus Torvalds 已提交
2043 2044 2045 2046 2047 2048
		break;

	/* iso write tests */
	case 15:
		if (dev->out_iso_pipe == 0 || param->sglen == 0)
			break;
2049
		dev_info(&intf->dev,
L
Linus Torvalds 已提交
2050 2051 2052
			"TEST 15:  write %d iso, %d entries of %d bytes\n",
				param->iterations,
				param->sglen, param->length);
M
Martin Fuzzey 已提交
2053 2054
		/* FIRMWARE:  iso sink */
		retval = test_iso_queue(dev, param,
2055
				dev->out_iso_pipe, dev->iso_out, 0);
L
Linus Torvalds 已提交
2056 2057 2058 2059 2060 2061
		break;

	/* iso read tests */
	case 16:
		if (dev->in_iso_pipe == 0 || param->sglen == 0)
			break;
2062
		dev_info(&intf->dev,
L
Linus Torvalds 已提交
2063 2064 2065
			"TEST 16:  read %d iso, %d entries of %d bytes\n",
				param->iterations,
				param->sglen, param->length);
M
Martin Fuzzey 已提交
2066 2067
		/* FIRMWARE:  iso source */
		retval = test_iso_queue(dev, param,
2068
				dev->in_iso_pipe, dev->iso_in, 0);
L
Linus Torvalds 已提交
2069 2070
		break;

M
Martin Fuzzey 已提交
2071
	/* FIXME scatterlist cancel (needs helper thread) */
L
Linus Torvalds 已提交
2072

2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162
	/* Tests for bulk I/O using DMA mapping by core and odd address */
	case 17:
		if (dev->out_pipe == 0)
			break;
		dev_info(&intf->dev,
			"TEST 17:  write odd addr %d bytes %u times core map\n",
			param->length, param->iterations);

		retval = test_unaligned_bulk(
				dev, dev->out_pipe,
				param->length, param->iterations,
				0, "test17");
		break;

	case 18:
		if (dev->in_pipe == 0)
			break;
		dev_info(&intf->dev,
			"TEST 18:  read odd addr %d bytes %u times core map\n",
			param->length, param->iterations);

		retval = test_unaligned_bulk(
				dev, dev->in_pipe,
				param->length, param->iterations,
				0, "test18");
		break;

	/* Tests for bulk I/O using premapped coherent buffer and odd address */
	case 19:
		if (dev->out_pipe == 0)
			break;
		dev_info(&intf->dev,
			"TEST 19:  write odd addr %d bytes %u times premapped\n",
			param->length, param->iterations);

		retval = test_unaligned_bulk(
				dev, dev->out_pipe,
				param->length, param->iterations,
				URB_NO_TRANSFER_DMA_MAP, "test19");
		break;

	case 20:
		if (dev->in_pipe == 0)
			break;
		dev_info(&intf->dev,
			"TEST 20:  read odd addr %d bytes %u times premapped\n",
			param->length, param->iterations);

		retval = test_unaligned_bulk(
				dev, dev->in_pipe,
				param->length, param->iterations,
				URB_NO_TRANSFER_DMA_MAP, "test20");
		break;

	/* control write tests with unaligned buffer */
	case 21:
		if (!dev->info->ctrl_out)
			break;
		dev_info(&intf->dev,
				"TEST 21:  %d ep0out odd addr, %d..%d vary %d\n",
				param->iterations,
				realworld ? 1 : 0, param->length,
				param->vary);
		retval = ctrl_out(dev, param->iterations,
				param->length, param->vary, 1);
		break;

	/* unaligned iso tests */
	case 22:
		if (dev->out_iso_pipe == 0 || param->sglen == 0)
			break;
		dev_info(&intf->dev,
			"TEST 22:  write %d iso odd, %d entries of %d bytes\n",
				param->iterations,
				param->sglen, param->length);
		retval = test_iso_queue(dev, param,
				dev->out_iso_pipe, dev->iso_out, 1);
		break;

	case 23:
		if (dev->in_iso_pipe == 0 || param->sglen == 0)
			break;
		dev_info(&intf->dev,
			"TEST 23:  read %d iso odd, %d entries of %d bytes\n",
				param->iterations,
				param->sglen, param->length);
		retval = test_iso_queue(dev, param,
				dev->in_iso_pipe, dev->iso_in, 1);
		break;

2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182
	/* unlink URBs from a bulk-OUT queue */
	case 24:
		if (dev->out_pipe == 0 || !param->length || param->sglen < 4)
			break;
		retval = 0;
		dev_info(&intf->dev, "TEST 17:  unlink from %d queues of "
				"%d %d-byte writes\n",
				param->iterations, param->sglen, param->length);
		for (i = param->iterations; retval == 0 && i > 0; --i) {
			retval = unlink_queued(dev, dev->out_pipe,
						param->sglen, param->length);
			if (retval) {
				dev_err(&intf->dev,
					"unlink queued writes failed %d, "
					"iterations left %d\n", retval, i);
				break;
			}
		}
		break;

L
Linus Torvalds 已提交
2183
	}
M
Martin Fuzzey 已提交
2184
	do_gettimeofday(&param->duration);
L
Linus Torvalds 已提交
2185 2186 2187 2188 2189 2190
	param->duration.tv_sec -= start.tv_sec;
	param->duration.tv_usec -= start.tv_usec;
	if (param->duration.tv_usec < 0) {
		param->duration.tv_usec += 1000 * 1000;
		param->duration.tv_sec -= 1;
	}
2191
	mutex_unlock(&dev->lock);
L
Linus Torvalds 已提交
2192 2193 2194 2195 2196
	return retval;
}

/*-------------------------------------------------------------------------*/

M
Martin Fuzzey 已提交
2197 2198 2199
static unsigned force_interrupt;
module_param(force_interrupt, uint, 0);
MODULE_PARM_DESC(force_interrupt, "0 = test default; else interrupt");
L
Linus Torvalds 已提交
2200 2201 2202 2203

#ifdef	GENERIC
static unsigned short vendor;
module_param(vendor, ushort, 0);
M
Martin Fuzzey 已提交
2204
MODULE_PARM_DESC(vendor, "vendor code (from usb-if)");
L
Linus Torvalds 已提交
2205 2206 2207

static unsigned short product;
module_param(product, ushort, 0);
M
Martin Fuzzey 已提交
2208
MODULE_PARM_DESC(product, "product code (from vendor)");
L
Linus Torvalds 已提交
2209 2210 2211
#endif

static int
M
Martin Fuzzey 已提交
2212
usbtest_probe(struct usb_interface *intf, const struct usb_device_id *id)
L
Linus Torvalds 已提交
2213 2214 2215 2216 2217 2218 2219
{
	struct usb_device	*udev;
	struct usbtest_dev	*dev;
	struct usbtest_info	*info;
	char			*rtest, *wtest;
	char			*irtest, *iwtest;

M
Martin Fuzzey 已提交
2220
	udev = interface_to_usbdev(intf);
L
Linus Torvalds 已提交
2221 2222 2223 2224 2225 2226 2227 2228 2229

#ifdef	GENERIC
	/* specify devices by module parameters? */
	if (id->match_flags == 0) {
		/* vendor match required, product match optional */
		if (!vendor || le16_to_cpu(udev->descriptor.idVendor) != (u16)vendor)
			return -ENODEV;
		if (product && le16_to_cpu(udev->descriptor.idProduct) != (u16)product)
			return -ENODEV;
2230 2231
		dev_info(&intf->dev, "matched module params, "
					"vend=0x%04x prod=0x%04x\n",
L
Linus Torvalds 已提交
2232 2233 2234 2235 2236
				le16_to_cpu(udev->descriptor.idVendor),
				le16_to_cpu(udev->descriptor.idProduct));
	}
#endif

2237
	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
L
Linus Torvalds 已提交
2238 2239 2240 2241
	if (!dev)
		return -ENOMEM;
	info = (struct usbtest_info *) id->driver_info;
	dev->info = info;
2242
	mutex_init(&dev->lock);
L
Linus Torvalds 已提交
2243 2244 2245 2246

	dev->intf = intf;

	/* cacheline-aligned scratch for i/o */
M
Martin Fuzzey 已提交
2247 2248 2249
	dev->buf = kmalloc(TBUF_SIZE, GFP_KERNEL);
	if (dev->buf == NULL) {
		kfree(dev);
L
Linus Torvalds 已提交
2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260
		return -ENOMEM;
	}

	/* NOTE this doesn't yet test the handful of difference that are
	 * visible with high speed interrupts:  bigger maxpacket (1K) and
	 * "high bandwidth" modes (up to 3 packets/uframe).
	 */
	rtest = wtest = "";
	irtest = iwtest = "";
	if (force_interrupt || udev->speed == USB_SPEED_LOW) {
		if (info->ep_in) {
M
Martin Fuzzey 已提交
2261
			dev->in_pipe = usb_rcvintpipe(udev, info->ep_in);
L
Linus Torvalds 已提交
2262 2263 2264
			rtest = " intr-in";
		}
		if (info->ep_out) {
M
Martin Fuzzey 已提交
2265
			dev->out_pipe = usb_sndintpipe(udev, info->ep_out);
L
Linus Torvalds 已提交
2266 2267 2268 2269 2270 2271
			wtest = " intr-out";
		}
	} else {
		if (info->autoconf) {
			int status;

M
Martin Fuzzey 已提交
2272
			status = get_endpoints(dev, intf);
L
Linus Torvalds 已提交
2273
			if (status < 0) {
2274
				WARNING(dev, "couldn't get endpoints, %d\n",
2275
						status);
L
Linus Torvalds 已提交
2276 2277 2278 2279 2280
				return status;
			}
			/* may find bulk or ISO pipes */
		} else {
			if (info->ep_in)
M
Martin Fuzzey 已提交
2281
				dev->in_pipe = usb_rcvbulkpipe(udev,
L
Linus Torvalds 已提交
2282 2283
							info->ep_in);
			if (info->ep_out)
M
Martin Fuzzey 已提交
2284
				dev->out_pipe = usb_sndbulkpipe(udev,
L
Linus Torvalds 已提交
2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296
							info->ep_out);
		}
		if (dev->in_pipe)
			rtest = " bulk-in";
		if (dev->out_pipe)
			wtest = " bulk-out";
		if (dev->in_iso_pipe)
			irtest = " iso-in";
		if (dev->out_iso_pipe)
			iwtest = " iso-out";
	}

M
Martin Fuzzey 已提交
2297 2298 2299
	usb_set_intfdata(intf, dev);
	dev_info(&intf->dev, "%s\n", info->name);
	dev_info(&intf->dev, "%s speed {control%s%s%s%s%s} tests%s\n",
L
Linus Torvalds 已提交
2300 2301
			({ char *tmp;
			switch (udev->speed) {
M
Martin Fuzzey 已提交
2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313
			case USB_SPEED_LOW:
				tmp = "low";
				break;
			case USB_SPEED_FULL:
				tmp = "full";
				break;
			case USB_SPEED_HIGH:
				tmp = "high";
				break;
			default:
				tmp = "unknown";
				break;
L
Linus Torvalds 已提交
2314 2315 2316 2317 2318 2319 2320 2321
			}; tmp; }),
			info->ctrl_out ? " in/out" : "",
			rtest, wtest,
			irtest, iwtest,
			info->alt >= 0 ? " (+alt)" : "");
	return 0;
}

M
Martin Fuzzey 已提交
2322
static int usbtest_suspend(struct usb_interface *intf, pm_message_t message)
D
David Brownell 已提交
2323 2324 2325 2326
{
	return 0;
}

M
Martin Fuzzey 已提交
2327
static int usbtest_resume(struct usb_interface *intf)
D
David Brownell 已提交
2328 2329 2330 2331 2332
{
	return 0;
}


M
Martin Fuzzey 已提交
2333
static void usbtest_disconnect(struct usb_interface *intf)
L
Linus Torvalds 已提交
2334
{
M
Martin Fuzzey 已提交
2335
	struct usbtest_dev	*dev = usb_get_intfdata(intf);
L
Linus Torvalds 已提交
2336

M
Martin Fuzzey 已提交
2337 2338 2339
	usb_set_intfdata(intf, NULL);
	dev_dbg(&intf->dev, "disconnect\n");
	kfree(dev);
L
Linus Torvalds 已提交
2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375
}

/* Basic testing only needs a device that can source or sink bulk traffic.
 * Any device can test control transfers (default with GENERIC binding).
 *
 * Several entries work with the default EP0 implementation that's built
 * into EZ-USB chips.  There's a default vendor ID which can be overridden
 * by (very) small config EEPROMS, but otherwise all these devices act
 * identically until firmware is loaded:  only EP0 works.  It turns out
 * to be easy to make other endpoints work, without modifying that EP0
 * behavior.  For now, we expect that kind of firmware.
 */

/* an21xx or fx versions of ez-usb */
static struct usbtest_info ez1_info = {
	.name		= "EZ-USB device",
	.ep_in		= 2,
	.ep_out		= 2,
	.alt		= 1,
};

/* fx2 version of ez-usb */
static struct usbtest_info ez2_info = {
	.name		= "FX2 device",
	.ep_in		= 6,
	.ep_out		= 2,
	.alt		= 1,
};

/* ezusb family device with dedicated usb test firmware,
 */
static struct usbtest_info fw_info = {
	.name		= "usb test device",
	.ep_in		= 2,
	.ep_out		= 2,
	.alt		= 1,
M
Martin Fuzzey 已提交
2376
	.autoconf	= 1,		/* iso and ctrl_out need autoconf */
L
Linus Torvalds 已提交
2377
	.ctrl_out	= 1,
M
Martin Fuzzey 已提交
2378
	.iso		= 1,		/* iso_ep's are #8 in/out */
L
Linus Torvalds 已提交
2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397 2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425
};

/* peripheral running Linux and 'zero.c' test firmware, or
 * its user-mode cousin. different versions of this use
 * different hardware with the same vendor/product codes.
 * host side MUST rely on the endpoint descriptors.
 */
static struct usbtest_info gz_info = {
	.name		= "Linux gadget zero",
	.autoconf	= 1,
	.ctrl_out	= 1,
	.alt		= 0,
};

static struct usbtest_info um_info = {
	.name		= "Linux user mode test driver",
	.autoconf	= 1,
	.alt		= -1,
};

static struct usbtest_info um2_info = {
	.name		= "Linux user mode ISO test driver",
	.autoconf	= 1,
	.iso		= 1,
	.alt		= -1,
};

#ifdef IBOT2
/* this is a nice source of high speed bulk data;
 * uses an FX2, with firmware provided in the device
 */
static struct usbtest_info ibot2_info = {
	.name		= "iBOT2 webcam",
	.ep_in		= 2,
	.alt		= -1,
};
#endif

#ifdef GENERIC
/* we can use any device to test control traffic */
static struct usbtest_info generic_info = {
	.name		= "Generic USB device",
	.alt		= -1,
};
#endif


2426
static const struct usb_device_id id_table[] = {
L
Linus Torvalds 已提交
2427 2428 2429 2430 2431 2432 2433 2434

	/*-------------------------------------------------------------*/

	/* EZ-USB devices which download firmware to replace (or in our
	 * case augment) the default device implementation.
	 */

	/* generic EZ-USB FX controller */
M
Martin Fuzzey 已提交
2435
	{ USB_DEVICE(0x0547, 0x2235),
L
Linus Torvalds 已提交
2436
		.driver_info = (unsigned long) &ez1_info,
M
Martin Fuzzey 已提交
2437
	},
L
Linus Torvalds 已提交
2438 2439

	/* CY3671 development board with EZ-USB FX */
M
Martin Fuzzey 已提交
2440
	{ USB_DEVICE(0x0547, 0x0080),
L
Linus Torvalds 已提交
2441
		.driver_info = (unsigned long) &ez1_info,
M
Martin Fuzzey 已提交
2442
	},
L
Linus Torvalds 已提交
2443 2444

	/* generic EZ-USB FX2 controller (or development board) */
M
Martin Fuzzey 已提交
2445
	{ USB_DEVICE(0x04b4, 0x8613),
L
Linus Torvalds 已提交
2446
		.driver_info = (unsigned long) &ez2_info,
M
Martin Fuzzey 已提交
2447
	},
L
Linus Torvalds 已提交
2448 2449

	/* re-enumerated usb test device firmware */
M
Martin Fuzzey 已提交
2450
	{ USB_DEVICE(0xfff0, 0xfff0),
L
Linus Torvalds 已提交
2451
		.driver_info = (unsigned long) &fw_info,
M
Martin Fuzzey 已提交
2452
	},
L
Linus Torvalds 已提交
2453 2454

	/* "Gadget Zero" firmware runs under Linux */
M
Martin Fuzzey 已提交
2455
	{ USB_DEVICE(0x0525, 0xa4a0),
L
Linus Torvalds 已提交
2456
		.driver_info = (unsigned long) &gz_info,
M
Martin Fuzzey 已提交
2457
	},
L
Linus Torvalds 已提交
2458 2459

	/* so does a user-mode variant */
M
Martin Fuzzey 已提交
2460
	{ USB_DEVICE(0x0525, 0xa4a4),
L
Linus Torvalds 已提交
2461
		.driver_info = (unsigned long) &um_info,
M
Martin Fuzzey 已提交
2462
	},
L
Linus Torvalds 已提交
2463 2464

	/* ... and a user-mode variant that talks iso */
M
Martin Fuzzey 已提交
2465
	{ USB_DEVICE(0x0525, 0xa4a3),
L
Linus Torvalds 已提交
2466
		.driver_info = (unsigned long) &um2_info,
M
Martin Fuzzey 已提交
2467
	},
L
Linus Torvalds 已提交
2468 2469 2470

#ifdef KEYSPAN_19Qi
	/* Keyspan 19qi uses an21xx (original EZ-USB) */
M
Martin Fuzzey 已提交
2471 2472
	/* this does not coexist with the real Keyspan 19qi driver! */
	{ USB_DEVICE(0x06cd, 0x010b),
L
Linus Torvalds 已提交
2473
		.driver_info = (unsigned long) &ez1_info,
M
Martin Fuzzey 已提交
2474
	},
L
Linus Torvalds 已提交
2475 2476 2477 2478 2479 2480
#endif

	/*-------------------------------------------------------------*/

#ifdef IBOT2
	/* iBOT2 makes a nice source of high speed bulk-in data */
M
Martin Fuzzey 已提交
2481 2482
	/* this does not coexist with a real iBOT2 driver! */
	{ USB_DEVICE(0x0b62, 0x0059),
L
Linus Torvalds 已提交
2483
		.driver_info = (unsigned long) &ibot2_info,
M
Martin Fuzzey 已提交
2484
	},
L
Linus Torvalds 已提交
2485 2486 2487 2488 2489 2490 2491 2492 2493 2494 2495 2496 2497
#endif

	/*-------------------------------------------------------------*/

#ifdef GENERIC
	/* module params can specify devices to use for control tests */
	{ .driver_info = (unsigned long) &generic_info, },
#endif

	/*-------------------------------------------------------------*/

	{ }
};
M
Martin Fuzzey 已提交
2498
MODULE_DEVICE_TABLE(usb, id_table);
L
Linus Torvalds 已提交
2499 2500 2501 2502 2503

static struct usb_driver usbtest_driver = {
	.name =		"usbtest",
	.id_table =	id_table,
	.probe =	usbtest_probe,
2504
	.unlocked_ioctl = usbtest_ioctl,
L
Linus Torvalds 已提交
2505
	.disconnect =	usbtest_disconnect,
D
David Brownell 已提交
2506 2507
	.suspend =	usbtest_suspend,
	.resume =	usbtest_resume,
L
Linus Torvalds 已提交
2508 2509 2510 2511
};

/*-------------------------------------------------------------------------*/

M
Martin Fuzzey 已提交
2512
static int __init usbtest_init(void)
L
Linus Torvalds 已提交
2513 2514 2515
{
#ifdef GENERIC
	if (vendor)
2516
		pr_debug("params: vend=0x%04x prod=0x%04x\n", vendor, product);
L
Linus Torvalds 已提交
2517
#endif
M
Martin Fuzzey 已提交
2518
	return usb_register(&usbtest_driver);
L
Linus Torvalds 已提交
2519
}
M
Martin Fuzzey 已提交
2520
module_init(usbtest_init);
L
Linus Torvalds 已提交
2521

M
Martin Fuzzey 已提交
2522
static void __exit usbtest_exit(void)
L
Linus Torvalds 已提交
2523
{
M
Martin Fuzzey 已提交
2524
	usb_deregister(&usbtest_driver);
L
Linus Torvalds 已提交
2525
}
M
Martin Fuzzey 已提交
2526
module_exit(usbtest_exit);
L
Linus Torvalds 已提交
2527

M
Martin Fuzzey 已提交
2528 2529
MODULE_DESCRIPTION("USB Core/HCD Testing Driver");
MODULE_LICENSE("GPL");
L
Linus Torvalds 已提交
2530