Arjan Opmeer | 2a0bd75 | 2008-10-16 22:10:19 -0400 | [diff] [blame] | 1 | /* |
Arjan Opmeer | 3f8c0df | 2009-04-18 19:05:40 -0700 | [diff] [blame^] | 2 | * Elantech Touchpad driver (v6) |
Arjan Opmeer | 2a0bd75 | 2008-10-16 22:10:19 -0400 | [diff] [blame] | 3 | * |
Arjan Opmeer | 3f8c0df | 2009-04-18 19:05:40 -0700 | [diff] [blame^] | 4 | * Copyright (C) 2007-2009 Arjan Opmeer <arjan@opmeer.net> |
Arjan Opmeer | 2a0bd75 | 2008-10-16 22:10:19 -0400 | [diff] [blame] | 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify it |
| 7 | * under the terms of the GNU General Public License version 2 as published |
| 8 | * by the Free Software Foundation. |
| 9 | * |
| 10 | * Trademarks are the property of their respective owners. |
| 11 | */ |
| 12 | |
| 13 | #include <linux/delay.h> |
| 14 | #include <linux/module.h> |
| 15 | #include <linux/input.h> |
| 16 | #include <linux/serio.h> |
| 17 | #include <linux/libps2.h> |
| 18 | #include "psmouse.h" |
| 19 | #include "elantech.h" |
| 20 | |
| 21 | #define elantech_debug(format, arg...) \ |
| 22 | do { \ |
| 23 | if (etd->debug) \ |
| 24 | printk(KERN_DEBUG format, ##arg); \ |
| 25 | } while (0) |
| 26 | |
| 27 | /* |
| 28 | * Send a Synaptics style sliced query command |
| 29 | */ |
| 30 | static int synaptics_send_cmd(struct psmouse *psmouse, unsigned char c, |
| 31 | unsigned char *param) |
| 32 | { |
| 33 | if (psmouse_sliced_command(psmouse, c) || |
| 34 | ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETINFO)) { |
| 35 | pr_err("elantech.c: synaptics_send_cmd query 0x%02x failed.\n", c); |
| 36 | return -1; |
| 37 | } |
| 38 | |
| 39 | return 0; |
| 40 | } |
| 41 | |
| 42 | /* |
| 43 | * A retrying version of ps2_command |
| 44 | */ |
| 45 | static int elantech_ps2_command(struct psmouse *psmouse, |
| 46 | unsigned char *param, int command) |
| 47 | { |
| 48 | struct ps2dev *ps2dev = &psmouse->ps2dev; |
| 49 | struct elantech_data *etd = psmouse->private; |
| 50 | int rc; |
| 51 | int tries = ETP_PS2_COMMAND_TRIES; |
| 52 | |
| 53 | do { |
| 54 | rc = ps2_command(ps2dev, param, command); |
| 55 | if (rc == 0) |
| 56 | break; |
| 57 | tries--; |
| 58 | elantech_debug("elantech.c: retrying ps2 command 0x%02x (%d).\n", |
| 59 | command, tries); |
| 60 | msleep(ETP_PS2_COMMAND_DELAY); |
| 61 | } while (tries > 0); |
| 62 | |
| 63 | if (rc) |
| 64 | pr_err("elantech.c: ps2 command 0x%02x failed.\n", command); |
| 65 | |
| 66 | return rc; |
| 67 | } |
| 68 | |
| 69 | /* |
| 70 | * Send an Elantech style special command to read a value from a register |
| 71 | */ |
| 72 | static int elantech_read_reg(struct psmouse *psmouse, unsigned char reg, |
| 73 | unsigned char *val) |
| 74 | { |
| 75 | struct elantech_data *etd = psmouse->private; |
| 76 | unsigned char param[3]; |
| 77 | int rc = 0; |
| 78 | |
| 79 | if (reg < 0x10 || reg > 0x26) |
| 80 | return -1; |
| 81 | |
| 82 | if (reg > 0x11 && reg < 0x20) |
| 83 | return -1; |
| 84 | |
| 85 | switch (etd->hw_version) { |
| 86 | case 1: |
| 87 | if (psmouse_sliced_command(psmouse, ETP_REGISTER_READ) || |
| 88 | psmouse_sliced_command(psmouse, reg) || |
| 89 | ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETINFO)) { |
| 90 | rc = -1; |
| 91 | } |
| 92 | break; |
| 93 | |
| 94 | case 2: |
| 95 | if (elantech_ps2_command(psmouse, NULL, ETP_PS2_CUSTOM_COMMAND) || |
| 96 | elantech_ps2_command(psmouse, NULL, ETP_REGISTER_READ) || |
| 97 | elantech_ps2_command(psmouse, NULL, ETP_PS2_CUSTOM_COMMAND) || |
| 98 | elantech_ps2_command(psmouse, NULL, reg) || |
| 99 | elantech_ps2_command(psmouse, param, PSMOUSE_CMD_GETINFO)) { |
| 100 | rc = -1; |
| 101 | } |
| 102 | break; |
| 103 | } |
| 104 | |
| 105 | if (rc) |
| 106 | pr_err("elantech.c: failed to read register 0x%02x.\n", reg); |
| 107 | else |
| 108 | *val = param[0]; |
| 109 | |
| 110 | return rc; |
| 111 | } |
| 112 | |
| 113 | /* |
| 114 | * Send an Elantech style special command to write a register with a value |
| 115 | */ |
| 116 | static int elantech_write_reg(struct psmouse *psmouse, unsigned char reg, |
| 117 | unsigned char val) |
| 118 | { |
| 119 | struct elantech_data *etd = psmouse->private; |
| 120 | int rc = 0; |
| 121 | |
| 122 | if (reg < 0x10 || reg > 0x26) |
| 123 | return -1; |
| 124 | |
| 125 | if (reg > 0x11 && reg < 0x20) |
| 126 | return -1; |
| 127 | |
| 128 | switch (etd->hw_version) { |
| 129 | case 1: |
| 130 | if (psmouse_sliced_command(psmouse, ETP_REGISTER_WRITE) || |
| 131 | psmouse_sliced_command(psmouse, reg) || |
| 132 | psmouse_sliced_command(psmouse, val) || |
| 133 | ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_SETSCALE11)) { |
| 134 | rc = -1; |
| 135 | } |
| 136 | break; |
| 137 | |
| 138 | case 2: |
| 139 | if (elantech_ps2_command(psmouse, NULL, ETP_PS2_CUSTOM_COMMAND) || |
| 140 | elantech_ps2_command(psmouse, NULL, ETP_REGISTER_WRITE) || |
| 141 | elantech_ps2_command(psmouse, NULL, ETP_PS2_CUSTOM_COMMAND) || |
| 142 | elantech_ps2_command(psmouse, NULL, reg) || |
| 143 | elantech_ps2_command(psmouse, NULL, ETP_PS2_CUSTOM_COMMAND) || |
| 144 | elantech_ps2_command(psmouse, NULL, val) || |
| 145 | elantech_ps2_command(psmouse, NULL, PSMOUSE_CMD_SETSCALE11)) { |
| 146 | rc = -1; |
| 147 | } |
| 148 | break; |
| 149 | } |
| 150 | |
| 151 | if (rc) |
| 152 | pr_err("elantech.c: failed to write register 0x%02x with value 0x%02x.\n", |
| 153 | reg, val); |
| 154 | |
| 155 | return rc; |
| 156 | } |
| 157 | |
| 158 | /* |
| 159 | * Dump a complete mouse movement packet to the syslog |
| 160 | */ |
| 161 | static void elantech_packet_dump(unsigned char *packet, int size) |
| 162 | { |
| 163 | int i; |
| 164 | |
| 165 | printk(KERN_DEBUG "elantech.c: PS/2 packet ["); |
| 166 | for (i = 0; i < size; i++) |
| 167 | printk("%s0x%02x ", (i) ? ", " : " ", packet[i]); |
| 168 | printk("]\n"); |
| 169 | } |
| 170 | |
| 171 | /* |
| 172 | * Interpret complete data packets and report absolute mode input events for |
| 173 | * hardware version 1. (4 byte packets) |
| 174 | */ |
| 175 | static void elantech_report_absolute_v1(struct psmouse *psmouse) |
| 176 | { |
| 177 | struct input_dev *dev = psmouse->dev; |
| 178 | struct elantech_data *etd = psmouse->private; |
| 179 | unsigned char *packet = psmouse->packet; |
| 180 | int fingers; |
Arjan Opmeer | 3f8c0df | 2009-04-18 19:05:40 -0700 | [diff] [blame^] | 181 | static int old_fingers; |
Arjan Opmeer | 2a0bd75 | 2008-10-16 22:10:19 -0400 | [diff] [blame] | 182 | |
| 183 | if (etd->fw_version_maj == 0x01) { |
| 184 | /* byte 0: D U p1 p2 1 p3 R L |
| 185 | byte 1: f 0 th tw x9 x8 y9 y8 */ |
| 186 | fingers = ((packet[1] & 0x80) >> 7) + |
| 187 | ((packet[1] & 0x30) >> 4); |
| 188 | } else { |
| 189 | /* byte 0: n1 n0 p2 p1 1 p3 R L |
| 190 | byte 1: 0 0 0 0 x9 x8 y9 y8 */ |
| 191 | fingers = (packet[0] & 0xc0) >> 6; |
| 192 | } |
| 193 | |
Arjan Opmeer | 3f8c0df | 2009-04-18 19:05:40 -0700 | [diff] [blame^] | 194 | if (etd->jumpy_cursor) { |
| 195 | /* Discard packets that are likely to have bogus coordinates */ |
| 196 | if (fingers > old_fingers) { |
| 197 | elantech_debug("elantech.c: discarding packet\n"); |
| 198 | goto discard_packet_v1; |
| 199 | } |
| 200 | } |
| 201 | |
Arjan Opmeer | 2a0bd75 | 2008-10-16 22:10:19 -0400 | [diff] [blame] | 202 | input_report_key(dev, BTN_TOUCH, fingers != 0); |
| 203 | |
| 204 | /* byte 2: x7 x6 x5 x4 x3 x2 x1 x0 |
| 205 | byte 3: y7 y6 y5 y4 y3 y2 y1 y0 */ |
| 206 | if (fingers) { |
| 207 | input_report_abs(dev, ABS_X, |
| 208 | ((packet[1] & 0x0c) << 6) | packet[2]); |
| 209 | input_report_abs(dev, ABS_Y, ETP_YMAX_V1 - |
| 210 | (((packet[1] & 0x03) << 8) | packet[3])); |
| 211 | } |
| 212 | |
| 213 | input_report_key(dev, BTN_TOOL_FINGER, fingers == 1); |
| 214 | input_report_key(dev, BTN_TOOL_DOUBLETAP, fingers == 2); |
| 215 | input_report_key(dev, BTN_TOOL_TRIPLETAP, fingers == 3); |
| 216 | input_report_key(dev, BTN_LEFT, packet[0] & 0x01); |
| 217 | input_report_key(dev, BTN_RIGHT, packet[0] & 0x02); |
| 218 | |
| 219 | if ((etd->fw_version_maj == 0x01) && |
| 220 | (etd->capabilities & ETP_CAP_HAS_ROCKER)) { |
| 221 | /* rocker up */ |
| 222 | input_report_key(dev, BTN_FORWARD, packet[0] & 0x40); |
| 223 | /* rocker down */ |
| 224 | input_report_key(dev, BTN_BACK, packet[0] & 0x80); |
| 225 | } |
| 226 | |
| 227 | input_sync(dev); |
Arjan Opmeer | 3f8c0df | 2009-04-18 19:05:40 -0700 | [diff] [blame^] | 228 | |
| 229 | discard_packet_v1: |
| 230 | old_fingers = fingers; |
Arjan Opmeer | 2a0bd75 | 2008-10-16 22:10:19 -0400 | [diff] [blame] | 231 | } |
| 232 | |
| 233 | /* |
| 234 | * Interpret complete data packets and report absolute mode input events for |
| 235 | * hardware version 2. (6 byte packets) |
| 236 | */ |
| 237 | static void elantech_report_absolute_v2(struct psmouse *psmouse) |
| 238 | { |
| 239 | struct input_dev *dev = psmouse->dev; |
| 240 | unsigned char *packet = psmouse->packet; |
| 241 | int fingers, x1, y1, x2, y2; |
| 242 | |
| 243 | /* byte 0: n1 n0 . . . . R L */ |
| 244 | fingers = (packet[0] & 0xc0) >> 6; |
| 245 | input_report_key(dev, BTN_TOUCH, fingers != 0); |
| 246 | |
| 247 | switch (fingers) { |
| 248 | case 1: |
| 249 | /* byte 1: x15 x14 x13 x12 x11 x10 x9 x8 |
| 250 | byte 2: x7 x6 x5 x4 x4 x2 x1 x0 */ |
| 251 | input_report_abs(dev, ABS_X, (packet[1] << 8) | packet[2]); |
| 252 | /* byte 4: y15 y14 y13 y12 y11 y10 y8 y8 |
| 253 | byte 5: y7 y6 y5 y4 y3 y2 y1 y0 */ |
| 254 | input_report_abs(dev, ABS_Y, ETP_YMAX_V2 - |
| 255 | ((packet[4] << 8) | packet[5])); |
| 256 | break; |
| 257 | |
| 258 | case 2: |
| 259 | /* The coordinate of each finger is reported separately with |
| 260 | a lower resolution for two finger touches */ |
| 261 | /* byte 0: . . ay8 ax8 . . . . |
| 262 | byte 1: ax7 ax6 ax5 ax4 ax3 ax2 ax1 ax0 */ |
| 263 | x1 = ((packet[0] & 0x10) << 4) | packet[1]; |
| 264 | /* byte 2: ay7 ay6 ay5 ay4 ay3 ay2 ay1 ay0 */ |
| 265 | y1 = ETP_2FT_YMAX - (((packet[0] & 0x20) << 3) | packet[2]); |
| 266 | /* byte 3: . . by8 bx8 . . . . |
| 267 | byte 4: bx7 bx6 bx5 bx4 bx3 bx2 bx1 bx0 */ |
| 268 | x2 = ((packet[3] & 0x10) << 4) | packet[4]; |
| 269 | /* byte 5: by7 by8 by5 by4 by3 by2 by1 by0 */ |
| 270 | y2 = ETP_2FT_YMAX - (((packet[3] & 0x20) << 3) | packet[5]); |
| 271 | /* For compatibility with the X Synaptics driver scale up one |
| 272 | coordinate and report as ordinary mouse movent */ |
| 273 | input_report_abs(dev, ABS_X, x1 << 2); |
| 274 | input_report_abs(dev, ABS_Y, y1 << 2); |
| 275 | /* For compatibility with the proprietary X Elantech driver |
| 276 | report both coordinates as hat coordinates */ |
| 277 | input_report_abs(dev, ABS_HAT0X, x1); |
| 278 | input_report_abs(dev, ABS_HAT0Y, y1); |
| 279 | input_report_abs(dev, ABS_HAT1X, x2); |
| 280 | input_report_abs(dev, ABS_HAT1Y, y2); |
| 281 | break; |
| 282 | } |
| 283 | |
| 284 | input_report_key(dev, BTN_TOOL_FINGER, fingers == 1); |
| 285 | input_report_key(dev, BTN_TOOL_DOUBLETAP, fingers == 2); |
| 286 | input_report_key(dev, BTN_TOOL_TRIPLETAP, fingers == 3); |
| 287 | input_report_key(dev, BTN_LEFT, packet[0] & 0x01); |
| 288 | input_report_key(dev, BTN_RIGHT, packet[0] & 0x02); |
| 289 | |
| 290 | input_sync(dev); |
| 291 | } |
| 292 | |
| 293 | static int elantech_check_parity_v1(struct psmouse *psmouse) |
| 294 | { |
| 295 | struct elantech_data *etd = psmouse->private; |
| 296 | unsigned char *packet = psmouse->packet; |
| 297 | unsigned char p1, p2, p3; |
| 298 | |
| 299 | /* Parity bits are placed differently */ |
| 300 | if (etd->fw_version_maj == 0x01) { |
| 301 | /* byte 0: D U p1 p2 1 p3 R L */ |
| 302 | p1 = (packet[0] & 0x20) >> 5; |
| 303 | p2 = (packet[0] & 0x10) >> 4; |
| 304 | } else { |
| 305 | /* byte 0: n1 n0 p2 p1 1 p3 R L */ |
| 306 | p1 = (packet[0] & 0x10) >> 4; |
| 307 | p2 = (packet[0] & 0x20) >> 5; |
| 308 | } |
| 309 | |
| 310 | p3 = (packet[0] & 0x04) >> 2; |
| 311 | |
| 312 | return etd->parity[packet[1]] == p1 && |
| 313 | etd->parity[packet[2]] == p2 && |
| 314 | etd->parity[packet[3]] == p3; |
| 315 | } |
| 316 | |
| 317 | /* |
| 318 | * Process byte stream from mouse and handle complete packets |
| 319 | */ |
| 320 | static psmouse_ret_t elantech_process_byte(struct psmouse *psmouse) |
| 321 | { |
| 322 | struct elantech_data *etd = psmouse->private; |
| 323 | |
| 324 | if (psmouse->pktcnt < psmouse->pktsize) |
| 325 | return PSMOUSE_GOOD_DATA; |
| 326 | |
| 327 | if (etd->debug > 1) |
| 328 | elantech_packet_dump(psmouse->packet, psmouse->pktsize); |
| 329 | |
| 330 | switch (etd->hw_version) { |
| 331 | case 1: |
| 332 | if (etd->paritycheck && !elantech_check_parity_v1(psmouse)) |
| 333 | return PSMOUSE_BAD_DATA; |
| 334 | |
| 335 | elantech_report_absolute_v1(psmouse); |
| 336 | break; |
| 337 | |
| 338 | case 2: |
| 339 | /* We don't know how to check parity in protocol v2 */ |
| 340 | elantech_report_absolute_v2(psmouse); |
| 341 | break; |
| 342 | } |
| 343 | |
| 344 | return PSMOUSE_FULL_PACKET; |
| 345 | } |
| 346 | |
| 347 | /* |
| 348 | * Put the touchpad into absolute mode |
| 349 | */ |
| 350 | static int elantech_set_absolute_mode(struct psmouse *psmouse) |
| 351 | { |
| 352 | struct elantech_data *etd = psmouse->private; |
| 353 | unsigned char val; |
| 354 | int tries = ETP_READ_BACK_TRIES; |
| 355 | int rc = 0; |
| 356 | |
| 357 | switch (etd->hw_version) { |
| 358 | case 1: |
| 359 | etd->reg_10 = 0x16; |
| 360 | etd->reg_11 = 0x8f; |
| 361 | if (elantech_write_reg(psmouse, 0x10, etd->reg_10) || |
| 362 | elantech_write_reg(psmouse, 0x11, etd->reg_11)) { |
| 363 | rc = -1; |
| 364 | } |
| 365 | break; |
| 366 | |
| 367 | case 2: |
| 368 | /* Windows driver values */ |
| 369 | etd->reg_10 = 0x54; |
| 370 | etd->reg_11 = 0x88; /* 0x8a */ |
| 371 | etd->reg_21 = 0x60; /* 0x00 */ |
| 372 | if (elantech_write_reg(psmouse, 0x10, etd->reg_10) || |
| 373 | elantech_write_reg(psmouse, 0x11, etd->reg_11) || |
| 374 | elantech_write_reg(psmouse, 0x21, etd->reg_21)) { |
| 375 | rc = -1; |
| 376 | break; |
| 377 | } |
| 378 | /* |
| 379 | * Read back reg 0x10. The touchpad is probably initalising |
| 380 | * and not ready until we read back the value we just wrote. |
| 381 | */ |
| 382 | do { |
| 383 | rc = elantech_read_reg(psmouse, 0x10, &val); |
| 384 | if (rc == 0) |
| 385 | break; |
| 386 | tries--; |
| 387 | elantech_debug("elantech.c: retrying read (%d).\n", |
| 388 | tries); |
| 389 | msleep(ETP_READ_BACK_DELAY); |
| 390 | } while (tries > 0); |
| 391 | if (rc) |
| 392 | pr_err("elantech.c: failed to read back register 0x10.\n"); |
| 393 | break; |
| 394 | } |
| 395 | |
| 396 | if (rc) |
| 397 | pr_err("elantech.c: failed to initialise registers.\n"); |
| 398 | |
| 399 | return rc; |
| 400 | } |
| 401 | |
| 402 | /* |
| 403 | * Set the appropriate event bits for the input subsystem |
| 404 | */ |
| 405 | static void elantech_set_input_params(struct psmouse *psmouse) |
| 406 | { |
| 407 | struct input_dev *dev = psmouse->dev; |
| 408 | struct elantech_data *etd = psmouse->private; |
| 409 | |
| 410 | __set_bit(EV_KEY, dev->evbit); |
| 411 | __set_bit(EV_ABS, dev->evbit); |
| 412 | |
| 413 | __set_bit(BTN_LEFT, dev->keybit); |
| 414 | __set_bit(BTN_RIGHT, dev->keybit); |
| 415 | |
| 416 | __set_bit(BTN_TOUCH, dev->keybit); |
| 417 | __set_bit(BTN_TOOL_FINGER, dev->keybit); |
| 418 | __set_bit(BTN_TOOL_DOUBLETAP, dev->keybit); |
| 419 | __set_bit(BTN_TOOL_TRIPLETAP, dev->keybit); |
| 420 | |
| 421 | switch (etd->hw_version) { |
| 422 | case 1: |
| 423 | /* Rocker button */ |
| 424 | if ((etd->fw_version_maj == 0x01) && |
| 425 | (etd->capabilities & ETP_CAP_HAS_ROCKER)) { |
| 426 | __set_bit(BTN_FORWARD, dev->keybit); |
| 427 | __set_bit(BTN_BACK, dev->keybit); |
| 428 | } |
| 429 | input_set_abs_params(dev, ABS_X, ETP_XMIN_V1, ETP_XMAX_V1, 0, 0); |
| 430 | input_set_abs_params(dev, ABS_Y, ETP_YMIN_V1, ETP_YMAX_V1, 0, 0); |
| 431 | break; |
| 432 | |
| 433 | case 2: |
| 434 | input_set_abs_params(dev, ABS_X, ETP_XMIN_V2, ETP_XMAX_V2, 0, 0); |
| 435 | input_set_abs_params(dev, ABS_Y, ETP_YMIN_V2, ETP_YMAX_V2, 0, 0); |
| 436 | input_set_abs_params(dev, ABS_HAT0X, ETP_2FT_XMIN, ETP_2FT_XMAX, 0, 0); |
| 437 | input_set_abs_params(dev, ABS_HAT0Y, ETP_2FT_YMIN, ETP_2FT_YMAX, 0, 0); |
| 438 | input_set_abs_params(dev, ABS_HAT1X, ETP_2FT_XMIN, ETP_2FT_XMAX, 0, 0); |
| 439 | input_set_abs_params(dev, ABS_HAT1Y, ETP_2FT_YMIN, ETP_2FT_YMAX, 0, 0); |
| 440 | break; |
| 441 | } |
| 442 | } |
| 443 | |
| 444 | struct elantech_attr_data { |
| 445 | size_t field_offset; |
| 446 | unsigned char reg; |
| 447 | }; |
| 448 | |
| 449 | /* |
| 450 | * Display a register value by reading a sysfs entry |
| 451 | */ |
| 452 | static ssize_t elantech_show_int_attr(struct psmouse *psmouse, void *data, |
| 453 | char *buf) |
| 454 | { |
| 455 | struct elantech_data *etd = psmouse->private; |
| 456 | struct elantech_attr_data *attr = data; |
| 457 | unsigned char *reg = (unsigned char *) etd + attr->field_offset; |
| 458 | int rc = 0; |
| 459 | |
| 460 | if (attr->reg) |
| 461 | rc = elantech_read_reg(psmouse, attr->reg, reg); |
| 462 | |
| 463 | return sprintf(buf, "0x%02x\n", (attr->reg && rc) ? -1 : *reg); |
| 464 | } |
| 465 | |
| 466 | /* |
| 467 | * Write a register value by writing a sysfs entry |
| 468 | */ |
| 469 | static ssize_t elantech_set_int_attr(struct psmouse *psmouse, |
| 470 | void *data, const char *buf, size_t count) |
| 471 | { |
| 472 | struct elantech_data *etd = psmouse->private; |
| 473 | struct elantech_attr_data *attr = data; |
| 474 | unsigned char *reg = (unsigned char *) etd + attr->field_offset; |
| 475 | unsigned long value; |
| 476 | int err; |
| 477 | |
| 478 | err = strict_strtoul(buf, 16, &value); |
| 479 | if (err) |
| 480 | return err; |
| 481 | |
| 482 | if (value > 0xff) |
| 483 | return -EINVAL; |
| 484 | |
| 485 | /* Do we need to preserve some bits for version 2 hardware too? */ |
| 486 | if (etd->hw_version == 1) { |
| 487 | if (attr->reg == 0x10) |
| 488 | /* Force absolute mode always on */ |
| 489 | value |= ETP_R10_ABSOLUTE_MODE; |
| 490 | else if (attr->reg == 0x11) |
| 491 | /* Force 4 byte mode always on */ |
| 492 | value |= ETP_R11_4_BYTE_MODE; |
| 493 | } |
| 494 | |
| 495 | if (!attr->reg || elantech_write_reg(psmouse, attr->reg, value) == 0) |
| 496 | *reg = value; |
| 497 | |
| 498 | return count; |
| 499 | } |
| 500 | |
| 501 | #define ELANTECH_INT_ATTR(_name, _register) \ |
| 502 | static struct elantech_attr_data elantech_attr_##_name = { \ |
| 503 | .field_offset = offsetof(struct elantech_data, _name), \ |
| 504 | .reg = _register, \ |
| 505 | }; \ |
| 506 | PSMOUSE_DEFINE_ATTR(_name, S_IWUSR | S_IRUGO, \ |
| 507 | &elantech_attr_##_name, \ |
| 508 | elantech_show_int_attr, \ |
| 509 | elantech_set_int_attr) |
| 510 | |
| 511 | ELANTECH_INT_ATTR(reg_10, 0x10); |
| 512 | ELANTECH_INT_ATTR(reg_11, 0x11); |
| 513 | ELANTECH_INT_ATTR(reg_20, 0x20); |
| 514 | ELANTECH_INT_ATTR(reg_21, 0x21); |
| 515 | ELANTECH_INT_ATTR(reg_22, 0x22); |
| 516 | ELANTECH_INT_ATTR(reg_23, 0x23); |
| 517 | ELANTECH_INT_ATTR(reg_24, 0x24); |
| 518 | ELANTECH_INT_ATTR(reg_25, 0x25); |
| 519 | ELANTECH_INT_ATTR(reg_26, 0x26); |
| 520 | ELANTECH_INT_ATTR(debug, 0); |
| 521 | ELANTECH_INT_ATTR(paritycheck, 0); |
| 522 | |
| 523 | static struct attribute *elantech_attrs[] = { |
| 524 | &psmouse_attr_reg_10.dattr.attr, |
| 525 | &psmouse_attr_reg_11.dattr.attr, |
| 526 | &psmouse_attr_reg_20.dattr.attr, |
| 527 | &psmouse_attr_reg_21.dattr.attr, |
| 528 | &psmouse_attr_reg_22.dattr.attr, |
| 529 | &psmouse_attr_reg_23.dattr.attr, |
| 530 | &psmouse_attr_reg_24.dattr.attr, |
| 531 | &psmouse_attr_reg_25.dattr.attr, |
| 532 | &psmouse_attr_reg_26.dattr.attr, |
| 533 | &psmouse_attr_debug.dattr.attr, |
| 534 | &psmouse_attr_paritycheck.dattr.attr, |
| 535 | NULL |
| 536 | }; |
| 537 | |
| 538 | static struct attribute_group elantech_attr_group = { |
| 539 | .attrs = elantech_attrs, |
| 540 | }; |
| 541 | |
| 542 | /* |
| 543 | * Use magic knock to detect Elantech touchpad |
| 544 | */ |
| 545 | int elantech_detect(struct psmouse *psmouse, int set_properties) |
| 546 | { |
| 547 | struct ps2dev *ps2dev = &psmouse->ps2dev; |
| 548 | unsigned char param[3]; |
| 549 | |
| 550 | ps2_command(&psmouse->ps2dev, NULL, PSMOUSE_CMD_RESET_DIS); |
| 551 | |
| 552 | if (ps2_command(ps2dev, NULL, PSMOUSE_CMD_DISABLE) || |
| 553 | ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11) || |
| 554 | ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11) || |
| 555 | ps2_command(ps2dev, NULL, PSMOUSE_CMD_SETSCALE11) || |
| 556 | ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO)) { |
Arjan Opmeer | 9ab7b25 | 2009-02-28 13:52:40 -0800 | [diff] [blame] | 557 | pr_debug("elantech.c: sending Elantech magic knock failed.\n"); |
Arjan Opmeer | 2a0bd75 | 2008-10-16 22:10:19 -0400 | [diff] [blame] | 558 | return -1; |
| 559 | } |
| 560 | |
| 561 | /* |
| 562 | * Report this in case there are Elantech models that use a different |
| 563 | * set of magic numbers |
| 564 | */ |
| 565 | if (param[0] != 0x3c || param[1] != 0x03 || param[2] != 0xc8) { |
Arjan Opmeer | 9ab7b25 | 2009-02-28 13:52:40 -0800 | [diff] [blame] | 566 | pr_debug("elantech.c: " |
| 567 | "unexpected magic knock result 0x%02x, 0x%02x, 0x%02x.\n", |
| 568 | param[0], param[1], param[2]); |
| 569 | return -1; |
| 570 | } |
| 571 | |
| 572 | /* |
| 573 | * Query touchpad's firmware version and see if it reports known |
| 574 | * value to avoid mis-detection. Logitech mice are known to respond |
| 575 | * to Elantech magic knock and there might be more. |
| 576 | */ |
| 577 | if (synaptics_send_cmd(psmouse, ETP_FW_VERSION_QUERY, param)) { |
| 578 | pr_debug("elantech.c: failed to query firmware version.\n"); |
| 579 | return -1; |
| 580 | } |
| 581 | |
| 582 | pr_debug("elantech.c: Elantech version query result 0x%02x, 0x%02x, 0x%02x.\n", |
| 583 | param[0], param[1], param[2]); |
| 584 | |
| 585 | if (param[0] == 0 || param[1] != 0) { |
| 586 | pr_debug("elantech.c: Probably not a real Elantech touchpad. Aborting.\n"); |
Arjan Opmeer | 2a0bd75 | 2008-10-16 22:10:19 -0400 | [diff] [blame] | 587 | return -1; |
| 588 | } |
| 589 | |
| 590 | if (set_properties) { |
| 591 | psmouse->vendor = "Elantech"; |
| 592 | psmouse->name = "Touchpad"; |
| 593 | } |
| 594 | |
| 595 | return 0; |
| 596 | } |
| 597 | |
| 598 | /* |
| 599 | * Clean up sysfs entries when disconnecting |
| 600 | */ |
| 601 | static void elantech_disconnect(struct psmouse *psmouse) |
| 602 | { |
| 603 | sysfs_remove_group(&psmouse->ps2dev.serio->dev.kobj, |
| 604 | &elantech_attr_group); |
| 605 | kfree(psmouse->private); |
| 606 | psmouse->private = NULL; |
| 607 | } |
| 608 | |
| 609 | /* |
| 610 | * Put the touchpad back into absolute mode when reconnecting |
| 611 | */ |
| 612 | static int elantech_reconnect(struct psmouse *psmouse) |
| 613 | { |
| 614 | if (elantech_detect(psmouse, 0)) |
| 615 | return -1; |
| 616 | |
| 617 | if (elantech_set_absolute_mode(psmouse)) { |
| 618 | pr_err("elantech.c: failed to put touchpad back into absolute mode.\n"); |
| 619 | return -1; |
| 620 | } |
| 621 | |
| 622 | return 0; |
| 623 | } |
| 624 | |
| 625 | /* |
| 626 | * Initialize the touchpad and create sysfs entries |
| 627 | */ |
| 628 | int elantech_init(struct psmouse *psmouse) |
| 629 | { |
| 630 | struct elantech_data *etd; |
| 631 | int i, error; |
| 632 | unsigned char param[3]; |
| 633 | |
Arjan Opmeer | 9ab7b25 | 2009-02-28 13:52:40 -0800 | [diff] [blame] | 634 | psmouse->private = etd = kzalloc(sizeof(struct elantech_data), GFP_KERNEL); |
Arjan Opmeer | 2a0bd75 | 2008-10-16 22:10:19 -0400 | [diff] [blame] | 635 | if (!etd) |
| 636 | return -1; |
| 637 | |
| 638 | etd->parity[0] = 1; |
| 639 | for (i = 1; i < 256; i++) |
| 640 | etd->parity[i] = etd->parity[i & (i - 1)] ^ 1; |
| 641 | |
| 642 | /* |
Arjan Opmeer | 9ab7b25 | 2009-02-28 13:52:40 -0800 | [diff] [blame] | 643 | * Do the version query again so we can store the result |
Arjan Opmeer | 2a0bd75 | 2008-10-16 22:10:19 -0400 | [diff] [blame] | 644 | */ |
| 645 | if (synaptics_send_cmd(psmouse, ETP_FW_VERSION_QUERY, param)) { |
| 646 | pr_err("elantech.c: failed to query firmware version.\n"); |
| 647 | goto init_fail; |
| 648 | } |
Arjan Opmeer | 2a0bd75 | 2008-10-16 22:10:19 -0400 | [diff] [blame] | 649 | etd->fw_version_maj = param[0]; |
| 650 | etd->fw_version_min = param[2]; |
| 651 | |
| 652 | /* |
| 653 | * Assume every version greater than this is new EeePC style |
| 654 | * hardware with 6 byte packets |
| 655 | */ |
| 656 | if (etd->fw_version_maj >= 0x02 && etd->fw_version_min >= 0x30) { |
| 657 | etd->hw_version = 2; |
| 658 | /* For now show extra debug information */ |
| 659 | etd->debug = 1; |
| 660 | /* Don't know how to do parity checking for version 2 */ |
| 661 | etd->paritycheck = 0; |
| 662 | } else { |
| 663 | etd->hw_version = 1; |
| 664 | etd->paritycheck = 1; |
| 665 | } |
| 666 | pr_info("elantech.c: assuming hardware version %d, firmware version %d.%d\n", |
| 667 | etd->hw_version, etd->fw_version_maj, etd->fw_version_min); |
| 668 | |
| 669 | if (synaptics_send_cmd(psmouse, ETP_CAPABILITIES_QUERY, param)) { |
| 670 | pr_err("elantech.c: failed to query capabilities.\n"); |
| 671 | goto init_fail; |
| 672 | } |
| 673 | pr_info("elantech.c: Synaptics capabilities query result 0x%02x, 0x%02x, 0x%02x.\n", |
| 674 | param[0], param[1], param[2]); |
| 675 | etd->capabilities = param[0]; |
| 676 | |
Arjan Opmeer | 3f8c0df | 2009-04-18 19:05:40 -0700 | [diff] [blame^] | 677 | /* |
| 678 | * This firmware seems to suffer from misreporting coordinates when |
| 679 | * a touch action starts causing the mouse cursor or scrolled page |
| 680 | * to jump. Enable a workaround. |
| 681 | */ |
| 682 | if (etd->fw_version_maj == 0x02 && etd->fw_version_min == 0x22) { |
| 683 | pr_info("elantech.c: firmware version 2.34 detected, " |
| 684 | "enabling jumpy cursor workaround\n"); |
| 685 | etd->jumpy_cursor = 1; |
| 686 | } |
| 687 | |
Arjan Opmeer | 2a0bd75 | 2008-10-16 22:10:19 -0400 | [diff] [blame] | 688 | if (elantech_set_absolute_mode(psmouse)) { |
| 689 | pr_err("elantech.c: failed to put touchpad into absolute mode.\n"); |
| 690 | goto init_fail; |
| 691 | } |
| 692 | |
| 693 | elantech_set_input_params(psmouse); |
| 694 | |
| 695 | error = sysfs_create_group(&psmouse->ps2dev.serio->dev.kobj, |
| 696 | &elantech_attr_group); |
| 697 | if (error) { |
| 698 | pr_err("elantech.c: failed to create sysfs attributes, error: %d.\n", |
| 699 | error); |
| 700 | goto init_fail; |
| 701 | } |
| 702 | |
| 703 | psmouse->protocol_handler = elantech_process_byte; |
| 704 | psmouse->disconnect = elantech_disconnect; |
| 705 | psmouse->reconnect = elantech_reconnect; |
| 706 | psmouse->pktsize = etd->hw_version == 2 ? 6 : 4; |
| 707 | |
| 708 | return 0; |
| 709 | |
| 710 | init_fail: |
| 711 | kfree(etd); |
| 712 | return -1; |
| 713 | } |