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