1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (c) 2010-2013, The Linux Foundation. All rights reserved. 4 */ 5 6 #include <linux/kernel.h> 7 #include <linux/errno.h> 8 #include <linux/module.h> 9 #include <linux/slab.h> 10 #include <linux/usb.h> 11 #include <linux/usb/ch11.h> 12 13 #define TEST_SE0_NAK_PID 0x0101 14 #define TEST_J_PID 0x0102 15 #define TEST_K_PID 0x0103 16 #define TEST_PACKET_PID 0x0104 17 #define TEST_HS_HOST_PORT_SUSPEND_RESUME 0x0106 18 #define TEST_SINGLE_STEP_GET_DEV_DESC 0x0107 19 #define TEST_SINGLE_STEP_SET_FEATURE 0x0108 20 21 static int ehset_probe(struct usb_interface *intf, 22 const struct usb_device_id *id) 23 { 24 int ret = -EINVAL; 25 struct usb_device *dev = interface_to_usbdev(intf); 26 struct usb_device *hub_udev = dev->parent; 27 struct usb_device_descriptor *buf; 28 u8 portnum = dev->portnum; 29 u16 test_pid = le16_to_cpu(dev->descriptor.idProduct); 30 31 switch (test_pid) { 32 case TEST_SE0_NAK_PID: 33 ret = usb_control_msg(hub_udev, usb_sndctrlpipe(hub_udev, 0), 34 USB_REQ_SET_FEATURE, USB_RT_PORT, 35 USB_PORT_FEAT_TEST, 36 (USB_TEST_SE0_NAK << 8) | portnum, 37 NULL, 0, 1000); 38 break; 39 case TEST_J_PID: 40 ret = usb_control_msg(hub_udev, usb_sndctrlpipe(hub_udev, 0), 41 USB_REQ_SET_FEATURE, USB_RT_PORT, 42 USB_PORT_FEAT_TEST, 43 (USB_TEST_J << 8) | portnum, 44 NULL, 0, 1000); 45 break; 46 case TEST_K_PID: 47 ret = usb_control_msg(hub_udev, usb_sndctrlpipe(hub_udev, 0), 48 USB_REQ_SET_FEATURE, USB_RT_PORT, 49 USB_PORT_FEAT_TEST, 50 (USB_TEST_K << 8) | portnum, 51 NULL, 0, 1000); 52 break; 53 case TEST_PACKET_PID: 54 ret = usb_control_msg(hub_udev, usb_sndctrlpipe(hub_udev, 0), 55 USB_REQ_SET_FEATURE, USB_RT_PORT, 56 USB_PORT_FEAT_TEST, 57 (USB_TEST_PACKET << 8) | portnum, 58 NULL, 0, 1000); 59 break; 60 case TEST_HS_HOST_PORT_SUSPEND_RESUME: 61 /* Test: wait for 15secs -> suspend -> 15secs delay -> resume */ 62 msleep(15 * 1000); 63 ret = usb_control_msg(hub_udev, usb_sndctrlpipe(hub_udev, 0), 64 USB_REQ_SET_FEATURE, USB_RT_PORT, 65 USB_PORT_FEAT_SUSPEND, portnum, 66 NULL, 0, 1000); 67 if (ret < 0) 68 break; 69 70 msleep(15 * 1000); 71 ret = usb_control_msg(hub_udev, usb_sndctrlpipe(hub_udev, 0), 72 USB_REQ_CLEAR_FEATURE, USB_RT_PORT, 73 USB_PORT_FEAT_SUSPEND, portnum, 74 NULL, 0, 1000); 75 break; 76 case TEST_SINGLE_STEP_GET_DEV_DESC: 77 /* Test: wait for 15secs -> GetDescriptor request */ 78 msleep(15 * 1000); 79 buf = kmalloc(USB_DT_DEVICE_SIZE, GFP_KERNEL); 80 if (!buf) 81 return -ENOMEM; 82 83 ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), 84 USB_REQ_GET_DESCRIPTOR, USB_DIR_IN, 85 USB_DT_DEVICE << 8, 0, 86 buf, USB_DT_DEVICE_SIZE, 87 USB_CTRL_GET_TIMEOUT); 88 kfree(buf); 89 break; 90 case TEST_SINGLE_STEP_SET_FEATURE: 91 /* 92 * GetDescriptor SETUP request -> 15secs delay -> IN & STATUS 93 * 94 * Note, this test is only supported on root hubs since the 95 * SetPortFeature handling can only be done inside the HCD's 96 * hub_control callback function. 97 */ 98 if (hub_udev != dev->bus->root_hub) { 99 dev_err(&intf->dev, "SINGLE_STEP_SET_FEATURE test only supported on root hub\n"); 100 break; 101 } 102 103 ret = usb_control_msg(hub_udev, usb_sndctrlpipe(hub_udev, 0), 104 USB_REQ_SET_FEATURE, USB_RT_PORT, 105 USB_PORT_FEAT_TEST, 106 (6 << 8) | portnum, 107 NULL, 0, 60 * 1000); 108 109 break; 110 default: 111 dev_err(&intf->dev, "%s: unsupported PID: 0x%x\n", 112 __func__, test_pid); 113 } 114 115 return (ret < 0) ? ret : 0; 116 } 117 118 static void ehset_disconnect(struct usb_interface *intf) 119 { 120 } 121 122 static const struct usb_device_id ehset_id_table[] = { 123 { USB_DEVICE(0x1a0a, TEST_SE0_NAK_PID) }, 124 { USB_DEVICE(0x1a0a, TEST_J_PID) }, 125 { USB_DEVICE(0x1a0a, TEST_K_PID) }, 126 { USB_DEVICE(0x1a0a, TEST_PACKET_PID) }, 127 { USB_DEVICE(0x1a0a, TEST_HS_HOST_PORT_SUSPEND_RESUME) }, 128 { USB_DEVICE(0x1a0a, TEST_SINGLE_STEP_GET_DEV_DESC) }, 129 { USB_DEVICE(0x1a0a, TEST_SINGLE_STEP_SET_FEATURE) }, 130 { } /* Terminating entry */ 131 }; 132 MODULE_DEVICE_TABLE(usb, ehset_id_table); 133 134 static struct usb_driver ehset_driver = { 135 .name = "usb_ehset_test", 136 .probe = ehset_probe, 137 .disconnect = ehset_disconnect, 138 .id_table = ehset_id_table, 139 }; 140 141 module_usb_driver(ehset_driver); 142 143 MODULE_DESCRIPTION("USB Driver for EHSET Test Fixture"); 144 MODULE_LICENSE("GPL v2"); 145