0001
0002 #include <linux/kernel.h>
0003 #include <linux/errno.h>
0004 #include <linux/init.h>
0005 #include <linux/slab.h>
0006 #include <linux/mm.h>
0007 #include <linux/module.h>
0008 #include <linux/moduleparam.h>
0009 #include <linux/scatterlist.h>
0010 #include <linux/mutex.h>
0011 #include <linux/timer.h>
0012 #include <linux/usb.h>
0013
0014 #define SIMPLE_IO_TIMEOUT 10000
0015
0016
0017
0018 static int override_alt = -1;
0019 module_param_named(alt, override_alt, int, 0644);
0020 MODULE_PARM_DESC(alt, ">= 0 to override altsetting selection");
0021 static void complicated_callback(struct urb *urb);
0022
0023
0024
0025
0026
0027
0028 struct usbtest_param_32 {
0029
0030 __u32 test_num;
0031 __u32 iterations;
0032 __u32 length;
0033 __u32 vary;
0034 __u32 sglen;
0035
0036
0037 __s32 duration_sec;
0038 __s32 duration_usec;
0039 };
0040
0041
0042
0043
0044
0045 struct usbtest_param_64 {
0046
0047 __u32 test_num;
0048 __u32 iterations;
0049 __u32 length;
0050 __u32 vary;
0051 __u32 sglen;
0052
0053
0054 __s64 duration_sec;
0055 __s64 duration_usec;
0056 };
0057
0058
0059 #define USBTEST_REQUEST_32 _IOWR('U', 100, struct usbtest_param_32)
0060
0061 #define USBTEST_REQUEST_64 _IOWR('U', 100, struct usbtest_param_64)
0062
0063
0064
0065 #define GENERIC
0066
0067
0068
0069
0070
0071
0072
0073
0074
0075
0076 struct usbtest_info {
0077 const char *name;
0078 u8 ep_in;
0079 u8 ep_out;
0080 unsigned autoconf:1;
0081 unsigned ctrl_out:1;
0082 unsigned iso:1;
0083 unsigned intr:1;
0084 int alt;
0085 };
0086
0087
0088
0089
0090
0091
0092
0093 struct usbtest_dev {
0094 struct usb_interface *intf;
0095 struct usbtest_info *info;
0096 int in_pipe;
0097 int out_pipe;
0098 int in_iso_pipe;
0099 int out_iso_pipe;
0100 int in_int_pipe;
0101 int out_int_pipe;
0102 struct usb_endpoint_descriptor *iso_in, *iso_out;
0103 struct usb_endpoint_descriptor *int_in, *int_out;
0104 struct mutex lock;
0105
0106 #define TBUF_SIZE 256
0107 u8 *buf;
0108 };
0109
0110 static struct usb_device *testdev_to_usbdev(struct usbtest_dev *test)
0111 {
0112 return interface_to_usbdev(test->intf);
0113 }
0114
0115
0116 #define INTERRUPT_RATE 1
0117
0118 #define ERROR(tdev, fmt, args...) \
0119 dev_err(&(tdev)->intf->dev , fmt , ## args)
0120 #define WARNING(tdev, fmt, args...) \
0121 dev_warn(&(tdev)->intf->dev , fmt , ## args)
0122
0123 #define GUARD_BYTE 0xA5
0124 #define MAX_SGLEN 128
0125
0126
0127
0128 static inline void endpoint_update(int edi,
0129 struct usb_host_endpoint **in,
0130 struct usb_host_endpoint **out,
0131 struct usb_host_endpoint *e)
0132 {
0133 if (edi) {
0134 if (!*in)
0135 *in = e;
0136 } else {
0137 if (!*out)
0138 *out = e;
0139 }
0140 }
0141
0142 static int
0143 get_endpoints(struct usbtest_dev *dev, struct usb_interface *intf)
0144 {
0145 int tmp;
0146 struct usb_host_interface *alt;
0147 struct usb_host_endpoint *in, *out;
0148 struct usb_host_endpoint *iso_in, *iso_out;
0149 struct usb_host_endpoint *int_in, *int_out;
0150 struct usb_device *udev;
0151
0152 for (tmp = 0; tmp < intf->num_altsetting; tmp++) {
0153 unsigned ep;
0154
0155 in = out = NULL;
0156 iso_in = iso_out = NULL;
0157 int_in = int_out = NULL;
0158 alt = intf->altsetting + tmp;
0159
0160 if (override_alt >= 0 &&
0161 override_alt != alt->desc.bAlternateSetting)
0162 continue;
0163
0164
0165
0166
0167 for (ep = 0; ep < alt->desc.bNumEndpoints; ep++) {
0168 struct usb_host_endpoint *e;
0169 int edi;
0170
0171 e = alt->endpoint + ep;
0172 edi = usb_endpoint_dir_in(&e->desc);
0173
0174 switch (usb_endpoint_type(&e->desc)) {
0175 case USB_ENDPOINT_XFER_BULK:
0176 endpoint_update(edi, &in, &out, e);
0177 continue;
0178 case USB_ENDPOINT_XFER_INT:
0179 if (dev->info->intr)
0180 endpoint_update(edi, &int_in, &int_out, e);
0181 continue;
0182 case USB_ENDPOINT_XFER_ISOC:
0183 if (dev->info->iso)
0184 endpoint_update(edi, &iso_in, &iso_out, e);
0185 fallthrough;
0186 default:
0187 continue;
0188 }
0189 }
0190 if ((in && out) || iso_in || iso_out || int_in || int_out)
0191 goto found;
0192 }
0193 return -EINVAL;
0194
0195 found:
0196 udev = testdev_to_usbdev(dev);
0197 dev->info->alt = alt->desc.bAlternateSetting;
0198 if (alt->desc.bAlternateSetting != 0) {
0199 tmp = usb_set_interface(udev,
0200 alt->desc.bInterfaceNumber,
0201 alt->desc.bAlternateSetting);
0202 if (tmp < 0)
0203 return tmp;
0204 }
0205
0206 if (in)
0207 dev->in_pipe = usb_rcvbulkpipe(udev,
0208 in->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK);
0209 if (out)
0210 dev->out_pipe = usb_sndbulkpipe(udev,
0211 out->desc.bEndpointAddress & USB_ENDPOINT_NUMBER_MASK);
0212
0213 if (iso_in) {
0214 dev->iso_in = &iso_in->desc;
0215 dev->in_iso_pipe = usb_rcvisocpipe(udev,
0216 iso_in->desc.bEndpointAddress
0217 & USB_ENDPOINT_NUMBER_MASK);
0218 }
0219
0220 if (iso_out) {
0221 dev->iso_out = &iso_out->desc;
0222 dev->out_iso_pipe = usb_sndisocpipe(udev,
0223 iso_out->desc.bEndpointAddress
0224 & USB_ENDPOINT_NUMBER_MASK);
0225 }
0226
0227 if (int_in) {
0228 dev->int_in = &int_in->desc;
0229 dev->in_int_pipe = usb_rcvintpipe(udev,
0230 int_in->desc.bEndpointAddress
0231 & USB_ENDPOINT_NUMBER_MASK);
0232 }
0233
0234 if (int_out) {
0235 dev->int_out = &int_out->desc;
0236 dev->out_int_pipe = usb_sndintpipe(udev,
0237 int_out->desc.bEndpointAddress
0238 & USB_ENDPOINT_NUMBER_MASK);
0239 }
0240 return 0;
0241 }
0242
0243
0244
0245
0246
0247
0248
0249
0250
0251
0252 static void simple_callback(struct urb *urb)
0253 {
0254 complete(urb->context);
0255 }
0256
0257 static struct urb *usbtest_alloc_urb(
0258 struct usb_device *udev,
0259 int pipe,
0260 unsigned long bytes,
0261 unsigned transfer_flags,
0262 unsigned offset,
0263 u8 bInterval,
0264 usb_complete_t complete_fn)
0265 {
0266 struct urb *urb;
0267
0268 urb = usb_alloc_urb(0, GFP_KERNEL);
0269 if (!urb)
0270 return urb;
0271
0272 if (bInterval)
0273 usb_fill_int_urb(urb, udev, pipe, NULL, bytes, complete_fn,
0274 NULL, bInterval);
0275 else
0276 usb_fill_bulk_urb(urb, udev, pipe, NULL, bytes, complete_fn,
0277 NULL);
0278
0279 urb->interval = (udev->speed == USB_SPEED_HIGH)
0280 ? (INTERRUPT_RATE << 3)
0281 : INTERRUPT_RATE;
0282 urb->transfer_flags = transfer_flags;
0283 if (usb_pipein(pipe))
0284 urb->transfer_flags |= URB_SHORT_NOT_OK;
0285
0286 if ((bytes + offset) == 0)
0287 return urb;
0288
0289 if (urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP)
0290 urb->transfer_buffer = usb_alloc_coherent(udev, bytes + offset,
0291 GFP_KERNEL, &urb->transfer_dma);
0292 else
0293 urb->transfer_buffer = kmalloc(bytes + offset, GFP_KERNEL);
0294
0295 if (!urb->transfer_buffer) {
0296 usb_free_urb(urb);
0297 return NULL;
0298 }
0299
0300
0301
0302 if (offset) {
0303 memset(urb->transfer_buffer, GUARD_BYTE, offset);
0304 urb->transfer_buffer += offset;
0305 if (urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP)
0306 urb->transfer_dma += offset;
0307 }
0308
0309
0310
0311 memset(urb->transfer_buffer,
0312 usb_pipein(urb->pipe) ? GUARD_BYTE : 0,
0313 bytes);
0314 return urb;
0315 }
0316
0317 static struct urb *simple_alloc_urb(
0318 struct usb_device *udev,
0319 int pipe,
0320 unsigned long bytes,
0321 u8 bInterval)
0322 {
0323 return usbtest_alloc_urb(udev, pipe, bytes, URB_NO_TRANSFER_DMA_MAP, 0,
0324 bInterval, simple_callback);
0325 }
0326
0327 static struct urb *complicated_alloc_urb(
0328 struct usb_device *udev,
0329 int pipe,
0330 unsigned long bytes,
0331 u8 bInterval)
0332 {
0333 return usbtest_alloc_urb(udev, pipe, bytes, URB_NO_TRANSFER_DMA_MAP, 0,
0334 bInterval, complicated_callback);
0335 }
0336
0337 static unsigned pattern;
0338 static unsigned mod_pattern;
0339 module_param_named(pattern, mod_pattern, uint, S_IRUGO | S_IWUSR);
0340 MODULE_PARM_DESC(mod_pattern, "i/o pattern (0 == zeroes)");
0341
0342 static unsigned get_maxpacket(struct usb_device *udev, int pipe)
0343 {
0344 struct usb_host_endpoint *ep;
0345
0346 ep = usb_pipe_endpoint(udev, pipe);
0347 return le16_to_cpup(&ep->desc.wMaxPacketSize);
0348 }
0349
0350 static int ss_isoc_get_packet_num(struct usb_device *udev, int pipe)
0351 {
0352 struct usb_host_endpoint *ep = usb_pipe_endpoint(udev, pipe);
0353
0354 return USB_SS_MULT(ep->ss_ep_comp.bmAttributes)
0355 * (1 + ep->ss_ep_comp.bMaxBurst);
0356 }
0357
0358 static void simple_fill_buf(struct urb *urb)
0359 {
0360 unsigned i;
0361 u8 *buf = urb->transfer_buffer;
0362 unsigned len = urb->transfer_buffer_length;
0363 unsigned maxpacket;
0364
0365 switch (pattern) {
0366 default:
0367 fallthrough;
0368 case 0:
0369 memset(buf, 0, len);
0370 break;
0371 case 1:
0372 maxpacket = get_maxpacket(urb->dev, urb->pipe);
0373 for (i = 0; i < len; i++)
0374 *buf++ = (u8) ((i % maxpacket) % 63);
0375 break;
0376 }
0377 }
0378
0379 static inline unsigned long buffer_offset(void *buf)
0380 {
0381 return (unsigned long)buf & (ARCH_KMALLOC_MINALIGN - 1);
0382 }
0383
0384 static int check_guard_bytes(struct usbtest_dev *tdev, struct urb *urb)
0385 {
0386 u8 *buf = urb->transfer_buffer;
0387 u8 *guard = buf - buffer_offset(buf);
0388 unsigned i;
0389
0390 for (i = 0; guard < buf; i++, guard++) {
0391 if (*guard != GUARD_BYTE) {
0392 ERROR(tdev, "guard byte[%d] %d (not %d)\n",
0393 i, *guard, GUARD_BYTE);
0394 return -EINVAL;
0395 }
0396 }
0397 return 0;
0398 }
0399
0400 static int simple_check_buf(struct usbtest_dev *tdev, struct urb *urb)
0401 {
0402 unsigned i;
0403 u8 expected;
0404 u8 *buf = urb->transfer_buffer;
0405 unsigned len = urb->actual_length;
0406 unsigned maxpacket = get_maxpacket(urb->dev, urb->pipe);
0407
0408 int ret = check_guard_bytes(tdev, urb);
0409 if (ret)
0410 return ret;
0411
0412 for (i = 0; i < len; i++, buf++) {
0413 switch (pattern) {
0414
0415 case 0:
0416 expected = 0;
0417 break;
0418
0419
0420
0421
0422
0423 case 1:
0424 expected = (i % maxpacket) % 63;
0425 break;
0426
0427 default:
0428 expected = !*buf;
0429 break;
0430 }
0431 if (*buf == expected)
0432 continue;
0433 ERROR(tdev, "buf[%d] = %d (not %d)\n", i, *buf, expected);
0434 return -EINVAL;
0435 }
0436 return 0;
0437 }
0438
0439 static void simple_free_urb(struct urb *urb)
0440 {
0441 unsigned long offset = buffer_offset(urb->transfer_buffer);
0442
0443 if (urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP)
0444 usb_free_coherent(
0445 urb->dev,
0446 urb->transfer_buffer_length + offset,
0447 urb->transfer_buffer - offset,
0448 urb->transfer_dma - offset);
0449 else
0450 kfree(urb->transfer_buffer - offset);
0451 usb_free_urb(urb);
0452 }
0453
0454 static int simple_io(
0455 struct usbtest_dev *tdev,
0456 struct urb *urb,
0457 int iterations,
0458 int vary,
0459 int expected,
0460 const char *label
0461 )
0462 {
0463 struct usb_device *udev = urb->dev;
0464 int max = urb->transfer_buffer_length;
0465 struct completion completion;
0466 int retval = 0;
0467 unsigned long expire;
0468
0469 urb->context = &completion;
0470 while (retval == 0 && iterations-- > 0) {
0471 init_completion(&completion);
0472 if (usb_pipeout(urb->pipe)) {
0473 simple_fill_buf(urb);
0474 urb->transfer_flags |= URB_ZERO_PACKET;
0475 }
0476 retval = usb_submit_urb(urb, GFP_KERNEL);
0477 if (retval != 0)
0478 break;
0479
0480 expire = msecs_to_jiffies(SIMPLE_IO_TIMEOUT);
0481 if (!wait_for_completion_timeout(&completion, expire)) {
0482 usb_kill_urb(urb);
0483 retval = (urb->status == -ENOENT ?
0484 -ETIMEDOUT : urb->status);
0485 } else {
0486 retval = urb->status;
0487 }
0488
0489 urb->dev = udev;
0490 if (retval == 0 && usb_pipein(urb->pipe))
0491 retval = simple_check_buf(tdev, urb);
0492
0493 if (vary) {
0494 int len = urb->transfer_buffer_length;
0495
0496 len += vary;
0497 len %= max;
0498 if (len == 0)
0499 len = (vary < max) ? vary : max;
0500 urb->transfer_buffer_length = len;
0501 }
0502
0503
0504 }
0505 urb->transfer_buffer_length = max;
0506
0507 if (expected != retval)
0508 dev_err(&udev->dev,
0509 "%s failed, iterations left %d, status %d (not %d)\n",
0510 label, iterations, retval, expected);
0511 return retval;
0512 }
0513
0514
0515
0516
0517
0518
0519
0520
0521 static void free_sglist(struct scatterlist *sg, int nents)
0522 {
0523 unsigned i;
0524
0525 if (!sg)
0526 return;
0527 for (i = 0; i < nents; i++) {
0528 if (!sg_page(&sg[i]))
0529 continue;
0530 kfree(sg_virt(&sg[i]));
0531 }
0532 kfree(sg);
0533 }
0534
0535 static struct scatterlist *
0536 alloc_sglist(int nents, int max, int vary, struct usbtest_dev *dev, int pipe)
0537 {
0538 struct scatterlist *sg;
0539 unsigned int n_size = 0;
0540 unsigned i;
0541 unsigned size = max;
0542 unsigned maxpacket =
0543 get_maxpacket(interface_to_usbdev(dev->intf), pipe);
0544
0545 if (max == 0)
0546 return NULL;
0547
0548 sg = kmalloc_array(nents, sizeof(*sg), GFP_KERNEL);
0549 if (!sg)
0550 return NULL;
0551 sg_init_table(sg, nents);
0552
0553 for (i = 0; i < nents; i++) {
0554 char *buf;
0555 unsigned j;
0556
0557 buf = kzalloc(size, GFP_KERNEL);
0558 if (!buf) {
0559 free_sglist(sg, i);
0560 return NULL;
0561 }
0562
0563
0564 sg_set_buf(&sg[i], buf, size);
0565
0566 switch (pattern) {
0567 case 0:
0568
0569 break;
0570 case 1:
0571 for (j = 0; j < size; j++)
0572 *buf++ = (u8) (((j + n_size) % maxpacket) % 63);
0573 n_size += size;
0574 break;
0575 }
0576
0577 if (vary) {
0578 size += vary;
0579 size %= max;
0580 if (size == 0)
0581 size = (vary < max) ? vary : max;
0582 }
0583 }
0584
0585 return sg;
0586 }
0587
0588 struct sg_timeout {
0589 struct timer_list timer;
0590 struct usb_sg_request *req;
0591 };
0592
0593 static void sg_timeout(struct timer_list *t)
0594 {
0595 struct sg_timeout *timeout = from_timer(timeout, t, timer);
0596
0597 usb_sg_cancel(timeout->req);
0598 }
0599
0600 static int perform_sglist(
0601 struct usbtest_dev *tdev,
0602 unsigned iterations,
0603 int pipe,
0604 struct usb_sg_request *req,
0605 struct scatterlist *sg,
0606 int nents
0607 )
0608 {
0609 struct usb_device *udev = testdev_to_usbdev(tdev);
0610 int retval = 0;
0611 struct sg_timeout timeout = {
0612 .req = req,
0613 };
0614
0615 timer_setup_on_stack(&timeout.timer, sg_timeout, 0);
0616
0617 while (retval == 0 && iterations-- > 0) {
0618 retval = usb_sg_init(req, udev, pipe,
0619 (udev->speed == USB_SPEED_HIGH)
0620 ? (INTERRUPT_RATE << 3)
0621 : INTERRUPT_RATE,
0622 sg, nents, 0, GFP_KERNEL);
0623
0624 if (retval)
0625 break;
0626 mod_timer(&timeout.timer, jiffies +
0627 msecs_to_jiffies(SIMPLE_IO_TIMEOUT));
0628 usb_sg_wait(req);
0629 if (!del_timer_sync(&timeout.timer))
0630 retval = -ETIMEDOUT;
0631 else
0632 retval = req->status;
0633 destroy_timer_on_stack(&timeout.timer);
0634
0635
0636
0637
0638 }
0639
0640
0641
0642
0643 if (retval)
0644 ERROR(tdev, "perform_sglist failed, "
0645 "iterations left %d, status %d\n",
0646 iterations, retval);
0647 return retval;
0648 }
0649
0650
0651
0652
0653
0654
0655
0656
0657
0658
0659
0660
0661
0662
0663
0664
0665 static unsigned realworld = 1;
0666 module_param(realworld, uint, 0);
0667 MODULE_PARM_DESC(realworld, "clear to demand stricter spec compliance");
0668
0669 static int get_altsetting(struct usbtest_dev *dev)
0670 {
0671 struct usb_interface *iface = dev->intf;
0672 struct usb_device *udev = interface_to_usbdev(iface);
0673 int retval;
0674
0675 retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
0676 USB_REQ_GET_INTERFACE, USB_DIR_IN|USB_RECIP_INTERFACE,
0677 0, iface->altsetting[0].desc.bInterfaceNumber,
0678 dev->buf, 1, USB_CTRL_GET_TIMEOUT);
0679 switch (retval) {
0680 case 1:
0681 return dev->buf[0];
0682 case 0:
0683 retval = -ERANGE;
0684 fallthrough;
0685 default:
0686 return retval;
0687 }
0688 }
0689
0690 static int set_altsetting(struct usbtest_dev *dev, int alternate)
0691 {
0692 struct usb_interface *iface = dev->intf;
0693 struct usb_device *udev;
0694
0695 if (alternate < 0 || alternate >= 256)
0696 return -EINVAL;
0697
0698 udev = interface_to_usbdev(iface);
0699 return usb_set_interface(udev,
0700 iface->altsetting[0].desc.bInterfaceNumber,
0701 alternate);
0702 }
0703
0704 static int is_good_config(struct usbtest_dev *tdev, int len)
0705 {
0706 struct usb_config_descriptor *config;
0707
0708 if (len < sizeof(*config))
0709 return 0;
0710 config = (struct usb_config_descriptor *) tdev->buf;
0711
0712 switch (config->bDescriptorType) {
0713 case USB_DT_CONFIG:
0714 case USB_DT_OTHER_SPEED_CONFIG:
0715 if (config->bLength != 9) {
0716 ERROR(tdev, "bogus config descriptor length\n");
0717 return 0;
0718 }
0719
0720 if (!realworld && !(config->bmAttributes & 0x80)) {
0721 ERROR(tdev, "high bit of config attributes not set\n");
0722 return 0;
0723 }
0724 if (config->bmAttributes & 0x1f) {
0725 ERROR(tdev, "reserved config bits set\n");
0726 return 0;
0727 }
0728 break;
0729 default:
0730 return 0;
0731 }
0732
0733 if (le16_to_cpu(config->wTotalLength) == len)
0734 return 1;
0735 if (le16_to_cpu(config->wTotalLength) >= TBUF_SIZE)
0736 return 1;
0737 ERROR(tdev, "bogus config descriptor read size\n");
0738 return 0;
0739 }
0740
0741 static int is_good_ext(struct usbtest_dev *tdev, u8 *buf)
0742 {
0743 struct usb_ext_cap_descriptor *ext;
0744 u32 attr;
0745
0746 ext = (struct usb_ext_cap_descriptor *) buf;
0747
0748 if (ext->bLength != USB_DT_USB_EXT_CAP_SIZE) {
0749 ERROR(tdev, "bogus usb 2.0 extension descriptor length\n");
0750 return 0;
0751 }
0752
0753 attr = le32_to_cpu(ext->bmAttributes);
0754
0755 if (attr & ~0xfffe) {
0756 ERROR(tdev, "reserved bits set\n");
0757 return 0;
0758 }
0759
0760 return 1;
0761 }
0762
0763 static int is_good_ss_cap(struct usbtest_dev *tdev, u8 *buf)
0764 {
0765 struct usb_ss_cap_descriptor *ss;
0766
0767 ss = (struct usb_ss_cap_descriptor *) buf;
0768
0769 if (ss->bLength != USB_DT_USB_SS_CAP_SIZE) {
0770 ERROR(tdev, "bogus superspeed device capability descriptor length\n");
0771 return 0;
0772 }
0773
0774
0775
0776
0777
0778 if (ss->bmAttributes & ~0x02) {
0779 ERROR(tdev, "reserved bits set in bmAttributes\n");
0780 return 0;
0781 }
0782
0783
0784 if (le16_to_cpu(ss->wSpeedSupported) & ~0x0f) {
0785 ERROR(tdev, "reserved bits set in wSpeedSupported\n");
0786 return 0;
0787 }
0788
0789 return 1;
0790 }
0791
0792 static int is_good_con_id(struct usbtest_dev *tdev, u8 *buf)
0793 {
0794 struct usb_ss_container_id_descriptor *con_id;
0795
0796 con_id = (struct usb_ss_container_id_descriptor *) buf;
0797
0798 if (con_id->bLength != USB_DT_USB_SS_CONTN_ID_SIZE) {
0799 ERROR(tdev, "bogus container id descriptor length\n");
0800 return 0;
0801 }
0802
0803 if (con_id->bReserved) {
0804 ERROR(tdev, "reserved bits set\n");
0805 return 0;
0806 }
0807
0808 return 1;
0809 }
0810
0811
0812
0813
0814
0815
0816
0817
0818
0819
0820
0821
0822
0823
0824
0825
0826 static int ch9_postconfig(struct usbtest_dev *dev)
0827 {
0828 struct usb_interface *iface = dev->intf;
0829 struct usb_device *udev = interface_to_usbdev(iface);
0830 int i, alt, retval;
0831
0832
0833
0834
0835 for (i = 0; i < iface->num_altsetting; i++) {
0836
0837
0838 alt = iface->altsetting[i].desc.bAlternateSetting;
0839 if (alt < 0 || alt >= iface->num_altsetting) {
0840 dev_err(&iface->dev,
0841 "invalid alt [%d].bAltSetting = %d\n",
0842 i, alt);
0843 }
0844
0845
0846 if (realworld && iface->num_altsetting == 1)
0847 continue;
0848
0849
0850 retval = set_altsetting(dev, alt);
0851 if (retval) {
0852 dev_err(&iface->dev, "can't set_interface = %d, %d\n",
0853 alt, retval);
0854 return retval;
0855 }
0856
0857
0858 retval = get_altsetting(dev);
0859 if (retval != alt) {
0860 dev_err(&iface->dev, "get alt should be %d, was %d\n",
0861 alt, retval);
0862 return (retval < 0) ? retval : -EDOM;
0863 }
0864
0865 }
0866
0867
0868 if (!realworld || udev->descriptor.bNumConfigurations != 1) {
0869 int expected = udev->actconfig->desc.bConfigurationValue;
0870
0871
0872
0873
0874
0875 retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
0876 USB_REQ_GET_CONFIGURATION,
0877 USB_DIR_IN | USB_RECIP_DEVICE,
0878 0, 0, dev->buf, 1, USB_CTRL_GET_TIMEOUT);
0879 if (retval != 1 || dev->buf[0] != expected) {
0880 dev_err(&iface->dev, "get config --> %d %d (1 %d)\n",
0881 retval, dev->buf[0], expected);
0882 return (retval < 0) ? retval : -EDOM;
0883 }
0884 }
0885
0886
0887 retval = usb_get_descriptor(udev, USB_DT_DEVICE, 0,
0888 dev->buf, sizeof(udev->descriptor));
0889 if (retval != sizeof(udev->descriptor)) {
0890 dev_err(&iface->dev, "dev descriptor --> %d\n", retval);
0891 return (retval < 0) ? retval : -EDOM;
0892 }
0893
0894
0895
0896
0897
0898 if (le16_to_cpu(udev->descriptor.bcdUSB) >= 0x0210) {
0899 struct usb_bos_descriptor *bos = NULL;
0900 struct usb_dev_cap_header *header = NULL;
0901 unsigned total, num, length;
0902 u8 *buf;
0903
0904 retval = usb_get_descriptor(udev, USB_DT_BOS, 0, dev->buf,
0905 sizeof(*udev->bos->desc));
0906 if (retval != sizeof(*udev->bos->desc)) {
0907 dev_err(&iface->dev, "bos descriptor --> %d\n", retval);
0908 return (retval < 0) ? retval : -EDOM;
0909 }
0910
0911 bos = (struct usb_bos_descriptor *)dev->buf;
0912 total = le16_to_cpu(bos->wTotalLength);
0913 num = bos->bNumDeviceCaps;
0914
0915 if (total > TBUF_SIZE)
0916 total = TBUF_SIZE;
0917
0918
0919
0920
0921
0922 retval = usb_get_descriptor(udev, USB_DT_BOS, 0, dev->buf,
0923 total);
0924 if (retval != total) {
0925 dev_err(&iface->dev, "bos descriptor set --> %d\n",
0926 retval);
0927 return (retval < 0) ? retval : -EDOM;
0928 }
0929
0930 length = sizeof(*udev->bos->desc);
0931 buf = dev->buf;
0932 for (i = 0; i < num; i++) {
0933 buf += length;
0934 if (buf + sizeof(struct usb_dev_cap_header) >
0935 dev->buf + total)
0936 break;
0937
0938 header = (struct usb_dev_cap_header *)buf;
0939 length = header->bLength;
0940
0941 if (header->bDescriptorType !=
0942 USB_DT_DEVICE_CAPABILITY) {
0943 dev_warn(&udev->dev, "not device capability descriptor, skip\n");
0944 continue;
0945 }
0946
0947 switch (header->bDevCapabilityType) {
0948 case USB_CAP_TYPE_EXT:
0949 if (buf + USB_DT_USB_EXT_CAP_SIZE >
0950 dev->buf + total ||
0951 !is_good_ext(dev, buf)) {
0952 dev_err(&iface->dev, "bogus usb 2.0 extension descriptor\n");
0953 return -EDOM;
0954 }
0955 break;
0956 case USB_SS_CAP_TYPE:
0957 if (buf + USB_DT_USB_SS_CAP_SIZE >
0958 dev->buf + total ||
0959 !is_good_ss_cap(dev, buf)) {
0960 dev_err(&iface->dev, "bogus superspeed device capability descriptor\n");
0961 return -EDOM;
0962 }
0963 break;
0964 case CONTAINER_ID_TYPE:
0965 if (buf + USB_DT_USB_SS_CONTN_ID_SIZE >
0966 dev->buf + total ||
0967 !is_good_con_id(dev, buf)) {
0968 dev_err(&iface->dev, "bogus container id descriptor\n");
0969 return -EDOM;
0970 }
0971 break;
0972 default:
0973 break;
0974 }
0975 }
0976 }
0977
0978
0979 for (i = 0; i < udev->descriptor.bNumConfigurations; i++) {
0980 retval = usb_get_descriptor(udev, USB_DT_CONFIG, i,
0981 dev->buf, TBUF_SIZE);
0982 if (!is_good_config(dev, retval)) {
0983 dev_err(&iface->dev,
0984 "config [%d] descriptor --> %d\n",
0985 i, retval);
0986 return (retval < 0) ? retval : -EDOM;
0987 }
0988
0989
0990
0991
0992 }
0993
0994
0995 if (le16_to_cpu(udev->descriptor.bcdUSB) == 0x0200) {
0996 struct usb_qualifier_descriptor *d = NULL;
0997
0998
0999 retval = usb_get_descriptor(udev,
1000 USB_DT_DEVICE_QUALIFIER, 0, dev->buf,
1001 sizeof(struct usb_qualifier_descriptor));
1002 if (retval == -EPIPE) {
1003 if (udev->speed == USB_SPEED_HIGH) {
1004 dev_err(&iface->dev,
1005 "hs dev qualifier --> %d\n",
1006 retval);
1007 return retval;
1008 }
1009
1010 } else if (retval != sizeof(struct usb_qualifier_descriptor)) {
1011 dev_err(&iface->dev, "dev qualifier --> %d\n", retval);
1012 return (retval < 0) ? retval : -EDOM;
1013 } else
1014 d = (struct usb_qualifier_descriptor *) dev->buf;
1015
1016
1017 if (d) {
1018 unsigned max = d->bNumConfigurations;
1019 for (i = 0; i < max; i++) {
1020 retval = usb_get_descriptor(udev,
1021 USB_DT_OTHER_SPEED_CONFIG, i,
1022 dev->buf, TBUF_SIZE);
1023 if (!is_good_config(dev, retval)) {
1024 dev_err(&iface->dev,
1025 "other speed config --> %d\n",
1026 retval);
1027 return (retval < 0) ? retval : -EDOM;
1028 }
1029 }
1030 }
1031 }
1032
1033
1034
1035 retval = usb_get_std_status(udev, USB_RECIP_DEVICE, 0, dev->buf);
1036 if (retval) {
1037 dev_err(&iface->dev, "get dev status --> %d\n", retval);
1038 return retval;
1039 }
1040
1041
1042
1043
1044
1045 retval = usb_get_std_status(udev, USB_RECIP_INTERFACE,
1046 iface->altsetting[0].desc.bInterfaceNumber, dev->buf);
1047 if (retval) {
1048 dev_err(&iface->dev, "get interface status --> %d\n", retval);
1049 return retval;
1050 }
1051
1052
1053 return 0;
1054 }
1055
1056
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066
1067 struct ctrl_ctx {
1068 spinlock_t lock;
1069 struct usbtest_dev *dev;
1070 struct completion complete;
1071 unsigned count;
1072 unsigned pending;
1073 int status;
1074 struct urb **urb;
1075 struct usbtest_param_32 *param;
1076 int last;
1077 };
1078
1079 #define NUM_SUBCASES 16
1080
1081 struct subcase {
1082 struct usb_ctrlrequest setup;
1083 int number;
1084 int expected;
1085 };
1086
1087 static void ctrl_complete(struct urb *urb)
1088 {
1089 struct ctrl_ctx *ctx = urb->context;
1090 struct usb_ctrlrequest *reqp;
1091 struct subcase *subcase;
1092 int status = urb->status;
1093 unsigned long flags;
1094
1095 reqp = (struct usb_ctrlrequest *)urb->setup_packet;
1096 subcase = container_of(reqp, struct subcase, setup);
1097
1098 spin_lock_irqsave(&ctx->lock, flags);
1099 ctx->count--;
1100 ctx->pending--;
1101
1102
1103
1104
1105
1106 if (subcase->number > 0) {
1107 if ((subcase->number - ctx->last) != 1) {
1108 ERROR(ctx->dev,
1109 "subcase %d completed out of order, last %d\n",
1110 subcase->number, ctx->last);
1111 status = -EDOM;
1112 ctx->last = subcase->number;
1113 goto error;
1114 }
1115 }
1116 ctx->last = subcase->number;
1117
1118
1119 if (status == subcase->expected)
1120 status = 0;
1121
1122
1123 else if (status != -ECONNRESET) {
1124
1125
1126 if (subcase->expected > 0 && (
1127 ((status == -subcase->expected
1128 || status == 0))))
1129 status = 0;
1130
1131 else if (subcase->number == 12 && status == -EPIPE)
1132 status = 0;
1133 else
1134 ERROR(ctx->dev, "subtest %d error, status %d\n",
1135 subcase->number, status);
1136 }
1137
1138
1139 if (status) {
1140 error:
1141 if (ctx->status == 0) {
1142 int i;
1143
1144 ctx->status = status;
1145 ERROR(ctx->dev, "control queue %02x.%02x, err %d, "
1146 "%d left, subcase %d, len %d/%d\n",
1147 reqp->bRequestType, reqp->bRequest,
1148 status, ctx->count, subcase->number,
1149 urb->actual_length,
1150 urb->transfer_buffer_length);
1151
1152
1153
1154
1155
1156
1157 for (i = 1; i < ctx->param->sglen; i++) {
1158 struct urb *u = ctx->urb[
1159 (i + subcase->number)
1160 % ctx->param->sglen];
1161
1162 if (u == urb || !u->dev)
1163 continue;
1164 spin_unlock(&ctx->lock);
1165 status = usb_unlink_urb(u);
1166 spin_lock(&ctx->lock);
1167 switch (status) {
1168 case -EINPROGRESS:
1169 case -EBUSY:
1170 case -EIDRM:
1171 continue;
1172 default:
1173 ERROR(ctx->dev, "urb unlink --> %d\n",
1174 status);
1175 }
1176 }
1177 status = ctx->status;
1178 }
1179 }
1180
1181
1182 if ((status == 0) && (ctx->pending < ctx->count)) {
1183 status = usb_submit_urb(urb, GFP_ATOMIC);
1184 if (status != 0) {
1185 ERROR(ctx->dev,
1186 "can't resubmit ctrl %02x.%02x, err %d\n",
1187 reqp->bRequestType, reqp->bRequest, status);
1188 urb->dev = NULL;
1189 } else
1190 ctx->pending++;
1191 } else
1192 urb->dev = NULL;
1193
1194
1195 if (ctx->pending == 0)
1196 complete(&ctx->complete);
1197 spin_unlock_irqrestore(&ctx->lock, flags);
1198 }
1199
1200 static int
1201 test_ctrl_queue(struct usbtest_dev *dev, struct usbtest_param_32 *param)
1202 {
1203 struct usb_device *udev = testdev_to_usbdev(dev);
1204 struct urb **urb;
1205 struct ctrl_ctx context;
1206 int i;
1207
1208 if (param->sglen == 0 || param->iterations > UINT_MAX / param->sglen)
1209 return -EOPNOTSUPP;
1210
1211 spin_lock_init(&context.lock);
1212 context.dev = dev;
1213 init_completion(&context.complete);
1214 context.count = param->sglen * param->iterations;
1215 context.pending = 0;
1216 context.status = -ENOMEM;
1217 context.param = param;
1218 context.last = -1;
1219
1220
1221
1222
1223
1224 urb = kcalloc(param->sglen, sizeof(struct urb *), GFP_KERNEL);
1225 if (!urb)
1226 return -ENOMEM;
1227 for (i = 0; i < param->sglen; i++) {
1228 int pipe = usb_rcvctrlpipe(udev, 0);
1229 unsigned len;
1230 struct urb *u;
1231 struct usb_ctrlrequest req;
1232 struct subcase *reqp;
1233
1234
1235
1236
1237
1238 int expected = 0;
1239
1240
1241
1242
1243
1244 memset(&req, 0, sizeof(req));
1245 req.bRequest = USB_REQ_GET_DESCRIPTOR;
1246 req.bRequestType = USB_DIR_IN|USB_RECIP_DEVICE;
1247
1248 switch (i % NUM_SUBCASES) {
1249 case 0:
1250 req.wValue = cpu_to_le16(USB_DT_DEVICE << 8);
1251 len = sizeof(struct usb_device_descriptor);
1252 break;
1253 case 1:
1254 req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
1255 len = sizeof(struct usb_config_descriptor);
1256 break;
1257 case 2:
1258 req.bRequest = USB_REQ_GET_INTERFACE;
1259 req.bRequestType = USB_DIR_IN|USB_RECIP_INTERFACE;
1260
1261 len = 1;
1262 expected = EPIPE;
1263 break;
1264 case 3:
1265 req.bRequest = USB_REQ_GET_STATUS;
1266 req.bRequestType = USB_DIR_IN|USB_RECIP_INTERFACE;
1267
1268 len = 2;
1269 break;
1270 case 4:
1271 req.bRequest = USB_REQ_GET_STATUS;
1272 req.bRequestType = USB_DIR_IN|USB_RECIP_DEVICE;
1273 len = 2;
1274 break;
1275 case 5:
1276 req.wValue = cpu_to_le16 (USB_DT_DEVICE_QUALIFIER << 8);
1277 len = sizeof(struct usb_qualifier_descriptor);
1278 if (udev->speed != USB_SPEED_HIGH)
1279 expected = EPIPE;
1280 break;
1281 case 6:
1282 req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
1283 len = sizeof(struct usb_config_descriptor);
1284 len += sizeof(struct usb_interface_descriptor);
1285 break;
1286 case 7:
1287 req.wValue = cpu_to_le16 (USB_DT_INTERFACE << 8);
1288
1289 len = sizeof(struct usb_interface_descriptor);
1290 expected = -EPIPE;
1291 break;
1292
1293
1294 case 8:
1295 req.bRequest = USB_REQ_CLEAR_FEATURE;
1296 req.bRequestType = USB_RECIP_ENDPOINT;
1297
1298
1299 len = 0;
1300 pipe = usb_sndctrlpipe(udev, 0);
1301 expected = EPIPE;
1302 break;
1303 case 9:
1304 req.bRequest = USB_REQ_GET_STATUS;
1305 req.bRequestType = USB_DIR_IN|USB_RECIP_ENDPOINT;
1306
1307 len = 2;
1308 break;
1309 case 10:
1310 req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
1311 len = 1024;
1312 expected = -EREMOTEIO;
1313 break;
1314
1315 case 11:
1316 req.wValue = cpu_to_le16(USB_DT_ENDPOINT << 8);
1317
1318 len = sizeof(struct usb_interface_descriptor);
1319 expected = EPIPE;
1320 break;
1321
1322 case 12:
1323 req.wValue = cpu_to_le16(USB_DT_STRING << 8);
1324
1325 len = sizeof(struct usb_interface_descriptor);
1326
1327 expected = EREMOTEIO;
1328 break;
1329 case 13:
1330 req.wValue = cpu_to_le16((USB_DT_CONFIG << 8) | 0);
1331
1332 if (udev->speed == USB_SPEED_SUPER)
1333 len = 1024 - 512;
1334 else
1335 len = 1024 - udev->descriptor.bMaxPacketSize0;
1336 expected = -EREMOTEIO;
1337 break;
1338 case 14:
1339 req.wValue = cpu_to_le16((USB_DT_DEVICE << 8) | 0);
1340
1341 len = udev->descriptor.bMaxPacketSize0;
1342 if (udev->speed == USB_SPEED_SUPER)
1343 len = 512;
1344 switch (len) {
1345 case 8:
1346 len = 24;
1347 break;
1348 case 16:
1349 len = 32;
1350 break;
1351 }
1352 expected = -EREMOTEIO;
1353 break;
1354 case 15:
1355 req.wValue = cpu_to_le16(USB_DT_BOS << 8);
1356 if (udev->bos)
1357 len = le16_to_cpu(udev->bos->desc->wTotalLength);
1358 else
1359 len = sizeof(struct usb_bos_descriptor);
1360 if (le16_to_cpu(udev->descriptor.bcdUSB) < 0x0201)
1361 expected = -EPIPE;
1362 break;
1363 default:
1364 ERROR(dev, "bogus number of ctrl queue testcases!\n");
1365 context.status = -EINVAL;
1366 goto cleanup;
1367 }
1368 req.wLength = cpu_to_le16(len);
1369 urb[i] = u = simple_alloc_urb(udev, pipe, len, 0);
1370 if (!u)
1371 goto cleanup;
1372
1373 reqp = kmalloc(sizeof(*reqp), GFP_KERNEL);
1374 if (!reqp)
1375 goto cleanup;
1376 reqp->setup = req;
1377 reqp->number = i % NUM_SUBCASES;
1378 reqp->expected = expected;
1379 u->setup_packet = (char *) &reqp->setup;
1380
1381 u->context = &context;
1382 u->complete = ctrl_complete;
1383 }
1384
1385
1386 context.urb = urb;
1387 spin_lock_irq(&context.lock);
1388 for (i = 0; i < param->sglen; i++) {
1389 context.status = usb_submit_urb(urb[i], GFP_ATOMIC);
1390 if (context.status != 0) {
1391 ERROR(dev, "can't submit urb[%d], status %d\n",
1392 i, context.status);
1393 context.count = context.pending;
1394 break;
1395 }
1396 context.pending++;
1397 }
1398 spin_unlock_irq(&context.lock);
1399
1400
1401
1402
1403 if (context.pending > 0)
1404 wait_for_completion(&context.complete);
1405
1406 cleanup:
1407 for (i = 0; i < param->sglen; i++) {
1408 if (!urb[i])
1409 continue;
1410 urb[i]->dev = udev;
1411 kfree(urb[i]->setup_packet);
1412 simple_free_urb(urb[i]);
1413 }
1414 kfree(urb);
1415 return context.status;
1416 }
1417 #undef NUM_SUBCASES
1418
1419
1420
1421
1422 static void unlink1_callback(struct urb *urb)
1423 {
1424 int status = urb->status;
1425
1426
1427 if (!status)
1428 status = usb_submit_urb(urb, GFP_ATOMIC);
1429 if (status) {
1430 urb->status = status;
1431 complete(urb->context);
1432 }
1433 }
1434
1435 static int unlink1(struct usbtest_dev *dev, int pipe, int size, int async)
1436 {
1437 struct urb *urb;
1438 struct completion completion;
1439 int retval = 0;
1440
1441 init_completion(&completion);
1442 urb = simple_alloc_urb(testdev_to_usbdev(dev), pipe, size, 0);
1443 if (!urb)
1444 return -ENOMEM;
1445 urb->context = &completion;
1446 urb->complete = unlink1_callback;
1447
1448 if (usb_pipeout(urb->pipe)) {
1449 simple_fill_buf(urb);
1450 urb->transfer_flags |= URB_ZERO_PACKET;
1451 }
1452
1453
1454
1455
1456
1457
1458
1459 retval = usb_submit_urb(urb, GFP_KERNEL);
1460 if (retval != 0) {
1461 dev_err(&dev->intf->dev, "submit fail %d\n", retval);
1462 return retval;
1463 }
1464
1465
1466
1467
1468 msleep(jiffies % (2 * INTERRUPT_RATE));
1469 if (async) {
1470 while (!completion_done(&completion)) {
1471 retval = usb_unlink_urb(urb);
1472
1473 if (retval == 0 && usb_pipein(urb->pipe))
1474 retval = simple_check_buf(dev, urb);
1475
1476 switch (retval) {
1477 case -EBUSY:
1478 case -EIDRM:
1479
1480
1481
1482
1483
1484
1485 ERROR(dev, "unlink retry\n");
1486 continue;
1487 case 0:
1488 case -EINPROGRESS:
1489 break;
1490
1491 default:
1492 dev_err(&dev->intf->dev,
1493 "unlink fail %d\n", retval);
1494 return retval;
1495 }
1496
1497 break;
1498 }
1499 } else
1500 usb_kill_urb(urb);
1501
1502 wait_for_completion(&completion);
1503 retval = urb->status;
1504 simple_free_urb(urb);
1505
1506 if (async)
1507 return (retval == -ECONNRESET) ? 0 : retval - 1000;
1508 else
1509 return (retval == -ENOENT || retval == -EPERM) ?
1510 0 : retval - 2000;
1511 }
1512
1513 static int unlink_simple(struct usbtest_dev *dev, int pipe, int len)
1514 {
1515 int retval = 0;
1516
1517
1518 retval = unlink1(dev, pipe, len, 1);
1519 if (!retval)
1520 retval = unlink1(dev, pipe, len, 0);
1521 return retval;
1522 }
1523
1524
1525
1526 struct queued_ctx {
1527 struct completion complete;
1528 atomic_t pending;
1529 unsigned num;
1530 int status;
1531 struct urb **urbs;
1532 };
1533
1534 static void unlink_queued_callback(struct urb *urb)
1535 {
1536 int status = urb->status;
1537 struct queued_ctx *ctx = urb->context;
1538
1539 if (ctx->status)
1540 goto done;
1541 if (urb == ctx->urbs[ctx->num - 4] || urb == ctx->urbs[ctx->num - 2]) {
1542 if (status == -ECONNRESET)
1543 goto done;
1544
1545 }
1546 if (status != 0)
1547 ctx->status = status;
1548
1549 done:
1550 if (atomic_dec_and_test(&ctx->pending))
1551 complete(&ctx->complete);
1552 }
1553
1554 static int unlink_queued(struct usbtest_dev *dev, int pipe, unsigned num,
1555 unsigned size)
1556 {
1557 struct queued_ctx ctx;
1558 struct usb_device *udev = testdev_to_usbdev(dev);
1559 void *buf;
1560 dma_addr_t buf_dma;
1561 int i;
1562 int retval = -ENOMEM;
1563
1564 init_completion(&ctx.complete);
1565 atomic_set(&ctx.pending, 1);
1566 ctx.num = num;
1567 ctx.status = 0;
1568
1569 buf = usb_alloc_coherent(udev, size, GFP_KERNEL, &buf_dma);
1570 if (!buf)
1571 return retval;
1572 memset(buf, 0, size);
1573
1574
1575 ctx.urbs = kcalloc(num, sizeof(struct urb *), GFP_KERNEL);
1576 if (!ctx.urbs)
1577 goto free_buf;
1578 for (i = 0; i < num; i++) {
1579 ctx.urbs[i] = usb_alloc_urb(0, GFP_KERNEL);
1580 if (!ctx.urbs[i])
1581 goto free_urbs;
1582 usb_fill_bulk_urb(ctx.urbs[i], udev, pipe, buf, size,
1583 unlink_queued_callback, &ctx);
1584 ctx.urbs[i]->transfer_dma = buf_dma;
1585 ctx.urbs[i]->transfer_flags = URB_NO_TRANSFER_DMA_MAP;
1586
1587 if (usb_pipeout(ctx.urbs[i]->pipe)) {
1588 simple_fill_buf(ctx.urbs[i]);
1589 ctx.urbs[i]->transfer_flags |= URB_ZERO_PACKET;
1590 }
1591 }
1592
1593
1594 for (i = 0; i < num; i++) {
1595 atomic_inc(&ctx.pending);
1596 retval = usb_submit_urb(ctx.urbs[i], GFP_KERNEL);
1597 if (retval != 0) {
1598 dev_err(&dev->intf->dev, "submit urbs[%d] fail %d\n",
1599 i, retval);
1600 atomic_dec(&ctx.pending);
1601 ctx.status = retval;
1602 break;
1603 }
1604 }
1605 if (i == num) {
1606 usb_unlink_urb(ctx.urbs[num - 4]);
1607 usb_unlink_urb(ctx.urbs[num - 2]);
1608 } else {
1609 while (--i >= 0)
1610 usb_unlink_urb(ctx.urbs[i]);
1611 }
1612
1613 if (atomic_dec_and_test(&ctx.pending))
1614 complete(&ctx.complete);
1615 wait_for_completion(&ctx.complete);
1616 retval = ctx.status;
1617
1618 free_urbs:
1619 for (i = 0; i < num; i++)
1620 usb_free_urb(ctx.urbs[i]);
1621 kfree(ctx.urbs);
1622 free_buf:
1623 usb_free_coherent(udev, size, buf, buf_dma);
1624 return retval;
1625 }
1626
1627
1628
1629 static int verify_not_halted(struct usbtest_dev *tdev, int ep, struct urb *urb)
1630 {
1631 int retval;
1632 u16 status;
1633
1634
1635 retval = usb_get_std_status(urb->dev, USB_RECIP_ENDPOINT, ep, &status);
1636 if (retval < 0) {
1637 ERROR(tdev, "ep %02x couldn't get no-halt status, %d\n",
1638 ep, retval);
1639 return retval;
1640 }
1641 if (status != 0) {
1642 ERROR(tdev, "ep %02x bogus status: %04x != 0\n", ep, status);
1643 return -EINVAL;
1644 }
1645 retval = simple_io(tdev, urb, 1, 0, 0, __func__);
1646 if (retval != 0)
1647 return -EINVAL;
1648 return 0;
1649 }
1650
1651 static int verify_halted(struct usbtest_dev *tdev, int ep, struct urb *urb)
1652 {
1653 int retval;
1654 u16 status;
1655
1656
1657 retval = usb_get_std_status(urb->dev, USB_RECIP_ENDPOINT, ep, &status);
1658 if (retval < 0) {
1659 ERROR(tdev, "ep %02x couldn't get halt status, %d\n",
1660 ep, retval);
1661 return retval;
1662 }
1663 if (status != 1) {
1664 ERROR(tdev, "ep %02x bogus status: %04x != 1\n", ep, status);
1665 return -EINVAL;
1666 }
1667 retval = simple_io(tdev, urb, 1, 0, -EPIPE, __func__);
1668 if (retval != -EPIPE)
1669 return -EINVAL;
1670 retval = simple_io(tdev, urb, 1, 0, -EPIPE, "verify_still_halted");
1671 if (retval != -EPIPE)
1672 return -EINVAL;
1673 return 0;
1674 }
1675
1676 static int test_halt(struct usbtest_dev *tdev, int ep, struct urb *urb)
1677 {
1678 int retval;
1679
1680
1681 retval = verify_not_halted(tdev, ep, urb);
1682 if (retval < 0)
1683 return retval;
1684
1685
1686 retval = usb_control_msg(urb->dev, usb_sndctrlpipe(urb->dev, 0),
1687 USB_REQ_SET_FEATURE, USB_RECIP_ENDPOINT,
1688 USB_ENDPOINT_HALT, ep,
1689 NULL, 0, USB_CTRL_SET_TIMEOUT);
1690 if (retval < 0) {
1691 ERROR(tdev, "ep %02x couldn't set halt, %d\n", ep, retval);
1692 return retval;
1693 }
1694 retval = verify_halted(tdev, ep, urb);
1695 if (retval < 0) {
1696 int ret;
1697
1698
1699 ret = usb_clear_halt(urb->dev, urb->pipe);
1700 if (ret)
1701 ERROR(tdev, "ep %02x couldn't clear halt, %d\n",
1702 ep, ret);
1703
1704 return retval;
1705 }
1706
1707
1708 retval = usb_clear_halt(urb->dev, urb->pipe);
1709 if (retval < 0) {
1710 ERROR(tdev, "ep %02x couldn't clear halt, %d\n", ep, retval);
1711 return retval;
1712 }
1713 retval = verify_not_halted(tdev, ep, urb);
1714 if (retval < 0)
1715 return retval;
1716
1717
1718
1719 return 0;
1720 }
1721
1722 static int test_toggle_sync(struct usbtest_dev *tdev, int ep, struct urb *urb)
1723 {
1724 int retval;
1725
1726
1727 retval = usb_clear_halt(urb->dev, urb->pipe);
1728 if (retval < 0) {
1729 ERROR(tdev, "ep %02x couldn't clear halt, %d\n", ep, retval);
1730 return retval;
1731 }
1732
1733
1734 retval = simple_io(tdev, urb, 1, 0, 0, __func__);
1735 if (retval != 0)
1736 return -EINVAL;
1737
1738
1739 retval = usb_clear_halt(urb->dev, urb->pipe);
1740 if (retval < 0) {
1741 ERROR(tdev, "ep %02x couldn't clear halt, %d\n", ep, retval);
1742 return retval;
1743 }
1744
1745
1746 retval = simple_io(tdev, urb, 1, 0, 0, __func__);
1747
1748 return retval;
1749 }
1750
1751 static int halt_simple(struct usbtest_dev *dev)
1752 {
1753 int ep;
1754 int retval = 0;
1755 struct urb *urb;
1756 struct usb_device *udev = testdev_to_usbdev(dev);
1757
1758 if (udev->speed == USB_SPEED_SUPER)
1759 urb = simple_alloc_urb(udev, 0, 1024, 0);
1760 else
1761 urb = simple_alloc_urb(udev, 0, 512, 0);
1762 if (urb == NULL)
1763 return -ENOMEM;
1764
1765 if (dev->in_pipe) {
1766 ep = usb_pipeendpoint(dev->in_pipe) | USB_DIR_IN;
1767 urb->pipe = dev->in_pipe;
1768 retval = test_halt(dev, ep, urb);
1769 if (retval < 0)
1770 goto done;
1771 }
1772
1773 if (dev->out_pipe) {
1774 ep = usb_pipeendpoint(dev->out_pipe);
1775 urb->pipe = dev->out_pipe;
1776 retval = test_halt(dev, ep, urb);
1777 }
1778 done:
1779 simple_free_urb(urb);
1780 return retval;
1781 }
1782
1783 static int toggle_sync_simple(struct usbtest_dev *dev)
1784 {
1785 int ep;
1786 int retval = 0;
1787 struct urb *urb;
1788 struct usb_device *udev = testdev_to_usbdev(dev);
1789 unsigned maxp = get_maxpacket(udev, dev->out_pipe);
1790
1791
1792
1793
1794
1795
1796 urb = simple_alloc_urb(udev, 0, 2 * maxp, 0);
1797 if (urb == NULL)
1798 return -ENOMEM;
1799
1800 urb->transfer_flags |= URB_ZERO_PACKET;
1801
1802 ep = usb_pipeendpoint(dev->out_pipe);
1803 urb->pipe = dev->out_pipe;
1804 retval = test_toggle_sync(dev, ep, urb);
1805
1806 simple_free_urb(urb);
1807 return retval;
1808 }
1809
1810
1811
1812
1813
1814
1815
1816
1817
1818
1819
1820 static int ctrl_out(struct usbtest_dev *dev,
1821 unsigned count, unsigned length, unsigned vary, unsigned offset)
1822 {
1823 unsigned i, j, len;
1824 int retval;
1825 u8 *buf;
1826 char *what = "?";
1827 struct usb_device *udev;
1828
1829 if (length < 1 || length > 0xffff || vary >= length)
1830 return -EINVAL;
1831
1832 buf = kmalloc(length + offset, GFP_KERNEL);
1833 if (!buf)
1834 return -ENOMEM;
1835
1836 buf += offset;
1837 udev = testdev_to_usbdev(dev);
1838 len = length;
1839 retval = 0;
1840
1841
1842
1843
1844 for (i = 0; i < count; i++) {
1845
1846 for (j = 0; j < len; j++)
1847 buf[j] = (u8)(i + j);
1848 retval = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
1849 0x5b, USB_DIR_OUT|USB_TYPE_VENDOR,
1850 0, 0, buf, len, USB_CTRL_SET_TIMEOUT);
1851 if (retval != len) {
1852 what = "write";
1853 if (retval >= 0) {
1854 ERROR(dev, "ctrl_out, wlen %d (expected %d)\n",
1855 retval, len);
1856 retval = -EBADMSG;
1857 }
1858 break;
1859 }
1860
1861
1862 retval = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
1863 0x5c, USB_DIR_IN|USB_TYPE_VENDOR,
1864 0, 0, buf, len, USB_CTRL_GET_TIMEOUT);
1865 if (retval != len) {
1866 what = "read";
1867 if (retval >= 0) {
1868 ERROR(dev, "ctrl_out, rlen %d (expected %d)\n",
1869 retval, len);
1870 retval = -EBADMSG;
1871 }
1872 break;
1873 }
1874
1875
1876 for (j = 0; j < len; j++) {
1877 if (buf[j] != (u8)(i + j)) {
1878 ERROR(dev, "ctrl_out, byte %d is %d not %d\n",
1879 j, buf[j], (u8)(i + j));
1880 retval = -EBADMSG;
1881 break;
1882 }
1883 }
1884 if (retval < 0) {
1885 what = "verify";
1886 break;
1887 }
1888
1889 len += vary;
1890
1891
1892
1893
1894
1895 if (len > length)
1896 len = realworld ? 1 : 0;
1897 }
1898
1899 if (retval < 0)
1900 ERROR(dev, "ctrl_out %s failed, code %d, count %d\n",
1901 what, retval, i);
1902
1903 kfree(buf - offset);
1904 return retval;
1905 }
1906
1907
1908
1909
1910
1911
1912
1913
1914 struct transfer_context {
1915 unsigned count;
1916 unsigned pending;
1917 spinlock_t lock;
1918 struct completion done;
1919 int submit_error;
1920 unsigned long errors;
1921 unsigned long packet_count;
1922 struct usbtest_dev *dev;
1923 bool is_iso;
1924 };
1925
1926 static void complicated_callback(struct urb *urb)
1927 {
1928 struct transfer_context *ctx = urb->context;
1929 unsigned long flags;
1930
1931 spin_lock_irqsave(&ctx->lock, flags);
1932 ctx->count--;
1933
1934 ctx->packet_count += urb->number_of_packets;
1935 if (urb->error_count > 0)
1936 ctx->errors += urb->error_count;
1937 else if (urb->status != 0)
1938 ctx->errors += (ctx->is_iso ? urb->number_of_packets : 1);
1939 else if (urb->actual_length != urb->transfer_buffer_length)
1940 ctx->errors++;
1941 else if (check_guard_bytes(ctx->dev, urb) != 0)
1942 ctx->errors++;
1943
1944 if (urb->status == 0 && ctx->count > (ctx->pending - 1)
1945 && !ctx->submit_error) {
1946 int status = usb_submit_urb(urb, GFP_ATOMIC);
1947 switch (status) {
1948 case 0:
1949 goto done;
1950 default:
1951 dev_err(&ctx->dev->intf->dev,
1952 "resubmit err %d\n",
1953 status);
1954 fallthrough;
1955 case -ENODEV:
1956 case -ESHUTDOWN:
1957 ctx->submit_error = 1;
1958 break;
1959 }
1960 }
1961
1962 ctx->pending--;
1963 if (ctx->pending == 0) {
1964 if (ctx->errors)
1965 dev_err(&ctx->dev->intf->dev,
1966 "during the test, %lu errors out of %lu\n",
1967 ctx->errors, ctx->packet_count);
1968 complete(&ctx->done);
1969 }
1970 done:
1971 spin_unlock_irqrestore(&ctx->lock, flags);
1972 }
1973
1974 static struct urb *iso_alloc_urb(
1975 struct usb_device *udev,
1976 int pipe,
1977 struct usb_endpoint_descriptor *desc,
1978 long bytes,
1979 unsigned offset
1980 )
1981 {
1982 struct urb *urb;
1983 unsigned i, maxp, packets;
1984
1985 if (bytes < 0 || !desc)
1986 return NULL;
1987
1988 maxp = usb_endpoint_maxp(desc);
1989 if (udev->speed >= USB_SPEED_SUPER)
1990 maxp *= ss_isoc_get_packet_num(udev, pipe);
1991 else
1992 maxp *= usb_endpoint_maxp_mult(desc);
1993
1994 packets = DIV_ROUND_UP(bytes, maxp);
1995
1996 urb = usb_alloc_urb(packets, GFP_KERNEL);
1997 if (!urb)
1998 return urb;
1999 urb->dev = udev;
2000 urb->pipe = pipe;
2001
2002 urb->number_of_packets = packets;
2003 urb->transfer_buffer_length = bytes;
2004 urb->transfer_buffer = usb_alloc_coherent(udev, bytes + offset,
2005 GFP_KERNEL,
2006 &urb->transfer_dma);
2007 if (!urb->transfer_buffer) {
2008 usb_free_urb(urb);
2009 return NULL;
2010 }
2011 if (offset) {
2012 memset(urb->transfer_buffer, GUARD_BYTE, offset);
2013 urb->transfer_buffer += offset;
2014 urb->transfer_dma += offset;
2015 }
2016
2017
2018 memset(urb->transfer_buffer,
2019 usb_pipein(urb->pipe) ? GUARD_BYTE : 0,
2020 bytes);
2021
2022 for (i = 0; i < packets; i++) {
2023
2024 urb->iso_frame_desc[i].length = min((unsigned) bytes, maxp);
2025 bytes -= urb->iso_frame_desc[i].length;
2026
2027 urb->iso_frame_desc[i].offset = maxp * i;
2028 }
2029
2030 urb->complete = complicated_callback;
2031
2032 urb->interval = 1 << (desc->bInterval - 1);
2033 urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP;
2034 return urb;
2035 }
2036
2037 static int
2038 test_queue(struct usbtest_dev *dev, struct usbtest_param_32 *param,
2039 int pipe, struct usb_endpoint_descriptor *desc, unsigned offset)
2040 {
2041 struct transfer_context context;
2042 struct usb_device *udev;
2043 unsigned i;
2044 unsigned long packets = 0;
2045 int status = 0;
2046 struct urb **urbs;
2047
2048 if (!param->sglen || param->iterations > UINT_MAX / param->sglen)
2049 return -EINVAL;
2050
2051 if (param->sglen > MAX_SGLEN)
2052 return -EINVAL;
2053
2054 urbs = kcalloc(param->sglen, sizeof(*urbs), GFP_KERNEL);
2055 if (!urbs)
2056 return -ENOMEM;
2057
2058 memset(&context, 0, sizeof(context));
2059 context.count = param->iterations * param->sglen;
2060 context.dev = dev;
2061 context.is_iso = !!desc;
2062 init_completion(&context.done);
2063 spin_lock_init(&context.lock);
2064
2065 udev = testdev_to_usbdev(dev);
2066
2067 for (i = 0; i < param->sglen; i++) {
2068 if (context.is_iso)
2069 urbs[i] = iso_alloc_urb(udev, pipe, desc,
2070 param->length, offset);
2071 else
2072 urbs[i] = complicated_alloc_urb(udev, pipe,
2073 param->length, 0);
2074
2075 if (!urbs[i]) {
2076 status = -ENOMEM;
2077 goto fail;
2078 }
2079 packets += urbs[i]->number_of_packets;
2080 urbs[i]->context = &context;
2081 }
2082 packets *= param->iterations;
2083
2084 if (context.is_iso) {
2085 int transaction_num;
2086
2087 if (udev->speed >= USB_SPEED_SUPER)
2088 transaction_num = ss_isoc_get_packet_num(udev, pipe);
2089 else
2090 transaction_num = usb_endpoint_maxp_mult(desc);
2091
2092 dev_info(&dev->intf->dev,
2093 "iso period %d %sframes, wMaxPacket %d, transactions: %d\n",
2094 1 << (desc->bInterval - 1),
2095 (udev->speed >= USB_SPEED_HIGH) ? "micro" : "",
2096 usb_endpoint_maxp(desc),
2097 transaction_num);
2098
2099 dev_info(&dev->intf->dev,
2100 "total %lu msec (%lu packets)\n",
2101 (packets * (1 << (desc->bInterval - 1)))
2102 / ((udev->speed >= USB_SPEED_HIGH) ? 8 : 1),
2103 packets);
2104 }
2105
2106 spin_lock_irq(&context.lock);
2107 for (i = 0; i < param->sglen; i++) {
2108 ++context.pending;
2109 status = usb_submit_urb(urbs[i], GFP_ATOMIC);
2110 if (status < 0) {
2111 ERROR(dev, "submit iso[%d], error %d\n", i, status);
2112 if (i == 0) {
2113 spin_unlock_irq(&context.lock);
2114 goto fail;
2115 }
2116
2117 simple_free_urb(urbs[i]);
2118 urbs[i] = NULL;
2119 context.pending--;
2120 context.submit_error = 1;
2121 break;
2122 }
2123 }
2124 spin_unlock_irq(&context.lock);
2125
2126 wait_for_completion(&context.done);
2127
2128 for (i = 0; i < param->sglen; i++) {
2129 if (urbs[i])
2130 simple_free_urb(urbs[i]);
2131 }
2132
2133
2134
2135
2136
2137 if (status != 0)
2138 ;
2139 else if (context.submit_error)
2140 status = -EACCES;
2141 else if (context.errors >
2142 (context.is_iso ? context.packet_count / 10 : 0))
2143 status = -EIO;
2144
2145 kfree(urbs);
2146 return status;
2147
2148 fail:
2149 for (i = 0; i < param->sglen; i++) {
2150 if (urbs[i])
2151 simple_free_urb(urbs[i]);
2152 }
2153
2154 kfree(urbs);
2155 return status;
2156 }
2157
2158 static int test_unaligned_bulk(
2159 struct usbtest_dev *tdev,
2160 int pipe,
2161 unsigned length,
2162 int iterations,
2163 unsigned transfer_flags,
2164 const char *label)
2165 {
2166 int retval;
2167 struct urb *urb = usbtest_alloc_urb(testdev_to_usbdev(tdev),
2168 pipe, length, transfer_flags, 1, 0, simple_callback);
2169
2170 if (!urb)
2171 return -ENOMEM;
2172
2173 retval = simple_io(tdev, urb, iterations, 0, 0, label);
2174 simple_free_urb(urb);
2175 return retval;
2176 }
2177
2178
2179 static int
2180 usbtest_do_ioctl(struct usb_interface *intf, struct usbtest_param_32 *param)
2181 {
2182 struct usbtest_dev *dev = usb_get_intfdata(intf);
2183 struct usb_device *udev = testdev_to_usbdev(dev);
2184 struct urb *urb;
2185 struct scatterlist *sg;
2186 struct usb_sg_request req;
2187 unsigned i;
2188 int retval = -EOPNOTSUPP;
2189
2190 if (param->iterations <= 0)
2191 return -EINVAL;
2192 if (param->sglen > MAX_SGLEN)
2193 return -EINVAL;
2194
2195
2196
2197
2198
2199
2200
2201
2202
2203 switch (param->test_num) {
2204
2205 case 0:
2206 dev_info(&intf->dev, "TEST 0: NOP\n");
2207 retval = 0;
2208 break;
2209
2210
2211 case 1:
2212 if (dev->out_pipe == 0)
2213 break;
2214 dev_info(&intf->dev,
2215 "TEST 1: write %d bytes %u times\n",
2216 param->length, param->iterations);
2217 urb = simple_alloc_urb(udev, dev->out_pipe, param->length, 0);
2218 if (!urb) {
2219 retval = -ENOMEM;
2220 break;
2221 }
2222
2223 retval = simple_io(dev, urb, param->iterations, 0, 0, "test1");
2224 simple_free_urb(urb);
2225 break;
2226 case 2:
2227 if (dev->in_pipe == 0)
2228 break;
2229 dev_info(&intf->dev,
2230 "TEST 2: read %d bytes %u times\n",
2231 param->length, param->iterations);
2232 urb = simple_alloc_urb(udev, dev->in_pipe, param->length, 0);
2233 if (!urb) {
2234 retval = -ENOMEM;
2235 break;
2236 }
2237
2238 retval = simple_io(dev, urb, param->iterations, 0, 0, "test2");
2239 simple_free_urb(urb);
2240 break;
2241 case 3:
2242 if (dev->out_pipe == 0 || param->vary == 0)
2243 break;
2244 dev_info(&intf->dev,
2245 "TEST 3: write/%d 0..%d bytes %u times\n",
2246 param->vary, param->length, param->iterations);
2247 urb = simple_alloc_urb(udev, dev->out_pipe, param->length, 0);
2248 if (!urb) {
2249 retval = -ENOMEM;
2250 break;
2251 }
2252
2253 retval = simple_io(dev, urb, param->iterations, param->vary,
2254 0, "test3");
2255 simple_free_urb(urb);
2256 break;
2257 case 4:
2258 if (dev->in_pipe == 0 || param->vary == 0)
2259 break;
2260 dev_info(&intf->dev,
2261 "TEST 4: read/%d 0..%d bytes %u times\n",
2262 param->vary, param->length, param->iterations);
2263 urb = simple_alloc_urb(udev, dev->in_pipe, param->length, 0);
2264 if (!urb) {
2265 retval = -ENOMEM;
2266 break;
2267 }
2268
2269 retval = simple_io(dev, urb, param->iterations, param->vary,
2270 0, "test4");
2271 simple_free_urb(urb);
2272 break;
2273
2274
2275 case 5:
2276 if (dev->out_pipe == 0 || param->sglen == 0)
2277 break;
2278 dev_info(&intf->dev,
2279 "TEST 5: write %d sglists %d entries of %d bytes\n",
2280 param->iterations,
2281 param->sglen, param->length);
2282 sg = alloc_sglist(param->sglen, param->length,
2283 0, dev, dev->out_pipe);
2284 if (!sg) {
2285 retval = -ENOMEM;
2286 break;
2287 }
2288
2289 retval = perform_sglist(dev, param->iterations, dev->out_pipe,
2290 &req, sg, param->sglen);
2291 free_sglist(sg, param->sglen);
2292 break;
2293
2294 case 6:
2295 if (dev->in_pipe == 0 || param->sglen == 0)
2296 break;
2297 dev_info(&intf->dev,
2298 "TEST 6: read %d sglists %d entries of %d bytes\n",
2299 param->iterations,
2300 param->sglen, param->length);
2301 sg = alloc_sglist(param->sglen, param->length,
2302 0, dev, dev->in_pipe);
2303 if (!sg) {
2304 retval = -ENOMEM;
2305 break;
2306 }
2307
2308 retval = perform_sglist(dev, param->iterations, dev->in_pipe,
2309 &req, sg, param->sglen);
2310 free_sglist(sg, param->sglen);
2311 break;
2312 case 7:
2313 if (dev->out_pipe == 0 || param->sglen == 0 || param->vary == 0)
2314 break;
2315 dev_info(&intf->dev,
2316 "TEST 7: write/%d %d sglists %d entries 0..%d bytes\n",
2317 param->vary, param->iterations,
2318 param->sglen, param->length);
2319 sg = alloc_sglist(param->sglen, param->length,
2320 param->vary, dev, dev->out_pipe);
2321 if (!sg) {
2322 retval = -ENOMEM;
2323 break;
2324 }
2325
2326 retval = perform_sglist(dev, param->iterations, dev->out_pipe,
2327 &req, sg, param->sglen);
2328 free_sglist(sg, param->sglen);
2329 break;
2330 case 8:
2331 if (dev->in_pipe == 0 || param->sglen == 0 || param->vary == 0)
2332 break;
2333 dev_info(&intf->dev,
2334 "TEST 8: read/%d %d sglists %d entries 0..%d bytes\n",
2335 param->vary, param->iterations,
2336 param->sglen, param->length);
2337 sg = alloc_sglist(param->sglen, param->length,
2338 param->vary, dev, dev->in_pipe);
2339 if (!sg) {
2340 retval = -ENOMEM;
2341 break;
2342 }
2343
2344 retval = perform_sglist(dev, param->iterations, dev->in_pipe,
2345 &req, sg, param->sglen);
2346 free_sglist(sg, param->sglen);
2347 break;
2348
2349
2350 case 9:
2351 retval = 0;
2352 dev_info(&intf->dev,
2353 "TEST 9: ch9 (subset) control tests, %d times\n",
2354 param->iterations);
2355 for (i = param->iterations; retval == 0 && i--; )
2356 retval = ch9_postconfig(dev);
2357 if (retval)
2358 dev_err(&intf->dev, "ch9 subset failed, "
2359 "iterations left %d\n", i);
2360 break;
2361
2362
2363 case 10:
2364 retval = 0;
2365 dev_info(&intf->dev,
2366 "TEST 10: queue %d control calls, %d times\n",
2367 param->sglen,
2368 param->iterations);
2369 retval = test_ctrl_queue(dev, param);
2370 break;
2371
2372
2373 case 11:
2374 if (dev->in_pipe == 0 || !param->length)
2375 break;
2376 retval = 0;
2377 dev_info(&intf->dev, "TEST 11: unlink %d reads of %d\n",
2378 param->iterations, param->length);
2379 for (i = param->iterations; retval == 0 && i--; )
2380 retval = unlink_simple(dev, dev->in_pipe,
2381 param->length);
2382 if (retval)
2383 dev_err(&intf->dev, "unlink reads failed %d, "
2384 "iterations left %d\n", retval, i);
2385 break;
2386 case 12:
2387 if (dev->out_pipe == 0 || !param->length)
2388 break;
2389 retval = 0;
2390 dev_info(&intf->dev, "TEST 12: unlink %d writes of %d\n",
2391 param->iterations, param->length);
2392 for (i = param->iterations; retval == 0 && i--; )
2393 retval = unlink_simple(dev, dev->out_pipe,
2394 param->length);
2395 if (retval)
2396 dev_err(&intf->dev, "unlink writes failed %d, "
2397 "iterations left %d\n", retval, i);
2398 break;
2399
2400
2401 case 13:
2402 if (dev->out_pipe == 0 && dev->in_pipe == 0)
2403 break;
2404 retval = 0;
2405 dev_info(&intf->dev, "TEST 13: set/clear %d halts\n",
2406 param->iterations);
2407 for (i = param->iterations; retval == 0 && i--; )
2408 retval = halt_simple(dev);
2409
2410 if (retval)
2411 ERROR(dev, "halts failed, iterations left %d\n", i);
2412 break;
2413
2414
2415 case 14:
2416 if (!dev->info->ctrl_out)
2417 break;
2418 dev_info(&intf->dev, "TEST 14: %d ep0out, %d..%d vary %d\n",
2419 param->iterations,
2420 realworld ? 1 : 0, param->length,
2421 param->vary);
2422 retval = ctrl_out(dev, param->iterations,
2423 param->length, param->vary, 0);
2424 break;
2425
2426
2427 case 15:
2428 if (dev->out_iso_pipe == 0 || param->sglen == 0)
2429 break;
2430 dev_info(&intf->dev,
2431 "TEST 15: write %d iso, %d entries of %d bytes\n",
2432 param->iterations,
2433 param->sglen, param->length);
2434
2435 retval = test_queue(dev, param,
2436 dev->out_iso_pipe, dev->iso_out, 0);
2437 break;
2438
2439
2440 case 16:
2441 if (dev->in_iso_pipe == 0 || param->sglen == 0)
2442 break;
2443 dev_info(&intf->dev,
2444 "TEST 16: read %d iso, %d entries of %d bytes\n",
2445 param->iterations,
2446 param->sglen, param->length);
2447
2448 retval = test_queue(dev, param,
2449 dev->in_iso_pipe, dev->iso_in, 0);
2450 break;
2451
2452
2453
2454
2455 case 17:
2456 if (dev->out_pipe == 0)
2457 break;
2458 dev_info(&intf->dev,
2459 "TEST 17: write odd addr %d bytes %u times core map\n",
2460 param->length, param->iterations);
2461
2462 retval = test_unaligned_bulk(
2463 dev, dev->out_pipe,
2464 param->length, param->iterations,
2465 0, "test17");
2466 break;
2467
2468 case 18:
2469 if (dev->in_pipe == 0)
2470 break;
2471 dev_info(&intf->dev,
2472 "TEST 18: read odd addr %d bytes %u times core map\n",
2473 param->length, param->iterations);
2474
2475 retval = test_unaligned_bulk(
2476 dev, dev->in_pipe,
2477 param->length, param->iterations,
2478 0, "test18");
2479 break;
2480
2481
2482 case 19:
2483 if (dev->out_pipe == 0)
2484 break;
2485 dev_info(&intf->dev,
2486 "TEST 19: write odd addr %d bytes %u times premapped\n",
2487 param->length, param->iterations);
2488
2489 retval = test_unaligned_bulk(
2490 dev, dev->out_pipe,
2491 param->length, param->iterations,
2492 URB_NO_TRANSFER_DMA_MAP, "test19");
2493 break;
2494
2495 case 20:
2496 if (dev->in_pipe == 0)
2497 break;
2498 dev_info(&intf->dev,
2499 "TEST 20: read odd addr %d bytes %u times premapped\n",
2500 param->length, param->iterations);
2501
2502 retval = test_unaligned_bulk(
2503 dev, dev->in_pipe,
2504 param->length, param->iterations,
2505 URB_NO_TRANSFER_DMA_MAP, "test20");
2506 break;
2507
2508
2509 case 21:
2510 if (!dev->info->ctrl_out)
2511 break;
2512 dev_info(&intf->dev,
2513 "TEST 21: %d ep0out odd addr, %d..%d vary %d\n",
2514 param->iterations,
2515 realworld ? 1 : 0, param->length,
2516 param->vary);
2517 retval = ctrl_out(dev, param->iterations,
2518 param->length, param->vary, 1);
2519 break;
2520
2521
2522 case 22:
2523 if (dev->out_iso_pipe == 0 || param->sglen == 0)
2524 break;
2525 dev_info(&intf->dev,
2526 "TEST 22: write %d iso odd, %d entries of %d bytes\n",
2527 param->iterations,
2528 param->sglen, param->length);
2529 retval = test_queue(dev, param,
2530 dev->out_iso_pipe, dev->iso_out, 1);
2531 break;
2532
2533 case 23:
2534 if (dev->in_iso_pipe == 0 || param->sglen == 0)
2535 break;
2536 dev_info(&intf->dev,
2537 "TEST 23: read %d iso odd, %d entries of %d bytes\n",
2538 param->iterations,
2539 param->sglen, param->length);
2540 retval = test_queue(dev, param,
2541 dev->in_iso_pipe, dev->iso_in, 1);
2542 break;
2543
2544
2545 case 24:
2546 if (dev->out_pipe == 0 || !param->length || param->sglen < 4)
2547 break;
2548 retval = 0;
2549 dev_info(&intf->dev, "TEST 24: unlink from %d queues of "
2550 "%d %d-byte writes\n",
2551 param->iterations, param->sglen, param->length);
2552 for (i = param->iterations; retval == 0 && i > 0; --i) {
2553 retval = unlink_queued(dev, dev->out_pipe,
2554 param->sglen, param->length);
2555 if (retval) {
2556 dev_err(&intf->dev,
2557 "unlink queued writes failed %d, "
2558 "iterations left %d\n", retval, i);
2559 break;
2560 }
2561 }
2562 break;
2563
2564
2565 case 25:
2566 if (dev->out_int_pipe == 0)
2567 break;
2568 dev_info(&intf->dev,
2569 "TEST 25: write %d bytes %u times\n",
2570 param->length, param->iterations);
2571 urb = simple_alloc_urb(udev, dev->out_int_pipe, param->length,
2572 dev->int_out->bInterval);
2573 if (!urb) {
2574 retval = -ENOMEM;
2575 break;
2576 }
2577
2578 retval = simple_io(dev, urb, param->iterations, 0, 0, "test25");
2579 simple_free_urb(urb);
2580 break;
2581 case 26:
2582 if (dev->in_int_pipe == 0)
2583 break;
2584 dev_info(&intf->dev,
2585 "TEST 26: read %d bytes %u times\n",
2586 param->length, param->iterations);
2587 urb = simple_alloc_urb(udev, dev->in_int_pipe, param->length,
2588 dev->int_in->bInterval);
2589 if (!urb) {
2590 retval = -ENOMEM;
2591 break;
2592 }
2593
2594 retval = simple_io(dev, urb, param->iterations, 0, 0, "test26");
2595 simple_free_urb(urb);
2596 break;
2597 case 27:
2598
2599 if (dev->out_pipe == 0 || param->sglen == 0 || pattern != 0)
2600 break;
2601 dev_info(&intf->dev,
2602 "TEST 27: bulk write %dMbytes\n", (param->iterations *
2603 param->sglen * param->length) / (1024 * 1024));
2604 retval = test_queue(dev, param,
2605 dev->out_pipe, NULL, 0);
2606 break;
2607 case 28:
2608 if (dev->in_pipe == 0 || param->sglen == 0 || pattern != 0)
2609 break;
2610 dev_info(&intf->dev,
2611 "TEST 28: bulk read %dMbytes\n", (param->iterations *
2612 param->sglen * param->length) / (1024 * 1024));
2613 retval = test_queue(dev, param,
2614 dev->in_pipe, NULL, 0);
2615 break;
2616
2617 case 29:
2618 if (dev->out_pipe == 0)
2619 break;
2620 retval = 0;
2621 dev_info(&intf->dev, "TEST 29: Clear toggle between bulk writes %d times\n",
2622 param->iterations);
2623 for (i = param->iterations; retval == 0 && i > 0; --i)
2624 retval = toggle_sync_simple(dev);
2625
2626 if (retval)
2627 ERROR(dev, "toggle sync failed, iterations left %d\n",
2628 i);
2629 break;
2630 }
2631 return retval;
2632 }
2633
2634
2635
2636
2637
2638
2639
2640
2641
2642
2643
2644
2645
2646
2647
2648
2649
2650
2651
2652
2653
2654
2655
2656
2657 static int
2658 usbtest_ioctl(struct usb_interface *intf, unsigned int code, void *buf)
2659 {
2660
2661 struct usbtest_dev *dev = usb_get_intfdata(intf);
2662 struct usbtest_param_64 *param_64 = buf;
2663 struct usbtest_param_32 temp;
2664 struct usbtest_param_32 *param_32 = buf;
2665 struct timespec64 start;
2666 struct timespec64 end;
2667 struct timespec64 duration;
2668 int retval = -EOPNOTSUPP;
2669
2670
2671
2672 pattern = mod_pattern;
2673
2674 if (mutex_lock_interruptible(&dev->lock))
2675 return -ERESTARTSYS;
2676
2677
2678
2679
2680
2681
2682
2683 if (dev->info->alt >= 0) {
2684 if (intf->altsetting->desc.bInterfaceNumber) {
2685 retval = -ENODEV;
2686 goto free_mutex;
2687 }
2688 retval = set_altsetting(dev, dev->info->alt);
2689 if (retval) {
2690 dev_err(&intf->dev,
2691 "set altsetting to %d failed, %d\n",
2692 dev->info->alt, retval);
2693 goto free_mutex;
2694 }
2695 }
2696
2697 switch (code) {
2698 case USBTEST_REQUEST_64:
2699 temp.test_num = param_64->test_num;
2700 temp.iterations = param_64->iterations;
2701 temp.length = param_64->length;
2702 temp.sglen = param_64->sglen;
2703 temp.vary = param_64->vary;
2704 param_32 = &temp;
2705 break;
2706
2707 case USBTEST_REQUEST_32:
2708 break;
2709
2710 default:
2711 retval = -EOPNOTSUPP;
2712 goto free_mutex;
2713 }
2714
2715 ktime_get_ts64(&start);
2716
2717 retval = usbtest_do_ioctl(intf, param_32);
2718 if (retval < 0)
2719 goto free_mutex;
2720
2721 ktime_get_ts64(&end);
2722
2723 duration = timespec64_sub(end, start);
2724
2725 temp.duration_sec = duration.tv_sec;
2726 temp.duration_usec = duration.tv_nsec/NSEC_PER_USEC;
2727
2728 switch (code) {
2729 case USBTEST_REQUEST_32:
2730 param_32->duration_sec = temp.duration_sec;
2731 param_32->duration_usec = temp.duration_usec;
2732 break;
2733
2734 case USBTEST_REQUEST_64:
2735 param_64->duration_sec = temp.duration_sec;
2736 param_64->duration_usec = temp.duration_usec;
2737 break;
2738 }
2739
2740 free_mutex:
2741 mutex_unlock(&dev->lock);
2742 return retval;
2743 }
2744
2745
2746
2747 static unsigned force_interrupt;
2748 module_param(force_interrupt, uint, 0);
2749 MODULE_PARM_DESC(force_interrupt, "0 = test default; else interrupt");
2750
2751 #ifdef GENERIC
2752 static unsigned short vendor;
2753 module_param(vendor, ushort, 0);
2754 MODULE_PARM_DESC(vendor, "vendor code (from usb-if)");
2755
2756 static unsigned short product;
2757 module_param(product, ushort, 0);
2758 MODULE_PARM_DESC(product, "product code (from vendor)");
2759 #endif
2760
2761 static int
2762 usbtest_probe(struct usb_interface *intf, const struct usb_device_id *id)
2763 {
2764 struct usb_device *udev;
2765 struct usbtest_dev *dev;
2766 struct usbtest_info *info;
2767 char *rtest, *wtest;
2768 char *irtest, *iwtest;
2769 char *intrtest, *intwtest;
2770
2771 udev = interface_to_usbdev(intf);
2772
2773 #ifdef GENERIC
2774
2775 if (id->match_flags == 0) {
2776
2777 if (!vendor || le16_to_cpu(udev->descriptor.idVendor) != (u16)vendor)
2778 return -ENODEV;
2779 if (product && le16_to_cpu(udev->descriptor.idProduct) != (u16)product)
2780 return -ENODEV;
2781 dev_info(&intf->dev, "matched module params, "
2782 "vend=0x%04x prod=0x%04x\n",
2783 le16_to_cpu(udev->descriptor.idVendor),
2784 le16_to_cpu(udev->descriptor.idProduct));
2785 }
2786 #endif
2787
2788 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
2789 if (!dev)
2790 return -ENOMEM;
2791 info = (struct usbtest_info *) id->driver_info;
2792 dev->info = info;
2793 mutex_init(&dev->lock);
2794
2795 dev->intf = intf;
2796
2797
2798 dev->buf = kmalloc(TBUF_SIZE, GFP_KERNEL);
2799 if (dev->buf == NULL) {
2800 kfree(dev);
2801 return -ENOMEM;
2802 }
2803
2804
2805
2806
2807
2808 rtest = wtest = "";
2809 irtest = iwtest = "";
2810 intrtest = intwtest = "";
2811 if (force_interrupt || udev->speed == USB_SPEED_LOW) {
2812 if (info->ep_in) {
2813 dev->in_pipe = usb_rcvintpipe(udev, info->ep_in);
2814 rtest = " intr-in";
2815 }
2816 if (info->ep_out) {
2817 dev->out_pipe = usb_sndintpipe(udev, info->ep_out);
2818 wtest = " intr-out";
2819 }
2820 } else {
2821 if (override_alt >= 0 || info->autoconf) {
2822 int status;
2823
2824 status = get_endpoints(dev, intf);
2825 if (status < 0) {
2826 WARNING(dev, "couldn't get endpoints, %d\n",
2827 status);
2828 kfree(dev->buf);
2829 kfree(dev);
2830 return status;
2831 }
2832
2833 } else {
2834 if (info->ep_in)
2835 dev->in_pipe = usb_rcvbulkpipe(udev,
2836 info->ep_in);
2837 if (info->ep_out)
2838 dev->out_pipe = usb_sndbulkpipe(udev,
2839 info->ep_out);
2840 }
2841 if (dev->in_pipe)
2842 rtest = " bulk-in";
2843 if (dev->out_pipe)
2844 wtest = " bulk-out";
2845 if (dev->in_iso_pipe)
2846 irtest = " iso-in";
2847 if (dev->out_iso_pipe)
2848 iwtest = " iso-out";
2849 if (dev->in_int_pipe)
2850 intrtest = " int-in";
2851 if (dev->out_int_pipe)
2852 intwtest = " int-out";
2853 }
2854
2855 usb_set_intfdata(intf, dev);
2856 dev_info(&intf->dev, "%s\n", info->name);
2857 dev_info(&intf->dev, "%s {control%s%s%s%s%s%s%s} tests%s\n",
2858 usb_speed_string(udev->speed),
2859 info->ctrl_out ? " in/out" : "",
2860 rtest, wtest,
2861 irtest, iwtest,
2862 intrtest, intwtest,
2863 info->alt >= 0 ? " (+alt)" : "");
2864 return 0;
2865 }
2866
2867 static int usbtest_suspend(struct usb_interface *intf, pm_message_t message)
2868 {
2869 return 0;
2870 }
2871
2872 static int usbtest_resume(struct usb_interface *intf)
2873 {
2874 return 0;
2875 }
2876
2877
2878 static void usbtest_disconnect(struct usb_interface *intf)
2879 {
2880 struct usbtest_dev *dev = usb_get_intfdata(intf);
2881
2882 usb_set_intfdata(intf, NULL);
2883 dev_dbg(&intf->dev, "disconnect\n");
2884 kfree(dev->buf);
2885 kfree(dev);
2886 }
2887
2888
2889
2890
2891
2892
2893
2894
2895
2896
2897
2898
2899
2900 static struct usbtest_info ez1_info = {
2901 .name = "EZ-USB device",
2902 .ep_in = 2,
2903 .ep_out = 2,
2904 .alt = 1,
2905 };
2906
2907
2908 static struct usbtest_info ez2_info = {
2909 .name = "FX2 device",
2910 .ep_in = 6,
2911 .ep_out = 2,
2912 .alt = 1,
2913 };
2914
2915
2916
2917 static struct usbtest_info fw_info = {
2918 .name = "usb test device",
2919 .ep_in = 2,
2920 .ep_out = 2,
2921 .alt = 1,
2922 .autoconf = 1,
2923 .ctrl_out = 1,
2924 .iso = 1,
2925 };
2926
2927
2928
2929
2930
2931
2932 static struct usbtest_info gz_info = {
2933 .name = "Linux gadget zero",
2934 .autoconf = 1,
2935 .ctrl_out = 1,
2936 .iso = 1,
2937 .intr = 1,
2938 .alt = 0,
2939 };
2940
2941 static struct usbtest_info um_info = {
2942 .name = "Linux user mode test driver",
2943 .autoconf = 1,
2944 .alt = -1,
2945 };
2946
2947 static struct usbtest_info um2_info = {
2948 .name = "Linux user mode ISO test driver",
2949 .autoconf = 1,
2950 .iso = 1,
2951 .alt = -1,
2952 };
2953
2954 #ifdef IBOT2
2955
2956
2957
2958 static struct usbtest_info ibot2_info = {
2959 .name = "iBOT2 webcam",
2960 .ep_in = 2,
2961 .alt = -1,
2962 };
2963 #endif
2964
2965 #ifdef GENERIC
2966
2967 static struct usbtest_info generic_info = {
2968 .name = "Generic USB device",
2969 .alt = -1,
2970 };
2971 #endif
2972
2973
2974 static const struct usb_device_id id_table[] = {
2975
2976
2977
2978
2979
2980
2981
2982
2983 { USB_DEVICE(0x0547, 0x2235),
2984 .driver_info = (unsigned long) &ez1_info,
2985 },
2986
2987
2988 { USB_DEVICE(0x0547, 0x0080),
2989 .driver_info = (unsigned long) &ez1_info,
2990 },
2991
2992
2993 { USB_DEVICE(0x04b4, 0x8613),
2994 .driver_info = (unsigned long) &ez2_info,
2995 },
2996
2997
2998 { USB_DEVICE(0xfff0, 0xfff0),
2999 .driver_info = (unsigned long) &fw_info,
3000 },
3001
3002
3003 { USB_DEVICE(0x0525, 0xa4a0),
3004 .driver_info = (unsigned long) &gz_info,
3005 },
3006
3007
3008 { USB_DEVICE(0x0525, 0xa4a4),
3009 .driver_info = (unsigned long) &um_info,
3010 },
3011
3012
3013 { USB_DEVICE(0x0525, 0xa4a3),
3014 .driver_info = (unsigned long) &um2_info,
3015 },
3016
3017 #ifdef KEYSPAN_19Qi
3018
3019
3020 { USB_DEVICE(0x06cd, 0x010b),
3021 .driver_info = (unsigned long) &ez1_info,
3022 },
3023 #endif
3024
3025
3026
3027 #ifdef IBOT2
3028
3029
3030 { USB_DEVICE(0x0b62, 0x0059),
3031 .driver_info = (unsigned long) &ibot2_info,
3032 },
3033 #endif
3034
3035
3036
3037 #ifdef GENERIC
3038
3039 { .driver_info = (unsigned long) &generic_info, },
3040 #endif
3041
3042
3043
3044 { }
3045 };
3046 MODULE_DEVICE_TABLE(usb, id_table);
3047
3048 static struct usb_driver usbtest_driver = {
3049 .name = "usbtest",
3050 .id_table = id_table,
3051 .probe = usbtest_probe,
3052 .unlocked_ioctl = usbtest_ioctl,
3053 .disconnect = usbtest_disconnect,
3054 .suspend = usbtest_suspend,
3055 .resume = usbtest_resume,
3056 };
3057
3058
3059
3060 static int __init usbtest_init(void)
3061 {
3062 #ifdef GENERIC
3063 if (vendor)
3064 pr_debug("params: vend=0x%04x prod=0x%04x\n", vendor, product);
3065 #endif
3066 return usb_register(&usbtest_driver);
3067 }
3068 module_init(usbtest_init);
3069
3070 static void __exit usbtest_exit(void)
3071 {
3072 usb_deregister(&usbtest_driver);
3073 }
3074 module_exit(usbtest_exit);
3075
3076 MODULE_DESCRIPTION("USB Core/HCD Testing Driver");
3077 MODULE_LICENSE("GPL");
3078