1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * AMD MP2 Sensors transport driver 4 * 5 * Authors: Nehal Bakulchandra Shah <Nehal-bakulchandra.shah@amd.com> 6 * Sandeep Singh <sandeep.singh@amd.com> 7 */ 8 #include <linux/hid.h> 9 #include <linux/wait.h> 10 #include <linux/sched.h> 11 12 #include "amd_sfh_hid.h" 13 14 #define AMD_SFH_RESPONSE_TIMEOUT 1500 15 16 /** 17 * amdtp_hid_parse() - hid-core .parse() callback 18 * @hid: hid device instance 19 * 20 * This function gets called during call to hid_add_device 21 * 22 * Return: 0 on success and non zero on error 23 */ 24 static int amdtp_hid_parse(struct hid_device *hid) 25 { 26 struct amdtp_hid_data *hid_data = hid->driver_data; 27 struct amdtp_cl_data *cli_data = hid_data->cli_data; 28 29 return hid_parse_report(hid, cli_data->report_descr[hid_data->index], 30 cli_data->report_descr_sz[hid_data->index]); 31 } 32 33 /* Empty callbacks with success return code */ 34 static int amdtp_hid_start(struct hid_device *hid) 35 { 36 return 0; 37 } 38 39 static void amdtp_hid_stop(struct hid_device *hid) 40 { 41 } 42 43 static int amdtp_hid_open(struct hid_device *hid) 44 { 45 return 0; 46 } 47 48 static void amdtp_hid_close(struct hid_device *hid) 49 { 50 } 51 52 static int amdtp_raw_request(struct hid_device *hdev, u8 reportnum, 53 u8 *buf, size_t len, u8 rtype, int reqtype) 54 { 55 return 0; 56 } 57 58 static void amdtp_hid_request(struct hid_device *hid, struct hid_report *rep, int reqtype) 59 { 60 int rc; 61 62 switch (reqtype) { 63 case HID_REQ_GET_REPORT: 64 rc = amd_sfh_get_report(hid, rep->id, rep->type); 65 if (rc) 66 dev_err(&hid->dev, "AMDSFH get report error\n"); 67 break; 68 case HID_REQ_SET_REPORT: 69 amd_sfh_set_report(hid, rep->id, reqtype); 70 break; 71 default: 72 break; 73 } 74 } 75 76 static int amdtp_wait_for_response(struct hid_device *hid) 77 { 78 struct amdtp_hid_data *hid_data = hid->driver_data; 79 struct amdtp_cl_data *cli_data = hid_data->cli_data; 80 int i, ret = 0; 81 82 for (i = 0; i < cli_data->num_hid_devices; i++) { 83 if (cli_data->hid_sensor_hubs[i] == hid) 84 break; 85 } 86 87 if (!cli_data->request_done[i]) 88 ret = wait_event_interruptible_timeout(hid_data->hid_wait, 89 cli_data->request_done[i], 90 msecs_to_jiffies(AMD_SFH_RESPONSE_TIMEOUT)); 91 if (ret == -ERESTARTSYS) 92 return -ERESTARTSYS; 93 else if (ret < 0) 94 return -ETIMEDOUT; 95 else 96 return 0; 97 } 98 99 void amdtp_hid_wakeup(struct hid_device *hid) 100 { 101 struct amdtp_hid_data *hid_data = hid->driver_data; 102 struct amdtp_cl_data *cli_data = hid_data->cli_data; 103 104 cli_data->request_done[cli_data->cur_hid_dev] = true; 105 wake_up_interruptible(&hid_data->hid_wait); 106 } 107 108 static struct hid_ll_driver amdtp_hid_ll_driver = { 109 .parse = amdtp_hid_parse, 110 .start = amdtp_hid_start, 111 .stop = amdtp_hid_stop, 112 .open = amdtp_hid_open, 113 .close = amdtp_hid_close, 114 .request = amdtp_hid_request, 115 .wait = amdtp_wait_for_response, 116 .raw_request = amdtp_raw_request, 117 }; 118 119 int amdtp_hid_probe(u32 cur_hid_dev, struct amdtp_cl_data *cli_data) 120 { 121 struct hid_device *hid; 122 struct amdtp_hid_data *hid_data; 123 int rc; 124 125 hid = hid_allocate_device(); 126 if (IS_ERR(hid)) 127 return PTR_ERR(hid); 128 129 hid_data = kzalloc(sizeof(*hid_data), GFP_KERNEL); 130 if (!hid_data) { 131 rc = -ENOMEM; 132 goto err_hid_data; 133 } 134 135 hid->ll_driver = &amdtp_hid_ll_driver; 136 hid_data->index = cur_hid_dev; 137 hid_data->cli_data = cli_data; 138 init_waitqueue_head(&hid_data->hid_wait); 139 140 hid->driver_data = hid_data; 141 cli_data->hid_sensor_hubs[cur_hid_dev] = hid; 142 hid->bus = BUS_AMD_AMDTP; 143 hid->vendor = AMD_SFH_HID_VENDOR; 144 hid->product = AMD_SFH_HID_PRODUCT; 145 snprintf(hid->name, sizeof(hid->name), "%s %04X:%04X", "hid-amdtp", 146 hid->vendor, hid->product); 147 148 rc = hid_add_device(hid); 149 if (rc) 150 goto err_hid_device; 151 return 0; 152 153 err_hid_device: 154 kfree(hid_data); 155 err_hid_data: 156 hid_destroy_device(hid); 157 return rc; 158 } 159 160 void amdtp_hid_remove(struct amdtp_cl_data *cli_data) 161 { 162 int i; 163 164 for (i = 0; i < cli_data->num_hid_devices; ++i) { 165 kfree(cli_data->feature_report[i]); 166 kfree(cli_data->input_report[i]); 167 kfree(cli_data->report_descr[i]); 168 if (cli_data->hid_sensor_hubs[i]) { 169 kfree(cli_data->hid_sensor_hubs[i]->driver_data); 170 hid_destroy_device(cli_data->hid_sensor_hubs[i]); 171 cli_data->hid_sensor_hubs[i] = NULL; 172 } 173 } 174 } 175