treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / hid / hid-elo.c
blob0d22713a38742b23465f0dbe216d2107c25edc52
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * HID driver for ELO usb touchscreen 4000/4500
5 * Copyright (c) 2013 Jiri Slaby
7 * Data parsing taken from elousb driver by Vojtech Pavlik.
8 */
10 #include <linux/hid.h>
11 #include <linux/input.h>
12 #include <linux/module.h>
13 #include <linux/usb.h>
14 #include <linux/workqueue.h>
16 #include "hid-ids.h"
18 #define ELO_PERIODIC_READ_INTERVAL HZ
19 #define ELO_SMARTSET_CMD_TIMEOUT 2000 /* msec */
21 /* Elo SmartSet commands */
22 #define ELO_FLUSH_SMARTSET_RESPONSES 0x02 /* Flush all pending smartset responses */
23 #define ELO_SEND_SMARTSET_COMMAND 0x05 /* Send a smartset command */
24 #define ELO_GET_SMARTSET_RESPONSE 0x06 /* Get a smartset response */
25 #define ELO_DIAG 0x64 /* Diagnostics command */
26 #define ELO_SMARTSET_PACKET_SIZE 8
28 struct elo_priv {
29 struct usb_device *usbdev;
30 struct delayed_work work;
31 unsigned char buffer[ELO_SMARTSET_PACKET_SIZE];
34 static struct workqueue_struct *wq;
35 static bool use_fw_quirk = true;
36 module_param(use_fw_quirk, bool, S_IRUGO);
37 MODULE_PARM_DESC(use_fw_quirk, "Do periodic pokes for broken M firmwares (default = true)");
39 static int elo_input_configured(struct hid_device *hdev,
40 struct hid_input *hidinput)
42 struct input_dev *input = hidinput->input;
45 * ELO devices have one Button usage in GenDesk field, which makes
46 * hid-input map it to BTN_LEFT; that confuses userspace, which then
47 * considers the device to be a mouse/touchpad instead of touchscreen.
49 clear_bit(BTN_LEFT, input->keybit);
50 set_bit(BTN_TOUCH, input->keybit);
51 set_bit(ABS_PRESSURE, input->absbit);
52 input_set_abs_params(input, ABS_PRESSURE, 0, 256, 0, 0);
54 return 0;
57 static void elo_process_data(struct input_dev *input, const u8 *data, int size)
59 int press;
61 input_report_abs(input, ABS_X, (data[3] << 8) | data[2]);
62 input_report_abs(input, ABS_Y, (data[5] << 8) | data[4]);
64 press = 0;
65 if (data[1] & 0x80)
66 press = (data[7] << 8) | data[6];
67 input_report_abs(input, ABS_PRESSURE, press);
69 if (data[1] & 0x03) {
70 input_report_key(input, BTN_TOUCH, 1);
71 input_sync(input);
74 if (data[1] & 0x04)
75 input_report_key(input, BTN_TOUCH, 0);
77 input_sync(input);
80 static int elo_raw_event(struct hid_device *hdev, struct hid_report *report,
81 u8 *data, int size)
83 struct hid_input *hidinput;
85 if (!(hdev->claimed & HID_CLAIMED_INPUT) || list_empty(&hdev->inputs))
86 return 0;
88 hidinput = list_first_entry(&hdev->inputs, struct hid_input, list);
90 switch (report->id) {
91 case 0:
92 if (data[0] == 'T') { /* Mandatory ELO packet marker */
93 elo_process_data(hidinput->input, data, size);
94 return 1;
96 break;
97 default: /* unknown report */
98 /* Unknown report type; pass upstream */
99 hid_info(hdev, "unknown report type %d\n", report->id);
100 break;
103 return 0;
106 static int elo_smartset_send_get(struct usb_device *dev, u8 command,
107 void *data)
109 unsigned int pipe;
110 u8 dir;
112 if (command == ELO_SEND_SMARTSET_COMMAND) {
113 pipe = usb_sndctrlpipe(dev, 0);
114 dir = USB_DIR_OUT;
115 } else if (command == ELO_GET_SMARTSET_RESPONSE) {
116 pipe = usb_rcvctrlpipe(dev, 0);
117 dir = USB_DIR_IN;
118 } else
119 return -EINVAL;
121 return usb_control_msg(dev, pipe, command,
122 dir | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
123 0, 0, data, ELO_SMARTSET_PACKET_SIZE,
124 ELO_SMARTSET_CMD_TIMEOUT);
127 static int elo_flush_smartset_responses(struct usb_device *dev)
129 return usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
130 ELO_FLUSH_SMARTSET_RESPONSES,
131 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
132 0, 0, NULL, 0, USB_CTRL_SET_TIMEOUT);
135 static void elo_work(struct work_struct *work)
137 struct elo_priv *priv = container_of(work, struct elo_priv, work.work);
138 struct usb_device *dev = priv->usbdev;
139 unsigned char *buffer = priv->buffer;
140 int ret;
142 ret = elo_flush_smartset_responses(dev);
143 if (ret < 0) {
144 dev_err(&dev->dev, "initial FLUSH_SMARTSET_RESPONSES failed, error %d\n",
145 ret);
146 goto fail;
149 /* send Diagnostics command */
150 *buffer = ELO_DIAG;
151 ret = elo_smartset_send_get(dev, ELO_SEND_SMARTSET_COMMAND, buffer);
152 if (ret < 0) {
153 dev_err(&dev->dev, "send Diagnostics Command failed, error %d\n",
154 ret);
155 goto fail;
158 /* get the result */
159 ret = elo_smartset_send_get(dev, ELO_GET_SMARTSET_RESPONSE, buffer);
160 if (ret < 0) {
161 dev_err(&dev->dev, "get Diagnostics Command response failed, error %d\n",
162 ret);
163 goto fail;
166 /* read the ack */
167 if (*buffer != 'A') {
168 ret = elo_smartset_send_get(dev, ELO_GET_SMARTSET_RESPONSE,
169 buffer);
170 if (ret < 0) {
171 dev_err(&dev->dev, "get acknowledge response failed, error %d\n",
172 ret);
173 goto fail;
177 fail:
178 ret = elo_flush_smartset_responses(dev);
179 if (ret < 0)
180 dev_err(&dev->dev, "final FLUSH_SMARTSET_RESPONSES failed, error %d\n",
181 ret);
182 queue_delayed_work(wq, &priv->work, ELO_PERIODIC_READ_INTERVAL);
186 * Not all Elo devices need the periodic HID descriptor reads.
187 * Only firmware version M needs this.
189 static bool elo_broken_firmware(struct usb_device *dev)
191 struct usb_device *hub = dev->parent;
192 struct usb_device *child = NULL;
193 u16 fw_lvl = le16_to_cpu(dev->descriptor.bcdDevice);
194 u16 child_vid, child_pid;
195 int i;
197 if (!use_fw_quirk)
198 return false;
199 if (fw_lvl != 0x10d)
200 return false;
202 /* iterate sibling devices of the touch controller */
203 usb_hub_for_each_child(hub, i, child) {
204 child_vid = le16_to_cpu(child->descriptor.idVendor);
205 child_pid = le16_to_cpu(child->descriptor.idProduct);
208 * If one of the devices below is present attached as a sibling of
209 * the touch controller then this is a newer IBM 4820 monitor that
210 * does not need the IBM-requested workaround if fw level is
211 * 0x010d - aka 'M'.
212 * No other HW can have this combination.
214 if (child_vid==0x04b3) {
215 switch (child_pid) {
216 case 0x4676: /* 4820 21x Video */
217 case 0x4677: /* 4820 51x Video */
218 case 0x4678: /* 4820 2Lx Video */
219 case 0x4679: /* 4820 5Lx Video */
220 return false;
224 return true;
227 static int elo_probe(struct hid_device *hdev, const struct hid_device_id *id)
229 struct elo_priv *priv;
230 int ret;
232 priv = kzalloc(sizeof(*priv), GFP_KERNEL);
233 if (!priv)
234 return -ENOMEM;
236 INIT_DELAYED_WORK(&priv->work, elo_work);
237 priv->usbdev = interface_to_usbdev(to_usb_interface(hdev->dev.parent));
239 hid_set_drvdata(hdev, priv);
241 ret = hid_parse(hdev);
242 if (ret) {
243 hid_err(hdev, "parse failed\n");
244 goto err_free;
247 ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT);
248 if (ret) {
249 hid_err(hdev, "hw start failed\n");
250 goto err_free;
253 if (elo_broken_firmware(priv->usbdev)) {
254 hid_info(hdev, "broken firmware found, installing workaround\n");
255 queue_delayed_work(wq, &priv->work, ELO_PERIODIC_READ_INTERVAL);
258 return 0;
259 err_free:
260 kfree(priv);
261 return ret;
264 static void elo_remove(struct hid_device *hdev)
266 struct elo_priv *priv = hid_get_drvdata(hdev);
268 hid_hw_stop(hdev);
269 cancel_delayed_work_sync(&priv->work);
270 kfree(priv);
273 static const struct hid_device_id elo_devices[] = {
274 { HID_USB_DEVICE(USB_VENDOR_ID_ELO, 0x0009), },
275 { HID_USB_DEVICE(USB_VENDOR_ID_ELO, 0x0030), },
278 MODULE_DEVICE_TABLE(hid, elo_devices);
280 static struct hid_driver elo_driver = {
281 .name = "elo",
282 .id_table = elo_devices,
283 .probe = elo_probe,
284 .remove = elo_remove,
285 .raw_event = elo_raw_event,
286 .input_configured = elo_input_configured,
289 static int __init elo_driver_init(void)
291 int ret;
293 wq = create_singlethread_workqueue("elousb");
294 if (!wq)
295 return -ENOMEM;
297 ret = hid_register_driver(&elo_driver);
298 if (ret)
299 destroy_workqueue(wq);
301 return ret;
303 module_init(elo_driver_init);
305 static void __exit elo_driver_exit(void)
307 hid_unregister_driver(&elo_driver);
308 destroy_workqueue(wq);
310 module_exit(elo_driver_exit);
312 MODULE_AUTHOR("Jiri Slaby <jslaby@suse.cz>");
313 MODULE_LICENSE("GPL");