Gitiles
Code Review Sign In
gerrit-public.fairphone.software / kernel / msm-5.4 / 2da2ca24a38f0200111e3b8823c08d02cb59d362 / . / drivers / usb / misc / ehset.c
blob: 7895d61e733b4c920b59b4cb41e051afa3faed7c [file] [log] [blame]
Greg Kroah-Hartman5fd54ac2017-11-03 11:28:30 +0100[diff] [blame]1// SPDX-License-Identifier: GPL-2.0
Manu Gautam1353aa52013-07-02 20:13:51 -0700[diff] [blame]2/*
3 * Copyright (c) 2010-2013, The Linux Foundation. All rights reserved.
Manu Gautam1353aa52013-07-02 20:13:51 -0700[diff] [blame]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
21static 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 (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 (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 (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 (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:
Manu Gautam9841f372013-08-08 16:49:24 -0700[diff] [blame]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;
Manu Gautam1353aa52013-07-02 20:13:51 -0700[diff] [blame]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
118static void ehset_disconnect(struct usb_interface *intf)
119{
120}
121
122static 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};
132MODULE_DEVICE_TABLE(usb, ehset_id_table);
133
134static 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
141module_usb_driver(ehset_driver);
142
143MODULE_DESCRIPTION("USB Driver for EHSET Test Fixture");
144MODULE_LICENSE("GPL v2");