usbtest.c 64.6 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
{
	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;
107
		 * ignore other endpoints and altsettings.
L
Linus Torvalds 已提交
108 109 110 111 112 113 114 115 116 117 118
		 */
		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
static inline unsigned long buffer_offset(void *buf)
272
{
273
	return (unsigned long)buf & (ARCH_KMALLOC_MINALIGN - 1);
274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292
}

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
	unsigned long offset = buffer_offset(urb->transfer_buffer);
333 334 335 336 337 338 339 340 341

	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
		init_completion(&completion);
362
		if (usb_pipeout(urb->pipe)) {
M
Martin Fuzzey 已提交
363
			simple_fill_buf(urb);
364 365
			urb->transfer_flags |= URB_ZERO_PACKET;
		}
M
Martin Fuzzey 已提交
366 367
		retval = usb_submit_urb(urb, GFP_KERNEL);
		if (retval != 0)
L
Linus Torvalds 已提交
368 369 370
			break;

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

		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)
392
		dev_err(&udev->dev,
L
Linus Torvalds 已提交
393 394 395 396 397 398 399 400 401 402 403 404
			"%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 已提交
405
static void free_sglist(struct scatterlist *sg, int nents)
L
Linus Torvalds 已提交
406 407
{
	unsigned		i;
408

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

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

426
	sg = kmalloc_array(nents, sizeof *sg, GFP_KERNEL);
L
Linus Torvalds 已提交
427 428
	if (!sg)
		return NULL;
429
	sg_init_table(sg, nents);
L
Linus Torvalds 已提交
430 431 432

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

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

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

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

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

	return sg;
}

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

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

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

489 490
		/* FIXME check resulting data pattern */

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

M
Martin Fuzzey 已提交
494 495 496
	/* FIXME for unlink or fault handling tests, don't report
	 * failure if retval is as we expected ...
	 */
L
Linus Torvalds 已提交
497
	if (retval)
498 499
		ERROR(tdev, "perform_sglist failed, "
				"iterations left %d, status %d\n",
L
Linus Torvalds 已提交
500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519
				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 已提交
520 521
module_param(realworld, uint, 0);
MODULE_PARM_DESC(realworld, "clear to demand stricter spec compliance");
L
Linus Torvalds 已提交
522

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

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

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

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

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

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

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

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

M
Martin Fuzzey 已提交
587
	if (le16_to_cpu(config->wTotalLength) == len)	/* read it all */
L
Linus Torvalds 已提交
588
		return 1;
M
Martin Fuzzey 已提交
589
	if (le16_to_cpu(config->wTotalLength) >= TBUF_SIZE)	/* max partial read */
L
Linus Torvalds 已提交
590
		return 1;
591
	ERROR(tdev, "bogus config descriptor read size\n");
L
Linus Torvalds 已提交
592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609
	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 已提交
610
static int ch9_postconfig(struct usbtest_dev *dev)
L
Linus Torvalds 已提交
611 612
{
	struct usb_interface	*iface = dev->intf;
M
Martin Fuzzey 已提交
613
	struct usb_device	*udev = interface_to_usbdev(iface);
L
Linus Torvalds 已提交
614 615 616 617 618 619 620 621
	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 已提交
622
		alt = iface->altsetting[i].desc.bAlternateSetting;
L
Linus Torvalds 已提交
623
		if (alt < 0 || alt >= iface->num_altsetting) {
624
			dev_err(&iface->dev,
L
Linus Torvalds 已提交
625 626 627 628 629 630 631 632 633
					"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 已提交
634
		retval = set_altsetting(dev, alt);
L
Linus Torvalds 已提交
635
		if (retval) {
636
			dev_err(&iface->dev, "can't set_interface = %d, %d\n",
L
Linus Torvalds 已提交
637 638 639 640 641
					alt, retval);
			return retval;
		}

		/* [9.4.4] get_interface always works */
M
Martin Fuzzey 已提交
642
		retval = get_altsetting(dev);
L
Linus Torvalds 已提交
643
		if (retval != alt) {
644
			dev_err(&iface->dev, "get alt should be %d, was %d\n",
L
Linus Torvalds 已提交
645 646 647 648 649 650 651 652 653 654 655 656 657 658
					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 已提交
659
		retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
L
Linus Torvalds 已提交
660 661 662
				USB_REQ_GET_CONFIGURATION,
				USB_DIR_IN | USB_RECIP_DEVICE,
				0, 0, dev->buf, 1, USB_CTRL_GET_TIMEOUT);
M
Martin Fuzzey 已提交
663
		if (retval != 1 || dev->buf[0] != expected) {
664
			dev_err(&iface->dev, "get config --> %d %d (1 %d)\n",
D
David Brownell 已提交
665
				retval, dev->buf[0], expected);
L
Linus Torvalds 已提交
666 667 668 669 670
			return (retval < 0) ? retval : -EDOM;
		}
	}

	/* there's always [9.4.3] a device descriptor [9.6.1] */
M
Martin Fuzzey 已提交
671
	retval = usb_get_descriptor(udev, USB_DT_DEVICE, 0,
L
Linus Torvalds 已提交
672 673
			dev->buf, sizeof udev->descriptor);
	if (retval != sizeof udev->descriptor) {
674
		dev_err(&iface->dev, "dev descriptor --> %d\n", retval);
L
Linus Torvalds 已提交
675 676 677 678 679
		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 已提交
680
		retval = usb_get_descriptor(udev, USB_DT_CONFIG, i,
L
Linus Torvalds 已提交
681
				dev->buf, TBUF_SIZE);
682 683
		if (!is_good_config(dev, retval)) {
			dev_err(&iface->dev,
L
Linus Torvalds 已提交
684 685 686 687 688
					"config [%d] descriptor --> %d\n",
					i, retval);
			return (retval < 0) ? retval : -EDOM;
		}

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

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

		/* device qualifier [9.6.2] */
M
Martin Fuzzey 已提交
699
		retval = usb_get_descriptor(udev,
L
Linus Torvalds 已提交
700
				USB_DT_DEVICE_QUALIFIER, 0, dev->buf,
M
Martin Fuzzey 已提交
701
				sizeof(struct usb_qualifier_descriptor));
L
Linus Torvalds 已提交
702 703
		if (retval == -EPIPE) {
			if (udev->speed == USB_SPEED_HIGH) {
704
				dev_err(&iface->dev,
L
Linus Torvalds 已提交
705 706 707 708 709
						"hs dev qualifier --> %d\n",
						retval);
				return (retval < 0) ? retval : -EDOM;
			}
			/* usb2.0 but not high-speed capable; fine */
M
Martin Fuzzey 已提交
710
		} else if (retval != sizeof(struct usb_qualifier_descriptor)) {
711
			dev_err(&iface->dev, "dev qualifier --> %d\n", retval);
L
Linus Torvalds 已提交
712 713 714 715 716 717 718 719
			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 已提交
720
				retval = usb_get_descriptor(udev,
L
Linus Torvalds 已提交
721 722
					USB_DT_OTHER_SPEED_CONFIG, i,
					dev->buf, TBUF_SIZE);
723 724
				if (!is_good_config(dev, retval)) {
					dev_err(&iface->dev,
L
Linus Torvalds 已提交
725 726 727 728 729 730 731
						"other speed config --> %d\n",
						retval);
					return (retval < 0) ? retval : -EDOM;
				}
			}
		}
	}
M
Martin Fuzzey 已提交
732
	/* FIXME fetch strings from at least the device descriptor */
L
Linus Torvalds 已提交
733 734

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

M
Martin Fuzzey 已提交
741 742 743
	/* 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 已提交
744

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

L
Linus Torvalds 已提交
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 785 786
	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 已提交
787
static void ctrl_complete(struct urb *urb)
L
Linus Torvalds 已提交
788 789 790 791 792 793 794
{
	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 已提交
795
	subcase = container_of(reqp, struct subcase, setup);
L
Linus Torvalds 已提交
796

M
Martin Fuzzey 已提交
797
	spin_lock(&ctx->lock);
L
Linus Torvalds 已提交
798 799 800 801 802 803 804 805 806
	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) {
807 808 809
			ERROR(ctx->dev,
				"subcase %d completed out of order, last %d\n",
				subcase->number, ctx->last);
L
Linus Torvalds 已提交
810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825
			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 && (
826 827
			  ((status == -subcase->expected	/* happened */
			   || status == 0))))			/* didn't */
L
Linus Torvalds 已提交
828 829 830 831 832
			status = 0;
		/* sometimes more than one fault is allowed */
		else if (subcase->number == 12 && status == -EPIPE)
			status = 0;
		else
833
			ERROR(ctx->dev, "subtest %d error, status %d\n",
L
Linus Torvalds 已提交
834 835 836 837 838 839 840 841 842 843
					subcase->number, status);
	}

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

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

			/* 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 已提交
857 858 859
				struct urb *u = ctx->urb[
							(i + subcase->number)
							% ctx->param->sglen];
L
Linus Torvalds 已提交
860 861 862

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

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

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

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

907 908 909
	if (param->sglen == 0 || param->iterations > UINT_MAX / param->sglen)
		return -EOPNOTSUPP;

M
Martin Fuzzey 已提交
910
	spin_lock_init(&context.lock);
L
Linus Torvalds 已提交
911
	context.dev = dev;
M
Martin Fuzzey 已提交
912
	init_completion(&context.complete);
L
Linus Torvalds 已提交
913 914 915 916 917 918 919 920 921 922
	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.
	 */
923
	urb = kcalloc(param->sglen, sizeof(struct urb *), GFP_KERNEL);
L
Linus Torvalds 已提交
924 925 926
	if (!urb)
		return -ENOMEM;
	for (i = 0; i < param->sglen; i++) {
M
Martin Fuzzey 已提交
927
		int			pipe = usb_rcvctrlpipe(udev, 0);
L
Linus Torvalds 已提交
928 929 930 931
		unsigned		len;
		struct urb		*u;
		struct usb_ctrlrequest	req;
		struct subcase		*reqp;
932 933 934 935 936

		/* 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 已提交
937 938 939 940 941 942
		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 已提交
943
		memset(&req, 0, sizeof req);
L
Linus Torvalds 已提交
944 945 946 947
		req.bRequest = USB_REQ_GET_DESCRIPTOR;
		req.bRequestType = USB_DIR_IN|USB_RECIP_DEVICE;

		switch (i % NUM_SUBCASES) {
M
Martin Fuzzey 已提交
948 949 950
		case 0:		/* get device descriptor */
			req.wValue = cpu_to_le16(USB_DT_DEVICE << 8);
			len = sizeof(struct usb_device_descriptor);
L
Linus Torvalds 已提交
951
			break;
M
Martin Fuzzey 已提交
952 953 954
		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 已提交
955
			break;
M
Martin Fuzzey 已提交
956
		case 2:		/* get altsetting (OFTEN STALLS) */
L
Linus Torvalds 已提交
957 958
			req.bRequest = USB_REQ_GET_INTERFACE;
			req.bRequestType = USB_DIR_IN|USB_RECIP_INTERFACE;
M
Martin Fuzzey 已提交
959
			/* index = 0 means first interface */
L
Linus Torvalds 已提交
960 961 962
			len = 1;
			expected = EPIPE;
			break;
M
Martin Fuzzey 已提交
963
		case 3:		/* get interface status */
L
Linus Torvalds 已提交
964 965
			req.bRequest = USB_REQ_GET_STATUS;
			req.bRequestType = USB_DIR_IN|USB_RECIP_INTERFACE;
M
Martin Fuzzey 已提交
966
			/* interface 0 */
L
Linus Torvalds 已提交
967 968
			len = 2;
			break;
M
Martin Fuzzey 已提交
969
		case 4:		/* get device status */
L
Linus Torvalds 已提交
970 971 972 973
			req.bRequest = USB_REQ_GET_STATUS;
			req.bRequestType = USB_DIR_IN|USB_RECIP_DEVICE;
			len = 2;
			break;
M
Martin Fuzzey 已提交
974
		case 5:		/* get device qualifier (MAY STALL) */
L
Linus Torvalds 已提交
975
			req.wValue = cpu_to_le16 (USB_DT_DEVICE_QUALIFIER << 8);
M
Martin Fuzzey 已提交
976
			len = sizeof(struct usb_qualifier_descriptor);
L
Linus Torvalds 已提交
977 978 979
			if (udev->speed != USB_SPEED_HIGH)
				expected = EPIPE;
			break;
M
Martin Fuzzey 已提交
980 981 982 983
		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 已提交
984
			break;
M
Martin Fuzzey 已提交
985
		case 7:		/* get interface descriptor (ALWAYS STALLS) */
L
Linus Torvalds 已提交
986
			req.wValue = cpu_to_le16 (USB_DT_INTERFACE << 8);
M
Martin Fuzzey 已提交
987 988
			/* interface == 0 */
			len = sizeof(struct usb_interface_descriptor);
989
			expected = -EPIPE;
L
Linus Torvalds 已提交
990
			break;
M
Martin Fuzzey 已提交
991 992 993
		/* 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 已提交
994 995
			req.bRequest = USB_REQ_CLEAR_FEATURE;
			req.bRequestType = USB_RECIP_ENDPOINT;
M
Martin Fuzzey 已提交
996 997
			/* wValue 0 == ep halt */
			/* wIndex 0 == ep0 (shouldn't halt!) */
L
Linus Torvalds 已提交
998
			len = 0;
M
Martin Fuzzey 已提交
999
			pipe = usb_sndctrlpipe(udev, 0);
L
Linus Torvalds 已提交
1000 1001
			expected = EPIPE;
			break;
M
Martin Fuzzey 已提交
1002
		case 9:		/* get endpoint status */
L
Linus Torvalds 已提交
1003 1004
			req.bRequest = USB_REQ_GET_STATUS;
			req.bRequestType = USB_DIR_IN|USB_RECIP_ENDPOINT;
M
Martin Fuzzey 已提交
1005
			/* endpoint 0 */
L
Linus Torvalds 已提交
1006 1007
			len = 2;
			break;
M
Martin Fuzzey 已提交
1008 1009
		case 10:	/* trigger short read (EREMOTEIO) */
			req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
L
Linus Torvalds 已提交
1010 1011 1012
			len = 1024;
			expected = -EREMOTEIO;
			break;
M
Martin Fuzzey 已提交
1013 1014 1015 1016 1017
		/* 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 已提交
1018 1019
			expected = EPIPE;
			break;
M
Martin Fuzzey 已提交
1020 1021 1022 1023 1024 1025 1026
		/* 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 已提交
1027
			break;
M
Martin Fuzzey 已提交
1028 1029 1030
		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 已提交
1031 1032 1033
			len = 1024 - udev->descriptor.bMaxPacketSize0;
			expected = -EREMOTEIO;
			break;
M
Martin Fuzzey 已提交
1034 1035
		case 14:	/* short read; try to fill the last packet */
			req.wValue = cpu_to_le16((USB_DT_DEVICE << 8) | 0);
1036
			/* device descriptor size == 18 bytes */
L
Linus Torvalds 已提交
1037
			len = udev->descriptor.bMaxPacketSize0;
1038 1039
			if (udev->speed == USB_SPEED_SUPER)
				len = 512;
L
Linus Torvalds 已提交
1040
			switch (len) {
M
Martin Fuzzey 已提交
1041 1042 1043 1044 1045 1046
			case 8:
				len = 24;
				break;
			case 16:
				len = 32;
				break;
L
Linus Torvalds 已提交
1047 1048 1049 1050
			}
			expected = -EREMOTEIO;
			break;
		default:
1051
			ERROR(dev, "bogus number of ctrl queue testcases!\n");
L
Linus Torvalds 已提交
1052 1053 1054
			context.status = -EINVAL;
			goto cleanup;
		}
M
Martin Fuzzey 已提交
1055 1056
		req.wLength = cpu_to_le16(len);
		urb[i] = u = simple_alloc_urb(udev, pipe, len);
L
Linus Torvalds 已提交
1057 1058 1059
		if (!u)
			goto cleanup;

1060
		reqp = kmalloc(sizeof *reqp, GFP_KERNEL);
L
Linus Torvalds 已提交
1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073
		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 已提交
1074
	spin_lock_irq(&context.lock);
L
Linus Torvalds 已提交
1075
	for (i = 0; i < param->sglen; i++) {
M
Martin Fuzzey 已提交
1076
		context.status = usb_submit_urb(urb[i], GFP_ATOMIC);
L
Linus Torvalds 已提交
1077
		if (context.status != 0) {
1078
			ERROR(dev, "can't submit urb[%d], status %d\n",
L
Linus Torvalds 已提交
1079 1080 1081 1082 1083 1084
					i, context.status);
			context.count = context.pending;
			break;
		}
		context.pending++;
	}
M
Martin Fuzzey 已提交
1085
	spin_unlock_irq(&context.lock);
L
Linus Torvalds 已提交
1086 1087 1088 1089 1090

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

	/* wait for the last one to complete */
	if (context.pending > 0)
M
Martin Fuzzey 已提交
1091
		wait_for_completion(&context.complete);
L
Linus Torvalds 已提交
1092 1093 1094

cleanup:
	for (i = 0; i < param->sglen; i++) {
M
Martin Fuzzey 已提交
1095
		if (!urb[i])
L
Linus Torvalds 已提交
1096
			continue;
M
Martin Fuzzey 已提交
1097
		urb[i]->dev = udev;
1098
		kfree(urb[i]->setup_packet);
M
Martin Fuzzey 已提交
1099
		simple_free_urb(urb[i]);
L
Linus Torvalds 已提交
1100
	}
M
Martin Fuzzey 已提交
1101
	kfree(urb);
L
Linus Torvalds 已提交
1102 1103 1104 1105 1106 1107 1108
	return context.status;
}
#undef NUM_SUBCASES


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

M
Martin Fuzzey 已提交
1109
static void unlink1_callback(struct urb *urb)
L
Linus Torvalds 已提交
1110 1111 1112
{
	int	status = urb->status;

M
Martin Fuzzey 已提交
1113
	/* we "know" -EPIPE (stall) never happens */
L
Linus Torvalds 已提交
1114
	if (!status)
M
Martin Fuzzey 已提交
1115
		status = usb_submit_urb(urb, GFP_ATOMIC);
L
Linus Torvalds 已提交
1116 1117
	if (status) {
		urb->status = status;
1118
		complete(urb->context);
L
Linus Torvalds 已提交
1119 1120 1121
	}
}

M
Martin Fuzzey 已提交
1122
static int unlink1(struct usbtest_dev *dev, int pipe, int size, int async)
L
Linus Torvalds 已提交
1123 1124 1125 1126 1127
{
	struct urb		*urb;
	struct completion	completion;
	int			retval = 0;

M
Martin Fuzzey 已提交
1128 1129
	init_completion(&completion);
	urb = simple_alloc_urb(testdev_to_usbdev(dev), pipe, size);
L
Linus Torvalds 已提交
1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140
	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 已提交
1141 1142
	retval = usb_submit_urb(urb, GFP_KERNEL);
	if (retval != 0) {
1143
		dev_err(&dev->intf->dev, "submit fail %d\n", retval);
L
Linus Torvalds 已提交
1144 1145 1146 1147 1148 1149
		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 已提交
1150
	msleep(jiffies % (2 * INTERRUPT_RATE));
L
Linus Torvalds 已提交
1151
	if (async) {
1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176
		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 已提交
1177 1178
		}
	} else
M
Martin Fuzzey 已提交
1179
		usb_kill_urb(urb);
L
Linus Torvalds 已提交
1180

M
Martin Fuzzey 已提交
1181
	wait_for_completion(&completion);
L
Linus Torvalds 已提交
1182
	retval = urb->status;
M
Martin Fuzzey 已提交
1183
	simple_free_urb(urb);
L
Linus Torvalds 已提交
1184 1185 1186 1187 1188 1189 1190 1191

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

M
Martin Fuzzey 已提交
1192
static int unlink_simple(struct usbtest_dev *dev, int pipe, int len)
L
Linus Torvalds 已提交
1193 1194 1195 1196
{
	int			retval = 0;

	/* test sync and async paths */
M
Martin Fuzzey 已提交
1197
	retval = unlink1(dev, pipe, len, 1);
L
Linus Torvalds 已提交
1198
	if (!retval)
M
Martin Fuzzey 已提交
1199
		retval = unlink1(dev, pipe, len, 0);
L
Linus Torvalds 已提交
1200 1201 1202 1203 1204
	return retval;
}

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

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 1296 1297 1298 1299 1300 1301 1302
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;
}

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

1303
static int verify_not_halted(struct usbtest_dev *tdev, int ep, struct urb *urb)
L
Linus Torvalds 已提交
1304 1305 1306 1307 1308
{
	int	retval;
	u16	status;

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

1325
static int verify_halted(struct usbtest_dev *tdev, int ep, struct urb *urb)
L
Linus Torvalds 已提交
1326 1327 1328 1329 1330
{
	int	retval;
	u16	status;

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

1351
static int test_halt(struct usbtest_dev *tdev, int ep, struct urb *urb)
L
Linus Torvalds 已提交
1352 1353 1354 1355
{
	int	retval;

	/* shouldn't look or act halted now */
1356
	retval = verify_not_halted(tdev, ep, urb);
L
Linus Torvalds 已提交
1357 1358 1359 1360
	if (retval < 0)
		return retval;

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

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

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

	return 0;
}

M
Martin Fuzzey 已提交
1388
static int halt_simple(struct usbtest_dev *dev)
L
Linus Torvalds 已提交
1389 1390 1391 1392 1393
{
	int		ep;
	int		retval = 0;
	struct urb	*urb;

M
Martin Fuzzey 已提交
1394
	urb = simple_alloc_urb(testdev_to_usbdev(dev), 0, 512);
L
Linus Torvalds 已提交
1395 1396 1397 1398
	if (urb == NULL)
		return -ENOMEM;

	if (dev->in_pipe) {
M
Martin Fuzzey 已提交
1399
		ep = usb_pipeendpoint(dev->in_pipe) | USB_DIR_IN;
L
Linus Torvalds 已提交
1400
		urb->pipe = dev->in_pipe;
1401
		retval = test_halt(dev, ep, urb);
L
Linus Torvalds 已提交
1402 1403 1404 1405 1406
		if (retval < 0)
			goto done;
	}

	if (dev->out_pipe) {
M
Martin Fuzzey 已提交
1407
		ep = usb_pipeendpoint(dev->out_pipe);
L
Linus Torvalds 已提交
1408
		urb->pipe = dev->out_pipe;
1409
		retval = test_halt(dev, ep, urb);
L
Linus Torvalds 已提交
1410 1411
	}
done:
M
Martin Fuzzey 已提交
1412
	simple_free_urb(urb);
L
Linus Torvalds 已提交
1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425
	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 已提交
1426
static int ctrl_out(struct usbtest_dev *dev,
1427
		unsigned count, unsigned length, unsigned vary, unsigned offset)
L
Linus Torvalds 已提交
1428
{
1429 1430
	unsigned		i, j, len;
	int			retval;
L
Linus Torvalds 已提交
1431 1432 1433
	u8			*buf;
	char			*what = "?";
	struct usb_device	*udev;
1434

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

1438
	buf = kmalloc(length + offset, GFP_KERNEL);
L
Linus Torvalds 已提交
1439 1440 1441
	if (!buf)
		return -ENOMEM;

1442
	buf += offset;
M
Martin Fuzzey 已提交
1443
	udev = testdev_to_usbdev(dev);
L
Linus Torvalds 已提交
1444 1445 1446 1447 1448 1449 1450 1451 1452
	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 已提交
1453 1454
			buf[j] = i + j;
		retval = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
L
Linus Torvalds 已提交
1455 1456 1457 1458
				0x5b, USB_DIR_OUT|USB_TYPE_VENDOR,
				0, 0, buf, len, USB_CTRL_SET_TIMEOUT);
		if (retval != len) {
			what = "write";
D
David Brownell 已提交
1459
			if (retval >= 0) {
1460
				ERROR(dev, "ctrl_out, wlen %d (expected %d)\n",
D
David Brownell 已提交
1461 1462 1463
						retval, len);
				retval = -EBADMSG;
			}
L
Linus Torvalds 已提交
1464 1465 1466 1467
			break;
		}

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

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

		len += vary;
D
David Brownell 已提交
1496 1497

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

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

1509
	kfree(buf - offset);
L
Linus Torvalds 已提交
1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524
	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;
1525
	int			submit_error;
L
Linus Torvalds 已提交
1526
	unsigned long		errors;
1527
	unsigned long		packet_count;
L
Linus Torvalds 已提交
1528 1529 1530
	struct usbtest_dev	*dev;
};

M
Martin Fuzzey 已提交
1531
static void iso_callback(struct urb *urb)
L
Linus Torvalds 已提交
1532 1533 1534 1535 1536 1537
{
	struct iso_context	*ctx = urb->context;

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

1538
	ctx->packet_count += urb->number_of_packets;
L
Linus Torvalds 已提交
1539 1540
	if (urb->error_count > 0)
		ctx->errors += urb->error_count;
1541 1542
	else if (urb->status != 0)
		ctx->errors += urb->number_of_packets;
1543 1544
	else if (urb->actual_length != urb->transfer_buffer_length)
		ctx->errors++;
1545 1546
	else if (check_guard_bytes(ctx->dev, urb) != 0)
		ctx->errors++;
L
Linus Torvalds 已提交
1547

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

	ctx->pending--;
	if (ctx->pending == 0) {
		if (ctx->errors)
1569
			dev_err(&ctx->dev->intf->dev,
1570 1571
				"iso test, %lu errors out of %lu\n",
				ctx->errors, ctx->packet_count);
M
Martin Fuzzey 已提交
1572
		complete(&ctx->done);
L
Linus Torvalds 已提交
1573 1574 1575 1576 1577
	}
done:
	spin_unlock(&ctx->lock);
}

M
Martin Fuzzey 已提交
1578
static struct urb *iso_alloc_urb(
L
Linus Torvalds 已提交
1579 1580 1581
	struct usb_device	*udev,
	int			pipe,
	struct usb_endpoint_descriptor	*desc,
1582 1583
	long			bytes,
	unsigned offset
L
Linus Torvalds 已提交
1584 1585 1586 1587 1588 1589 1590
)
{
	struct urb		*urb;
	unsigned		i, maxp, packets;

	if (bytes < 0 || !desc)
		return NULL;
1591 1592
	maxp = 0x7ff & usb_endpoint_maxp(desc);
	maxp *= 1 + (0x3 & (usb_endpoint_maxp(desc) >> 11));
J
Julia Lawall 已提交
1593
	packets = DIV_ROUND_UP(bytes, maxp);
L
Linus Torvalds 已提交
1594

M
Martin Fuzzey 已提交
1595
	urb = usb_alloc_urb(packets, GFP_KERNEL);
L
Linus Torvalds 已提交
1596 1597 1598 1599 1600 1601 1602
	if (!urb)
		return urb;
	urb->dev = udev;
	urb->pipe = pipe;

	urb->number_of_packets = packets;
	urb->transfer_buffer_length = bytes;
1603 1604 1605
	urb->transfer_buffer = usb_alloc_coherent(udev, bytes + offset,
							GFP_KERNEL,
							&urb->transfer_dma);
L
Linus Torvalds 已提交
1606
	if (!urb->transfer_buffer) {
M
Martin Fuzzey 已提交
1607
		usb_free_urb(urb);
L
Linus Torvalds 已提交
1608 1609
		return NULL;
	}
1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620
	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 已提交
1621 1622
	for (i = 0; i < packets; i++) {
		/* here, only the last packet will be short */
M
Martin Fuzzey 已提交
1623
		urb->iso_frame_desc[i].length = min((unsigned) bytes, maxp);
L
Linus Torvalds 已提交
1624 1625 1626 1627 1628 1629
		bytes -= urb->iso_frame_desc[i].length;

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

	urb->complete = iso_callback;
M
Martin Fuzzey 已提交
1630
	/* urb->context = SET BY CALLER */
L
Linus Torvalds 已提交
1631 1632 1633 1634 1635 1636
	urb->interval = 1 << (desc->bInterval - 1);
	urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP;
	return urb;
}

static int
M
Martin Fuzzey 已提交
1637
test_iso_queue(struct usbtest_dev *dev, struct usbtest_param *param,
1638
		int pipe, struct usb_endpoint_descriptor *desc, unsigned offset)
L
Linus Torvalds 已提交
1639 1640 1641 1642 1643
{
	struct iso_context	context;
	struct usb_device	*udev;
	unsigned		i;
	unsigned long		packets = 0;
1644
	int			status = 0;
L
Linus Torvalds 已提交
1645 1646 1647 1648 1649
	struct urb		*urbs[10];	/* FIXME no limit */

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

1650
	memset(&context, 0, sizeof context);
L
Linus Torvalds 已提交
1651 1652
	context.count = param->iterations * param->sglen;
	context.dev = dev;
M
Martin Fuzzey 已提交
1653 1654
	init_completion(&context.done);
	spin_lock_init(&context.lock);
L
Linus Torvalds 已提交
1655

M
Martin Fuzzey 已提交
1656 1657
	memset(urbs, 0, sizeof urbs);
	udev = testdev_to_usbdev(dev);
1658
	dev_info(&dev->intf->dev,
L
Linus Torvalds 已提交
1659 1660 1661
		"... iso period %d %sframes, wMaxPacket %04x\n",
		1 << (desc->bInterval - 1),
		(udev->speed == USB_SPEED_HIGH) ? "micro" : "",
1662
		usb_endpoint_maxp(desc));
L
Linus Torvalds 已提交
1663 1664

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

M
Martin Fuzzey 已提交
1681
	spin_lock_irq(&context.lock);
L
Linus Torvalds 已提交
1682
	for (i = 0; i < param->sglen; i++) {
1683
		++context.pending;
M
Martin Fuzzey 已提交
1684
		status = usb_submit_urb(urbs[i], GFP_ATOMIC);
L
Linus Torvalds 已提交
1685
		if (status < 0) {
M
Martin Fuzzey 已提交
1686
			ERROR(dev, "submit iso[%d], error %d\n", i, status);
L
Linus Torvalds 已提交
1687
			if (i == 0) {
M
Martin Fuzzey 已提交
1688
				spin_unlock_irq(&context.lock);
L
Linus Torvalds 已提交
1689 1690 1691
				goto fail;
			}

M
Martin Fuzzey 已提交
1692
			simple_free_urb(urbs[i]);
1693
			urbs[i] = NULL;
L
Linus Torvalds 已提交
1694
			context.pending--;
1695 1696
			context.submit_error = 1;
			break;
L
Linus Torvalds 已提交
1697 1698
		}
	}
M
Martin Fuzzey 已提交
1699
	spin_unlock_irq(&context.lock);
L
Linus Torvalds 已提交
1700

M
Martin Fuzzey 已提交
1701
	wait_for_completion(&context.done);
1702

1703 1704 1705 1706
	for (i = 0; i < param->sglen; i++) {
		if (urbs[i])
			simple_free_urb(urbs[i]);
	}
1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718
	/*
	 * 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 已提交
1719 1720 1721

fail:
	for (i = 0; i < param->sglen; i++) {
M
Martin Fuzzey 已提交
1722 1723
		if (urbs[i])
			simple_free_urb(urbs[i]);
L
Linus Torvalds 已提交
1724 1725 1726 1727
	}
	return status;
}

1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747
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 已提交
1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761
/*-------------------------------------------------------------------------*/

/* 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.
1762 1763 1764 1765 1766 1767 1768
 *
 * 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 已提交
1769 1770 1771
 */

static int
M
Martin Fuzzey 已提交
1772
usbtest_ioctl(struct usb_interface *intf, unsigned int code, void *buf)
L
Linus Torvalds 已提交
1773
{
M
Martin Fuzzey 已提交
1774 1775
	struct usbtest_dev	*dev = usb_get_intfdata(intf);
	struct usb_device	*udev = testdev_to_usbdev(dev);
L
Linus Torvalds 已提交
1776 1777 1778 1779 1780 1781 1782 1783
	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 已提交
1784
	/* FIXME USBDEVFS_CONNECTINFO doesn't say how fast the device is. */
L
Linus Torvalds 已提交
1785

1786 1787
	pattern = mod_pattern;

L
Linus Torvalds 已提交
1788 1789 1790
	if (code != USBTEST_REQUEST)
		return -EOPNOTSUPP;

1791
	if (param->iterations <= 0)
L
Linus Torvalds 已提交
1792 1793
		return -EINVAL;

1794
	if (mutex_lock_interruptible(&dev->lock))
L
Linus Torvalds 已提交
1795 1796
		return -ERESTARTSYS;

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

L
Linus Torvalds 已提交
1799 1800 1801 1802 1803
	/* 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) {
1804
		int	res;
L
Linus Torvalds 已提交
1805 1806

		if (intf->altsetting->desc.bInterfaceNumber) {
1807
			mutex_unlock(&dev->lock);
L
Linus Torvalds 已提交
1808 1809
			return -ENODEV;
		}
M
Martin Fuzzey 已提交
1810
		res = set_altsetting(dev, dev->info->alt);
L
Linus Torvalds 已提交
1811
		if (res) {
M
Martin Fuzzey 已提交
1812
			dev_err(&intf->dev,
L
Linus Torvalds 已提交
1813 1814
					"set altsetting to %d failed, %d\n",
					dev->info->alt, res);
1815
			mutex_unlock(&dev->lock);
L
Linus Torvalds 已提交
1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828
			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 已提交
1829
	do_gettimeofday(&start);
L
Linus Torvalds 已提交
1830 1831 1832
	switch (param->test_num) {

	case 0:
1833
		dev_info(&intf->dev, "TEST 0:  NOP\n");
L
Linus Torvalds 已提交
1834 1835 1836 1837 1838 1839 1840
		retval = 0;
		break;

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

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

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

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

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

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

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

L
Linus Torvalds 已提交
2033
		if (retval)
2034
			ERROR(dev, "halts failed, iterations left %d\n", i);
L
Linus Torvalds 已提交
2035 2036 2037 2038 2039 2040
		break;

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

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

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

M
Martin Fuzzey 已提交
2075
	/* FIXME scatterlist cancel (needs helper thread) */
L
Linus Torvalds 已提交
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 2163 2164 2165 2166
	/* 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;

2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182 2183 2184 2185 2186
	/* 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 已提交
2187
	}
M
Martin Fuzzey 已提交
2188
	do_gettimeofday(&param->duration);
L
Linus Torvalds 已提交
2189 2190 2191 2192 2193 2194
	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;
	}
2195
	mutex_unlock(&dev->lock);
L
Linus Torvalds 已提交
2196 2197 2198 2199 2200
	return retval;
}

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

M
Martin Fuzzey 已提交
2201 2202 2203
static unsigned force_interrupt;
module_param(force_interrupt, uint, 0);
MODULE_PARM_DESC(force_interrupt, "0 = test default; else interrupt");
L
Linus Torvalds 已提交
2204 2205 2206 2207

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

static unsigned short product;
module_param(product, ushort, 0);
M
Martin Fuzzey 已提交
2212
MODULE_PARM_DESC(product, "product code (from vendor)");
L
Linus Torvalds 已提交
2213 2214 2215
#endif

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

M
Martin Fuzzey 已提交
2224
	udev = interface_to_usbdev(intf);
L
Linus Torvalds 已提交
2225 2226 2227 2228 2229 2230 2231 2232 2233

#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;
2234 2235
		dev_info(&intf->dev, "matched module params, "
					"vend=0x%04x prod=0x%04x\n",
L
Linus Torvalds 已提交
2236 2237 2238 2239 2240
				le16_to_cpu(udev->descriptor.idVendor),
				le16_to_cpu(udev->descriptor.idProduct));
	}
#endif

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

	dev->intf = intf;

	/* cacheline-aligned scratch for i/o */
M
Martin Fuzzey 已提交
2251 2252 2253
	dev->buf = kmalloc(TBUF_SIZE, GFP_KERNEL);
	if (dev->buf == NULL) {
		kfree(dev);
L
Linus Torvalds 已提交
2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264
		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 已提交
2265
			dev->in_pipe = usb_rcvintpipe(udev, info->ep_in);
L
Linus Torvalds 已提交
2266 2267 2268
			rtest = " intr-in";
		}
		if (info->ep_out) {
M
Martin Fuzzey 已提交
2269
			dev->out_pipe = usb_sndintpipe(udev, info->ep_out);
L
Linus Torvalds 已提交
2270 2271 2272 2273 2274 2275
			wtest = " intr-out";
		}
	} else {
		if (info->autoconf) {
			int status;

M
Martin Fuzzey 已提交
2276
			status = get_endpoints(dev, intf);
L
Linus Torvalds 已提交
2277
			if (status < 0) {
2278
				WARNING(dev, "couldn't get endpoints, %d\n",
2279
						status);
2280 2281
				kfree(dev->buf);
				kfree(dev);
L
Linus Torvalds 已提交
2282 2283 2284 2285 2286
				return status;
			}
			/* may find bulk or ISO pipes */
		} else {
			if (info->ep_in)
M
Martin Fuzzey 已提交
2287
				dev->in_pipe = usb_rcvbulkpipe(udev,
L
Linus Torvalds 已提交
2288 2289
							info->ep_in);
			if (info->ep_out)
M
Martin Fuzzey 已提交
2290
				dev->out_pipe = usb_sndbulkpipe(udev,
L
Linus Torvalds 已提交
2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302
							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 已提交
2303 2304
	usb_set_intfdata(intf, dev);
	dev_info(&intf->dev, "%s\n", info->name);
2305 2306
	dev_info(&intf->dev, "%s {control%s%s%s%s%s} tests%s\n",
			usb_speed_string(udev->speed),
L
Linus Torvalds 已提交
2307 2308 2309 2310 2311 2312 2313
			info->ctrl_out ? " in/out" : "",
			rtest, wtest,
			irtest, iwtest,
			info->alt >= 0 ? " (+alt)" : "");
	return 0;
}

M
Martin Fuzzey 已提交
2314
static int usbtest_suspend(struct usb_interface *intf, pm_message_t message)
D
David Brownell 已提交
2315 2316 2317 2318
{
	return 0;
}

M
Martin Fuzzey 已提交
2319
static int usbtest_resume(struct usb_interface *intf)
D
David Brownell 已提交
2320 2321 2322 2323 2324
{
	return 0;
}


M
Martin Fuzzey 已提交
2325
static void usbtest_disconnect(struct usb_interface *intf)
L
Linus Torvalds 已提交
2326
{
M
Martin Fuzzey 已提交
2327
	struct usbtest_dev	*dev = usb_get_intfdata(intf);
L
Linus Torvalds 已提交
2328

M
Martin Fuzzey 已提交
2329 2330 2331
	usb_set_intfdata(intf, NULL);
	dev_dbg(&intf->dev, "disconnect\n");
	kfree(dev);
L
Linus Torvalds 已提交
2332 2333 2334 2335 2336 2337 2338 2339 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
}

/* 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 已提交
2368
	.autoconf	= 1,		/* iso and ctrl_out need autoconf */
L
Linus Torvalds 已提交
2369
	.ctrl_out	= 1,
M
Martin Fuzzey 已提交
2370
	.iso		= 1,		/* iso_ep's are #8 in/out */
L
Linus Torvalds 已提交
2371 2372 2373 2374 2375 2376 2377 2378 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
};

/* 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


2418
static const struct usb_device_id id_table[] = {
L
Linus Torvalds 已提交
2419 2420 2421 2422 2423 2424 2425 2426

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

	/* 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 已提交
2427
	{ USB_DEVICE(0x0547, 0x2235),
L
Linus Torvalds 已提交
2428
		.driver_info = (unsigned long) &ez1_info,
M
Martin Fuzzey 已提交
2429
	},
L
Linus Torvalds 已提交
2430 2431

	/* CY3671 development board with EZ-USB FX */
M
Martin Fuzzey 已提交
2432
	{ USB_DEVICE(0x0547, 0x0080),
L
Linus Torvalds 已提交
2433
		.driver_info = (unsigned long) &ez1_info,
M
Martin Fuzzey 已提交
2434
	},
L
Linus Torvalds 已提交
2435 2436

	/* generic EZ-USB FX2 controller (or development board) */
M
Martin Fuzzey 已提交
2437
	{ USB_DEVICE(0x04b4, 0x8613),
L
Linus Torvalds 已提交
2438
		.driver_info = (unsigned long) &ez2_info,
M
Martin Fuzzey 已提交
2439
	},
L
Linus Torvalds 已提交
2440 2441

	/* re-enumerated usb test device firmware */
M
Martin Fuzzey 已提交
2442
	{ USB_DEVICE(0xfff0, 0xfff0),
L
Linus Torvalds 已提交
2443
		.driver_info = (unsigned long) &fw_info,
M
Martin Fuzzey 已提交
2444
	},
L
Linus Torvalds 已提交
2445 2446

	/* "Gadget Zero" firmware runs under Linux */
M
Martin Fuzzey 已提交
2447
	{ USB_DEVICE(0x0525, 0xa4a0),
L
Linus Torvalds 已提交
2448
		.driver_info = (unsigned long) &gz_info,
M
Martin Fuzzey 已提交
2449
	},
L
Linus Torvalds 已提交
2450 2451

	/* so does a user-mode variant */
M
Martin Fuzzey 已提交
2452
	{ USB_DEVICE(0x0525, 0xa4a4),
L
Linus Torvalds 已提交
2453
		.driver_info = (unsigned long) &um_info,
M
Martin Fuzzey 已提交
2454
	},
L
Linus Torvalds 已提交
2455 2456

	/* ... and a user-mode variant that talks iso */
M
Martin Fuzzey 已提交
2457
	{ USB_DEVICE(0x0525, 0xa4a3),
L
Linus Torvalds 已提交
2458
		.driver_info = (unsigned long) &um2_info,
M
Martin Fuzzey 已提交
2459
	},
L
Linus Torvalds 已提交
2460 2461 2462

#ifdef KEYSPAN_19Qi
	/* Keyspan 19qi uses an21xx (original EZ-USB) */
M
Martin Fuzzey 已提交
2463 2464
	/* this does not coexist with the real Keyspan 19qi driver! */
	{ USB_DEVICE(0x06cd, 0x010b),
L
Linus Torvalds 已提交
2465
		.driver_info = (unsigned long) &ez1_info,
M
Martin Fuzzey 已提交
2466
	},
L
Linus Torvalds 已提交
2467 2468 2469 2470 2471 2472
#endif

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

#ifdef IBOT2
	/* iBOT2 makes a nice source of high speed bulk-in data */
M
Martin Fuzzey 已提交
2473 2474
	/* this does not coexist with a real iBOT2 driver! */
	{ USB_DEVICE(0x0b62, 0x0059),
L
Linus Torvalds 已提交
2475
		.driver_info = (unsigned long) &ibot2_info,
M
Martin Fuzzey 已提交
2476
	},
L
Linus Torvalds 已提交
2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489
#endif

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

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

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

	{ }
};
M
Martin Fuzzey 已提交
2490
MODULE_DEVICE_TABLE(usb, id_table);
L
Linus Torvalds 已提交
2491 2492 2493 2494 2495

static struct usb_driver usbtest_driver = {
	.name =		"usbtest",
	.id_table =	id_table,
	.probe =	usbtest_probe,
2496
	.unlocked_ioctl = usbtest_ioctl,
L
Linus Torvalds 已提交
2497
	.disconnect =	usbtest_disconnect,
D
David Brownell 已提交
2498 2499
	.suspend =	usbtest_suspend,
	.resume =	usbtest_resume,
L
Linus Torvalds 已提交
2500 2501 2502 2503
};

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

M
Martin Fuzzey 已提交
2504
static int __init usbtest_init(void)
L
Linus Torvalds 已提交
2505 2506 2507
{
#ifdef GENERIC
	if (vendor)
2508
		pr_debug("params: vend=0x%04x prod=0x%04x\n", vendor, product);
L
Linus Torvalds 已提交
2509
#endif
M
Martin Fuzzey 已提交
2510
	return usb_register(&usbtest_driver);
L
Linus Torvalds 已提交
2511
}
M
Martin Fuzzey 已提交
2512
module_init(usbtest_init);
L
Linus Torvalds 已提交
2513

M
Martin Fuzzey 已提交
2514
static void __exit usbtest_exit(void)
L
Linus Torvalds 已提交
2515
{
M
Martin Fuzzey 已提交
2516
	usb_deregister(&usbtest_driver);
L
Linus Torvalds 已提交
2517
}
M
Martin Fuzzey 已提交
2518
module_exit(usbtest_exit);
L
Linus Torvalds 已提交
2519

M
Martin Fuzzey 已提交
2520 2521
MODULE_DESCRIPTION("USB Core/HCD Testing Driver");
MODULE_LICENSE("GPL");
L
Linus Torvalds 已提交
2522