Thomas Gleixner | d2912cb | 2019-06-04 10:11:33 +0200 | [diff] [blame^] | 1 | // SPDX-License-Identifier: GPL-2.0-only |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | /* |
| 3 | * Elo serial touchscreen driver |
| 4 | * |
| 5 | * Copyright (c) 2004 Vojtech Pavlik |
| 6 | */ |
| 7 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 8 | |
| 9 | /* |
| 10 | * This driver can handle serial Elo touchscreens using either the Elo standard |
| 11 | * 'E271-2210' 10-byte protocol, Elo legacy 'E281A-4002' 6-byte protocol, Elo |
| 12 | * legacy 'E271-140' 4-byte protocol and Elo legacy 'E261-280' 3-byte protocol. |
| 13 | */ |
| 14 | |
| 15 | #include <linux/errno.h> |
| 16 | #include <linux/kernel.h> |
| 17 | #include <linux/module.h> |
| 18 | #include <linux/slab.h> |
| 19 | #include <linux/input.h> |
| 20 | #include <linux/serio.h> |
Shaun Jackman | fae3006 | 2006-08-05 00:29:49 -0400 | [diff] [blame] | 21 | #include <linux/ctype.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 22 | |
| 23 | #define DRIVER_DESC "Elo serial touchscreen driver" |
| 24 | |
| 25 | MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); |
| 26 | MODULE_DESCRIPTION(DRIVER_DESC); |
| 27 | MODULE_LICENSE("GPL"); |
| 28 | |
| 29 | /* |
| 30 | * Definitions & global arrays. |
| 31 | */ |
| 32 | |
Shaun Jackman | 1ce316e | 2006-08-05 00:27:59 -0400 | [diff] [blame] | 33 | #define ELO_MAX_LENGTH 10 |
| 34 | |
Shaun Jackman | fae3006 | 2006-08-05 00:29:49 -0400 | [diff] [blame] | 35 | #define ELO10_PACKET_LEN 8 |
| 36 | #define ELO10_TOUCH 0x03 |
| 37 | #define ELO10_PRESSURE 0x80 |
| 38 | |
Shaun Jackman | 1ce316e | 2006-08-05 00:27:59 -0400 | [diff] [blame] | 39 | #define ELO10_LEAD_BYTE 'U' |
| 40 | |
Shaun Jackman | fae3006 | 2006-08-05 00:29:49 -0400 | [diff] [blame] | 41 | #define ELO10_ID_CMD 'i' |
| 42 | |
Shaun Jackman | 1ce316e | 2006-08-05 00:27:59 -0400 | [diff] [blame] | 43 | #define ELO10_TOUCH_PACKET 'T' |
Shaun Jackman | fae3006 | 2006-08-05 00:29:49 -0400 | [diff] [blame] | 44 | #define ELO10_ACK_PACKET 'A' |
| 45 | #define ELI10_ID_PACKET 'I' |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 46 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 47 | /* |
| 48 | * Per-touchscreen data. |
| 49 | */ |
| 50 | |
| 51 | struct elo { |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 52 | struct input_dev *dev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | struct serio *serio; |
Shaun Jackman | fae3006 | 2006-08-05 00:29:49 -0400 | [diff] [blame] | 54 | struct mutex cmd_mutex; |
| 55 | struct completion cmd_done; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 56 | int id; |
| 57 | int idx; |
Shaun Jackman | fae3006 | 2006-08-05 00:29:49 -0400 | [diff] [blame] | 58 | unsigned char expected_packet; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | unsigned char csum; |
| 60 | unsigned char data[ELO_MAX_LENGTH]; |
Shaun Jackman | fae3006 | 2006-08-05 00:29:49 -0400 | [diff] [blame] | 61 | unsigned char response[ELO10_PACKET_LEN]; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 | char phys[32]; |
| 63 | }; |
| 64 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 65 | static void elo_process_data_10(struct elo *elo, unsigned char data) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 66 | { |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 67 | struct input_dev *dev = elo->dev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 68 | |
Shaun Jackman | 1ce316e | 2006-08-05 00:27:59 -0400 | [diff] [blame] | 69 | elo->data[elo->idx] = data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 70 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 71 | switch (elo->idx++) { |
| 72 | case 0: |
| 73 | elo->csum = 0xaa; |
| 74 | if (data != ELO10_LEAD_BYTE) { |
| 75 | dev_dbg(&elo->serio->dev, |
| 76 | "unsynchronized data: 0x%02x\n", data); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 77 | elo->idx = 0; |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 78 | } |
| 79 | break; |
| 80 | |
| 81 | case 9: |
| 82 | elo->idx = 0; |
| 83 | if (data != elo->csum) { |
| 84 | dev_dbg(&elo->serio->dev, |
| 85 | "bad checksum: 0x%02x, expected 0x%02x\n", |
| 86 | data, elo->csum); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 87 | break; |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 88 | } |
| 89 | if (elo->data[1] != elo->expected_packet) { |
| 90 | if (elo->data[1] != ELO10_TOUCH_PACKET) |
| 91 | dev_dbg(&elo->serio->dev, |
| 92 | "unexpected packet: 0x%02x\n", |
| 93 | elo->data[1]); |
| 94 | break; |
| 95 | } |
| 96 | if (likely(elo->data[1] == ELO10_TOUCH_PACKET)) { |
| 97 | input_report_abs(dev, ABS_X, (elo->data[4] << 8) | elo->data[3]); |
| 98 | input_report_abs(dev, ABS_Y, (elo->data[6] << 8) | elo->data[5]); |
| 99 | if (elo->data[2] & ELO10_PRESSURE) |
| 100 | input_report_abs(dev, ABS_PRESSURE, |
| 101 | (elo->data[8] << 8) | elo->data[7]); |
| 102 | input_report_key(dev, BTN_TOUCH, elo->data[2] & ELO10_TOUCH); |
| 103 | input_sync(dev); |
| 104 | } else if (elo->data[1] == ELO10_ACK_PACKET) { |
| 105 | if (elo->data[2] == '0') |
| 106 | elo->expected_packet = ELO10_TOUCH_PACKET; |
| 107 | complete(&elo->cmd_done); |
| 108 | } else { |
| 109 | memcpy(elo->response, &elo->data[1], ELO10_PACKET_LEN); |
| 110 | elo->expected_packet = ELO10_ACK_PACKET; |
| 111 | } |
| 112 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 | } |
Shaun Jackman | 1ce316e | 2006-08-05 00:27:59 -0400 | [diff] [blame] | 114 | elo->csum += data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 115 | } |
| 116 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 117 | static void elo_process_data_6(struct elo *elo, unsigned char data) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 118 | { |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 119 | struct input_dev *dev = elo->dev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 120 | |
| 121 | elo->data[elo->idx] = data; |
| 122 | |
| 123 | switch (elo->idx++) { |
| 124 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 125 | case 0: |
| 126 | if ((data & 0xc0) != 0xc0) |
| 127 | elo->idx = 0; |
| 128 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 129 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 130 | case 1: |
| 131 | if ((data & 0xc0) != 0x80) |
| 132 | elo->idx = 0; |
| 133 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 134 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 135 | case 2: |
| 136 | if ((data & 0xc0) != 0x40) |
| 137 | elo->idx = 0; |
| 138 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 139 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 140 | case 3: |
| 141 | if (data & 0xc0) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 142 | elo->idx = 0; |
| 143 | break; |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 144 | } |
| 145 | |
| 146 | input_report_abs(dev, ABS_X, ((elo->data[0] & 0x3f) << 6) | (elo->data[1] & 0x3f)); |
| 147 | input_report_abs(dev, ABS_Y, ((elo->data[2] & 0x3f) << 6) | (elo->data[3] & 0x3f)); |
| 148 | |
| 149 | if (elo->id == 2) { |
| 150 | input_report_key(dev, BTN_TOUCH, 1); |
| 151 | input_sync(dev); |
| 152 | elo->idx = 0; |
| 153 | } |
| 154 | |
| 155 | break; |
| 156 | |
| 157 | case 4: |
| 158 | if (data) { |
| 159 | input_sync(dev); |
| 160 | elo->idx = 0; |
| 161 | } |
| 162 | break; |
| 163 | |
| 164 | case 5: |
| 165 | if ((data & 0xf0) == 0) { |
| 166 | input_report_abs(dev, ABS_PRESSURE, elo->data[5]); |
| 167 | input_report_key(dev, BTN_TOUCH, !!elo->data[5]); |
| 168 | } |
| 169 | input_sync(dev); |
| 170 | elo->idx = 0; |
| 171 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 172 | } |
| 173 | } |
| 174 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 175 | static void elo_process_data_3(struct elo *elo, unsigned char data) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 176 | { |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 177 | struct input_dev *dev = elo->dev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 178 | |
| 179 | elo->data[elo->idx] = data; |
| 180 | |
| 181 | switch (elo->idx++) { |
| 182 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 183 | case 0: |
| 184 | if ((data & 0x7f) != 0x01) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 185 | elo->idx = 0; |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 186 | break; |
| 187 | case 2: |
| 188 | input_report_key(dev, BTN_TOUCH, !(elo->data[1] & 0x80)); |
| 189 | input_report_abs(dev, ABS_X, elo->data[1]); |
| 190 | input_report_abs(dev, ABS_Y, elo->data[2]); |
| 191 | input_sync(dev); |
| 192 | elo->idx = 0; |
| 193 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 194 | } |
| 195 | } |
| 196 | |
| 197 | static irqreturn_t elo_interrupt(struct serio *serio, |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 198 | unsigned char data, unsigned int flags) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 199 | { |
Shaun Jackman | 1ce316e | 2006-08-05 00:27:59 -0400 | [diff] [blame] | 200 | struct elo *elo = serio_get_drvdata(serio); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 201 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 202 | switch (elo->id) { |
| 203 | case 0: |
| 204 | elo_process_data_10(elo, data); |
| 205 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 206 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 207 | case 1: |
| 208 | case 2: |
| 209 | elo_process_data_6(elo, data); |
| 210 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 211 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 212 | case 3: |
| 213 | elo_process_data_3(elo, data); |
| 214 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 215 | } |
| 216 | |
| 217 | return IRQ_HANDLED; |
| 218 | } |
| 219 | |
Shaun Jackman | fae3006 | 2006-08-05 00:29:49 -0400 | [diff] [blame] | 220 | static int elo_command_10(struct elo *elo, unsigned char *packet) |
| 221 | { |
| 222 | int rc = -1; |
| 223 | int i; |
| 224 | unsigned char csum = 0xaa + ELO10_LEAD_BYTE; |
| 225 | |
| 226 | mutex_lock(&elo->cmd_mutex); |
| 227 | |
| 228 | serio_pause_rx(elo->serio); |
| 229 | elo->expected_packet = toupper(packet[0]); |
| 230 | init_completion(&elo->cmd_done); |
| 231 | serio_continue_rx(elo->serio); |
| 232 | |
| 233 | if (serio_write(elo->serio, ELO10_LEAD_BYTE)) |
| 234 | goto out; |
| 235 | |
| 236 | for (i = 0; i < ELO10_PACKET_LEN; i++) { |
| 237 | csum += packet[i]; |
| 238 | if (serio_write(elo->serio, packet[i])) |
| 239 | goto out; |
| 240 | } |
| 241 | |
| 242 | if (serio_write(elo->serio, csum)) |
| 243 | goto out; |
| 244 | |
| 245 | wait_for_completion_timeout(&elo->cmd_done, HZ); |
| 246 | |
| 247 | if (elo->expected_packet == ELO10_TOUCH_PACKET) { |
| 248 | /* We are back in reporting mode, the command was ACKed */ |
| 249 | memcpy(packet, elo->response, ELO10_PACKET_LEN); |
| 250 | rc = 0; |
| 251 | } |
| 252 | |
| 253 | out: |
| 254 | mutex_unlock(&elo->cmd_mutex); |
| 255 | return rc; |
| 256 | } |
| 257 | |
| 258 | static int elo_setup_10(struct elo *elo) |
| 259 | { |
| 260 | static const char *elo_types[] = { "Accu", "Dura", "Intelli", "Carroll" }; |
| 261 | struct input_dev *dev = elo->dev; |
| 262 | unsigned char packet[ELO10_PACKET_LEN] = { ELO10_ID_CMD }; |
| 263 | |
| 264 | if (elo_command_10(elo, packet)) |
| 265 | return -1; |
| 266 | |
| 267 | dev->id.version = (packet[5] << 8) | packet[4]; |
| 268 | |
| 269 | input_set_abs_params(dev, ABS_X, 96, 4000, 0, 0); |
| 270 | input_set_abs_params(dev, ABS_Y, 96, 4000, 0, 0); |
| 271 | if (packet[3] & ELO10_PRESSURE) |
| 272 | input_set_abs_params(dev, ABS_PRESSURE, 0, 255, 0, 0); |
| 273 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 274 | dev_info(&elo->serio->dev, |
| 275 | "%sTouch touchscreen, fw: %02x.%02x, features: 0x%02x, controller: 0x%02x\n", |
| 276 | elo_types[(packet[1] -'0') & 0x03], |
| 277 | packet[5], packet[4], packet[3], packet[7]); |
Shaun Jackman | fae3006 | 2006-08-05 00:29:49 -0400 | [diff] [blame] | 278 | |
| 279 | return 0; |
| 280 | } |
| 281 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 282 | /* |
| 283 | * elo_disconnect() is the opposite of elo_connect() |
| 284 | */ |
| 285 | |
| 286 | static void elo_disconnect(struct serio *serio) |
| 287 | { |
Dmitry Torokhov | 6b50d8b | 2006-08-05 00:27:00 -0400 | [diff] [blame] | 288 | struct elo *elo = serio_get_drvdata(serio); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 289 | |
Dmitry Torokhov | 6b50d8b | 2006-08-05 00:27:00 -0400 | [diff] [blame] | 290 | input_get_device(elo->dev); |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 291 | input_unregister_device(elo->dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 292 | serio_close(serio); |
| 293 | serio_set_drvdata(serio, NULL); |
Dmitry Torokhov | 6b50d8b | 2006-08-05 00:27:00 -0400 | [diff] [blame] | 294 | input_put_device(elo->dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 295 | kfree(elo); |
| 296 | } |
| 297 | |
| 298 | /* |
| 299 | * elo_connect() is the routine that is called when someone adds a |
| 300 | * new serio device that supports Gunze protocol and registers it as |
| 301 | * an input device. |
| 302 | */ |
| 303 | |
| 304 | static int elo_connect(struct serio *serio, struct serio_driver *drv) |
| 305 | { |
| 306 | struct elo *elo; |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 307 | struct input_dev *input_dev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 308 | int err; |
| 309 | |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 310 | elo = kzalloc(sizeof(struct elo), GFP_KERNEL); |
| 311 | input_dev = input_allocate_device(); |
| 312 | if (!elo || !input_dev) { |
| 313 | err = -ENOMEM; |
Dmitry Torokhov | 6b50d8b | 2006-08-05 00:27:00 -0400 | [diff] [blame] | 314 | goto fail1; |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 315 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 316 | |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 317 | elo->serio = serio; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 318 | elo->id = serio->id.id; |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 319 | elo->dev = input_dev; |
Shaun Jackman | fae3006 | 2006-08-05 00:29:49 -0400 | [diff] [blame] | 320 | elo->expected_packet = ELO10_TOUCH_PACKET; |
| 321 | mutex_init(&elo->cmd_mutex); |
| 322 | init_completion(&elo->cmd_done); |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 323 | snprintf(elo->phys, sizeof(elo->phys), "%s/input0", serio->phys); |
| 324 | |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 325 | input_dev->name = "Elo Serial TouchScreen"; |
| 326 | input_dev->phys = elo->phys; |
| 327 | input_dev->id.bustype = BUS_RS232; |
| 328 | input_dev->id.vendor = SERIO_ELO; |
| 329 | input_dev->id.product = elo->id; |
| 330 | input_dev->id.version = 0x0100; |
Dmitry Torokhov | a5394fb0 | 2007-04-12 01:35:14 -0400 | [diff] [blame] | 331 | input_dev->dev.parent = &serio->dev; |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 332 | |
Jiri Slaby | 7b19ada | 2007-10-18 23:40:32 -0700 | [diff] [blame] | 333 | input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS); |
| 334 | input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 335 | |
Shaun Jackman | fae3006 | 2006-08-05 00:29:49 -0400 | [diff] [blame] | 336 | serio_set_drvdata(serio, elo); |
| 337 | err = serio_open(serio, drv); |
| 338 | if (err) |
| 339 | goto fail2; |
| 340 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 341 | switch (elo->id) { |
| 342 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 343 | case 0: /* 10-byte protocol */ |
| 344 | if (elo_setup_10(elo)) |
| 345 | goto fail3; |
Shaun Jackman | fae3006 | 2006-08-05 00:29:49 -0400 | [diff] [blame] | 346 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 347 | break; |
Dmitry Torokhov | de1b963 | 2005-05-29 02:28:50 -0500 | [diff] [blame] | 348 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 349 | case 1: /* 6-byte protocol */ |
| 350 | input_set_abs_params(input_dev, ABS_PRESSURE, 0, 15, 0, 0); |
Gustavo A. R. Silva | 17a4ed5 | 2018-08-06 15:31:02 -0700 | [diff] [blame] | 351 | /* fall through */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 352 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 353 | case 2: /* 4-byte protocol */ |
| 354 | input_set_abs_params(input_dev, ABS_X, 96, 4000, 0, 0); |
| 355 | input_set_abs_params(input_dev, ABS_Y, 96, 4000, 0, 0); |
| 356 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 357 | |
Dmitry Torokhov | 8cab9ba | 2010-01-06 23:52:12 -0800 | [diff] [blame] | 358 | case 3: /* 3-byte protocol */ |
| 359 | input_set_abs_params(input_dev, ABS_X, 0, 255, 0, 0); |
| 360 | input_set_abs_params(input_dev, ABS_Y, 0, 255, 0, 0); |
| 361 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 362 | } |
| 363 | |
Dmitry Torokhov | 6b50d8b | 2006-08-05 00:27:00 -0400 | [diff] [blame] | 364 | err = input_register_device(elo->dev); |
| 365 | if (err) |
| 366 | goto fail3; |
| 367 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 368 | return 0; |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 369 | |
Dmitry Torokhov | 6b50d8b | 2006-08-05 00:27:00 -0400 | [diff] [blame] | 370 | fail3: serio_close(serio); |
| 371 | fail2: serio_set_drvdata(serio, NULL); |
| 372 | fail1: input_free_device(input_dev); |
Dmitry Torokhov | eca1ed1 | 2005-09-15 02:01:46 -0500 | [diff] [blame] | 373 | kfree(elo); |
| 374 | return err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 375 | } |
| 376 | |
| 377 | /* |
| 378 | * The serio driver structure. |
| 379 | */ |
| 380 | |
Arvind Yadav | 4f8d524 | 2017-08-18 17:10:53 -0700 | [diff] [blame] | 381 | static const struct serio_device_id elo_serio_ids[] = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 382 | { |
| 383 | .type = SERIO_RS232, |
| 384 | .proto = SERIO_ELO, |
| 385 | .id = SERIO_ANY, |
| 386 | .extra = SERIO_ANY, |
| 387 | }, |
| 388 | { 0 } |
| 389 | }; |
| 390 | |
| 391 | MODULE_DEVICE_TABLE(serio, elo_serio_ids); |
| 392 | |
| 393 | static struct serio_driver elo_drv = { |
| 394 | .driver = { |
| 395 | .name = "elo", |
| 396 | }, |
| 397 | .description = DRIVER_DESC, |
| 398 | .id_table = elo_serio_ids, |
| 399 | .interrupt = elo_interrupt, |
| 400 | .connect = elo_connect, |
| 401 | .disconnect = elo_disconnect, |
| 402 | }; |
| 403 | |
Axel Lin | 65ac9f7 | 2012-04-03 23:50:17 -0700 | [diff] [blame] | 404 | module_serio_driver(elo_drv); |