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
ehset_probe(struct usb_interface * intf,const struct usb_device_id * id)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_send(hub_udev, 0, USB_REQ_SET_FEATURE,
34 USB_RT_PORT, USB_PORT_FEAT_TEST,
35 (USB_TEST_SE0_NAK << 8) | portnum,
36 NULL, 0, 1000, GFP_KERNEL);
37 break;
38 case TEST_J_PID:
39 ret = usb_control_msg_send(hub_udev, 0, USB_REQ_SET_FEATURE,
40 USB_RT_PORT, USB_PORT_FEAT_TEST,
41 (USB_TEST_J << 8) | portnum, NULL, 0,
42 1000, GFP_KERNEL);
43 break;
44 case TEST_K_PID:
45 ret = usb_control_msg_send(hub_udev, 0, USB_REQ_SET_FEATURE,
46 USB_RT_PORT, USB_PORT_FEAT_TEST,
47 (USB_TEST_K << 8) | portnum, NULL, 0,
48 1000, GFP_KERNEL);
49 break;
50 case TEST_PACKET_PID:
51 ret = usb_control_msg_send(hub_udev, 0, USB_REQ_SET_FEATURE,
52 USB_RT_PORT, USB_PORT_FEAT_TEST,
53 (USB_TEST_PACKET << 8) | portnum,
54 NULL, 0, 1000, GFP_KERNEL);
55 break;
56 case TEST_HS_HOST_PORT_SUSPEND_RESUME:
57 /* Test: wait for 15secs -> suspend -> 15secs delay -> resume */
58 msleep(15 * 1000);
59 ret = usb_control_msg_send(hub_udev, 0, USB_REQ_SET_FEATURE,
60 USB_RT_PORT, USB_PORT_FEAT_SUSPEND,
61 portnum, NULL, 0, 1000, GFP_KERNEL);
62 if (ret < 0)
63 break;
64
65 msleep(15 * 1000);
66 ret = usb_control_msg_send(hub_udev, 0, USB_REQ_CLEAR_FEATURE,
67 USB_RT_PORT, USB_PORT_FEAT_SUSPEND,
68 portnum, NULL, 0, 1000, GFP_KERNEL);
69 break;
70 case TEST_SINGLE_STEP_GET_DEV_DESC:
71 /* Test: wait for 15secs -> GetDescriptor request */
72 msleep(15 * 1000);
73
74 ret = usb_control_msg_recv(dev, 0, USB_REQ_GET_DESCRIPTOR,
75 USB_DIR_IN, USB_DT_DEVICE << 8, 0,
76 &buf, USB_DT_DEVICE_SIZE,
77 USB_CTRL_GET_TIMEOUT, GFP_KERNEL);
78 break;
79 case TEST_SINGLE_STEP_SET_FEATURE:
80 /*
81 * GetDescriptor SETUP request -> 15secs delay -> IN & STATUS
82 *
83 * Note, this test is only supported on root hubs since the
84 * SetPortFeature handling can only be done inside the HCD's
85 * hub_control callback function.
86 */
87 if (hub_udev != dev->bus->root_hub) {
88 dev_err(&intf->dev, "SINGLE_STEP_SET_FEATURE test only supported on root hub\n");
89 break;
90 }
91
92 ret = usb_control_msg_send(hub_udev, 0, USB_REQ_SET_FEATURE,
93 USB_RT_PORT, USB_PORT_FEAT_TEST,
94 (6 << 8) | portnum, NULL, 0,
95 60 * 1000, GFP_KERNEL);
96
97 break;
98 default:
99 dev_err(&intf->dev, "%s: unsupported PID: 0x%x\n",
100 __func__, test_pid);
101 }
102
103 return ret;
104 }
105
ehset_disconnect(struct usb_interface * intf)106 static void ehset_disconnect(struct usb_interface *intf)
107 {
108 }
109
110 static const struct usb_device_id ehset_id_table[] = {
111 { USB_DEVICE(0x1a0a, TEST_SE0_NAK_PID) },
112 { USB_DEVICE(0x1a0a, TEST_J_PID) },
113 { USB_DEVICE(0x1a0a, TEST_K_PID) },
114 { USB_DEVICE(0x1a0a, TEST_PACKET_PID) },
115 { USB_DEVICE(0x1a0a, TEST_HS_HOST_PORT_SUSPEND_RESUME) },
116 { USB_DEVICE(0x1a0a, TEST_SINGLE_STEP_GET_DEV_DESC) },
117 { USB_DEVICE(0x1a0a, TEST_SINGLE_STEP_SET_FEATURE) },
118 { } /* Terminating entry */
119 };
120 MODULE_DEVICE_TABLE(usb, ehset_id_table);
121
122 static struct usb_driver ehset_driver = {
123 .name = "usb_ehset_test",
124 .probe = ehset_probe,
125 .disconnect = ehset_disconnect,
126 .id_table = ehset_id_table,
127 };
128
129 module_usb_driver(ehset_driver);
130
131 MODULE_DESCRIPTION("USB Driver for EHSET Test Fixture");
132 MODULE_LICENSE("GPL v2");
133