]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - drivers/input/mouse/synaptics.c
projects / mirror_ubuntu-artful-kernel.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Linux 4.0-rc5
[mirror_ubuntu-artful-kernel.git] / drivers / input / mouse / synaptics.c
1 /*
2 * Synaptics TouchPad PS/2 mouse driver
3 *
4 * 2003 Dmitry Torokhov <dtor@mail.ru>
5 * Added support for pass-through port. Special thanks to Peter Berg Larsen
6 * for explaining various Synaptics quirks.
7 *
8 * 2003 Peter Osterlund <petero2@telia.com>
9 * Ported to 2.5 input device infrastructure.
10 *
11 * Copyright (C) 2001 Stefan Gmeiner <riddlebox@freesurf.ch>
12 * start merging tpconfig and gpm code to a xfree-input module
13 * adding some changes and extensions (ex. 3rd and 4th button)
14 *
15 * Copyright (c) 1997 C. Scott Ananian <cananian@alumni.priceton.edu>
16 * Copyright (c) 1998-2000 Bruce Kalk <kall@compass.com>
17 * code for the special synaptics commands (from the tpconfig-source)
18 *
19 * This program is free software; you can redistribute it and/or modify it
20 * under the terms of the GNU General Public License version 2 as published by
21 * the Free Software Foundation.
22 *
23 * Trademarks are the property of their respective owners.
24 */
25
26 #include <linux/module.h>
27 #include <linux/delay.h>
28 #include <linux/dmi.h>
29 #include <linux/input/mt.h>
30 #include <linux/serio.h>
31 #include <linux/libps2.h>
32 #include <linux/slab.h>
33 #include "psmouse.h"
34 #include "synaptics.h"
35
36 /*
37 * The x/y limits are taken from the Synaptics TouchPad interfacing Guide,
38 * section 2.3.2, which says that they should be valid regardless of the
39 * actual size of the sensor.
40 * Note that newer firmware allows querying device for maximum useable
41 * coordinates.
42 */
43 #define XMIN 0
44 #define XMAX 6143
45 #define YMIN 0
46 #define YMAX 6143
47 #define XMIN_NOMINAL 1472
48 #define XMAX_NOMINAL 5472
49 #define YMIN_NOMINAL 1408
50 #define YMAX_NOMINAL 4448
51
52 /* Size in bits of absolute position values reported by the hardware */
53 #define ABS_POS_BITS 13
54
55 /*
56 * These values should represent the absolute maximum value that will
57 * be reported for a positive position value. Some Synaptics firmware
58 * uses this value to indicate a finger near the edge of the touchpad
59 * whose precise position cannot be determined.
60 *
61 * At least one touchpad is known to report positions in excess of this
62 * value which are actually negative values truncated to the 13-bit
63 * reporting range. These values have never been observed to be lower
64 * than 8184 (i.e. -8), so we treat all values greater than 8176 as
65 * negative and any other value as positive.
66 */
67 #define X_MAX_POSITIVE 8176
68 #define Y_MAX_POSITIVE 8176
69
70 /*****************************************************************************
71 * Stuff we need even when we do not want native Synaptics support
72 ****************************************************************************/
73
74 /*
75 * Set the synaptics touchpad mode byte by special commands
76 */
77 static int synaptics_mode_cmd(struct psmouse *psmouse, unsigned char mode)
78 {
79 unsigned char param[1];
80
81 if (psmouse_sliced_command(psmouse, mode))
82 return -1;
83 param[0] = SYN_PS_SET_MODE2;
84 if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_SETRATE))
85 return -1;
86 return 0;
87 }
88
89 int synaptics_detect(struct psmouse *psmouse, bool set_properties)
90 {
91 struct ps2dev *ps2dev = &psmouse->ps2dev;
92 unsigned char param[4];
93
94 param[0] = 0;
95
96 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
97 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
98 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
99 ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
100 ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO);
101
102 if (param[1] != 0x47)
103 return -ENODEV;
104
105 if (set_properties) {
106 psmouse->vendor = "Synaptics";
107 psmouse->name = "TouchPad";
108 }
109
110 return 0;
111 }
112
113 void synaptics_reset(struct psmouse *psmouse)
114 {
115 /* reset touchpad back to relative mode, gestures enabled */
116 synaptics_mode_cmd(psmouse, 0);
117 }
118
119 #ifdef CONFIG_MOUSE_PS2_SYNAPTICS
120
121 static bool cr48_profile_sensor;
122
123 #define ANY_BOARD_ID 0
124 struct min_max_quirk {
125 const char * const *pnp_ids;
126 struct {
127 unsigned long int min, max;
128 } board_id;
129 int x_min, x_max, y_min, y_max;
130 };
131
132 static const struct min_max_quirk min_max_pnpid_table[] = {
133 {
134 (const char * const []){"LEN0033", NULL},
135 {ANY_BOARD_ID, ANY_BOARD_ID},
136 1024, 5052, 2258, 4832
137 },
138 {
139 (const char * const []){"LEN0042", NULL},
140 {ANY_BOARD_ID, ANY_BOARD_ID},
141 1232, 5710, 1156, 4696
142 },
143 {
144 (const char * const []){"LEN0034", "LEN0036", "LEN0037",
145 "LEN0039", "LEN2002", "LEN2004",
146 NULL},
147 {ANY_BOARD_ID, 2961},
148 1024, 5112, 2024, 4832
149 },
150 {
151 (const char * const []){"LEN2001", NULL},
152 {ANY_BOARD_ID, ANY_BOARD_ID},
153 1024, 5022, 2508, 4832
154 },
155 {
156 (const char * const []){"LEN2006", NULL},
157 {ANY_BOARD_ID, ANY_BOARD_ID},
158 1264, 5675, 1171, 4688
159 },
160 { }
161 };
162
163 /* This list has been kindly provided by Synaptics. */
164 static const char * const topbuttonpad_pnp_ids[] = {
165 "LEN0017",
166 "LEN0018",
167 "LEN0019",
168 "LEN0023",
169 "LEN002A",
170 "LEN002B",
171 "LEN002C",
172 "LEN002D",
173 "LEN002E",
174 "LEN0033", /* Helix */
175 "LEN0034", /* T431s, L440, L540, T540, W540, X1 Carbon 2nd */
176 "LEN0035", /* X240 */
177 "LEN0036", /* T440 */
178 "LEN0037", /* X1 Carbon 2nd */
179 "LEN0038",
180 "LEN0039", /* T440s */
181 "LEN0041",
182 "LEN0042", /* Yoga */
183 "LEN0045",
184 "LEN0047",
185 "LEN0049",
186 "LEN2000",
187 "LEN2001", /* Edge E431 */
188 "LEN2002", /* Edge E531 */
189 "LEN2003",
190 "LEN2004", /* L440 */
191 "LEN2005",
192 "LEN2006",
193 "LEN2007",
194 "LEN2008",
195 "LEN2009",
196 "LEN200A",
197 "LEN200B",
198 NULL
199 };
200
201 /*****************************************************************************
202 * Synaptics communications functions
203 ****************************************************************************/
204
205 /*
206 * Synaptics touchpads report the y coordinate from bottom to top, which is
207 * opposite from what userspace expects.
208 * This function is used to invert y before reporting.
209 */
210 static int synaptics_invert_y(int y)
211 {
212 return YMAX_NOMINAL + YMIN_NOMINAL - y;
213 }
214
215 /*
216 * Send a command to the synpatics touchpad by special commands
217 */
218 static int synaptics_send_cmd(struct psmouse *psmouse, unsigned char c, unsigned char *param)
219 {
220 if (psmouse_sliced_command(psmouse, c))
221 return -1;
222 if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETINFO))
223 return -1;
224 return 0;
225 }
226
227 /*
228 * Read the model-id bytes from the touchpad
229 * see also SYN_MODEL_* macros
230 */
231 static int synaptics_model_id(struct psmouse *psmouse)
232 {
233 struct synaptics_data *priv = psmouse->private;
234 unsigned char mi[3];
235
236 if (synaptics_send_cmd(psmouse, SYN_QUE_MODEL, mi))
237 return -1;
238 priv->model_id = (mi[0]<<16) | (mi[1]<<8) | mi[2];
239 return 0;
240 }
241
242 static int synaptics_more_extended_queries(struct psmouse *psmouse)
243 {
244 struct synaptics_data *priv = psmouse->private;
245 unsigned char buf[3];
246
247 if (synaptics_send_cmd(psmouse, SYN_QUE_MEXT_CAPAB_10, buf))
248 return -1;
249
250 priv->ext_cap_10 = (buf[0]<<16) | (buf[1]<<8) | buf[2];
251
252 return 0;
253 }
254
255 /*
256 * Read the board id and the "More Extended Queries" from the touchpad
257 * The board id is encoded in the "QUERY MODES" response
258 */
259 static int synaptics_query_modes(struct psmouse *psmouse)
260 {
261 struct synaptics_data *priv = psmouse->private;
262 unsigned char bid[3];
263
264 /* firmwares prior 7.5 have no board_id encoded */
265 if (SYN_ID_FULL(priv->identity) < 0x705)
266 return 0;
267
268 if (synaptics_send_cmd(psmouse, SYN_QUE_MODES, bid))
269 return -1;
270 priv->board_id = ((bid[0] & 0xfc) << 6) | bid[1];
271
272 if (SYN_MEXT_CAP_BIT(bid[0]))
273 return synaptics_more_extended_queries(psmouse);
274
275 return 0;
276 }
277
278 /*
279 * Read the firmware id from the touchpad
280 */
281 static int synaptics_firmware_id(struct psmouse *psmouse)
282 {
283 struct synaptics_data *priv = psmouse->private;
284 unsigned char fwid[3];
285
286 if (synaptics_send_cmd(psmouse, SYN_QUE_FIRMWARE_ID, fwid))
287 return -1;
288 priv->firmware_id = (fwid[0] << 16) | (fwid[1] << 8) | fwid[2];
289 return 0;
290 }
291
292 /*
293 * Read the capability-bits from the touchpad
294 * see also the SYN_CAP_* macros
295 */
296 static int synaptics_capability(struct psmouse *psmouse)
297 {
298 struct synaptics_data *priv = psmouse->private;
299 unsigned char cap[3];
300
301 if (synaptics_send_cmd(psmouse, SYN_QUE_CAPABILITIES, cap))
302 return -1;
303 priv->capabilities = (cap[0] << 16) | (cap[1] << 8) | cap[2];
304 priv->ext_cap = priv->ext_cap_0c = 0;
305
306 /*
307 * Older firmwares had submodel ID fixed to 0x47
308 */
309 if (SYN_ID_FULL(priv->identity) < 0x705 &&
310 SYN_CAP_SUBMODEL_ID(priv->capabilities) != 0x47) {
311 return -1;
312 }
313
314 /*
315 * Unless capExtended is set the rest of the flags should be ignored
316 */
317 if (!SYN_CAP_EXTENDED(priv->capabilities))
318 priv->capabilities = 0;
319
320 if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 1) {
321 if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB, cap)) {
322 psmouse_warn(psmouse,
323 "device claims to have extended capabilities, but I'm not able to read them.\n");
324 } else {
325 priv->ext_cap = (cap[0] << 16) | (cap[1] << 8) | cap[2];
326
327 /*
328 * if nExtBtn is greater than 8 it should be considered
329 * invalid and treated as 0
330 */
331 if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) > 8)
332 priv->ext_cap &= 0xff0fff;
333 }
334 }
335
336 if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 4) {
337 if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB_0C, cap)) {
338 psmouse_warn(psmouse,
339 "device claims to have extended capability 0x0c, but I'm not able to read it.\n");
340 } else {
341 priv->ext_cap_0c = (cap[0] << 16) | (cap[1] << 8) | cap[2];
342 }
343 }
344
345 return 0;
346 }
347
348 /*
349 * Identify Touchpad
350 * See also the SYN_ID_* macros
351 */
352 static int synaptics_identify(struct psmouse *psmouse)
353 {
354 struct synaptics_data *priv = psmouse->private;
355 unsigned char id[3];
356
357 if (synaptics_send_cmd(psmouse, SYN_QUE_IDENTIFY, id))
358 return -1;
359 priv->identity = (id[0]<<16) | (id[1]<<8) | id[2];
360 if (SYN_ID_IS_SYNAPTICS(priv->identity))
361 return 0;
362 return -1;
363 }
364
365 /*
366 * Read touchpad resolution and maximum reported coordinates
367 * Resolution is left zero if touchpad does not support the query
368 */
369
370 static int synaptics_resolution(struct psmouse *psmouse)
371 {
372 struct synaptics_data *priv = psmouse->private;
373 unsigned char resp[3];
374
375 if (SYN_ID_MAJOR(priv->identity) < 4)
376 return 0;
377
378 if (synaptics_send_cmd(psmouse, SYN_QUE_RESOLUTION, resp) == 0) {
379 if (resp[0] != 0 && (resp[1] & 0x80) && resp[2] != 0) {
380 priv->x_res = resp[0]; /* x resolution in units/mm */
381 priv->y_res = resp[2]; /* y resolution in units/mm */
382 }
383 }
384
385 if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 5 &&
386 SYN_CAP_MAX_DIMENSIONS(priv->ext_cap_0c)) {
387 if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_MAX_COORDS, resp)) {
388 psmouse_warn(psmouse,
389 "device claims to have max coordinates query, but I'm not able to read it.\n");
390 } else {
391 priv->x_max = (resp[0] << 5) | ((resp[1] & 0x0f) << 1);
392 priv->y_max = (resp[2] << 5) | ((resp[1] & 0xf0) >> 3);
393 psmouse_info(psmouse,
394 "queried max coordinates: x [..%d], y [..%d]\n",
395 priv->x_max, priv->y_max);
396 }
397 }
398
399 if (SYN_CAP_MIN_DIMENSIONS(priv->ext_cap_0c) &&
400 (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 7 ||
401 /*
402 * Firmware v8.1 does not report proper number of extended
403 * capabilities, but has been proven to report correct min
404 * coordinates.
405 */
406 SYN_ID_FULL(priv->identity) == 0x801)) {
407 if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_MIN_COORDS, resp)) {
408 psmouse_warn(psmouse,
409 "device claims to have min coordinates query, but I'm not able to read it.\n");
410 } else {
411 priv->x_min = (resp[0] << 5) | ((resp[1] & 0x0f) << 1);
412 priv->y_min = (resp[2] << 5) | ((resp[1] & 0xf0) >> 3);
413 psmouse_info(psmouse,
414 "queried min coordinates: x [%d..], y [%d..]\n",
415 priv->x_min, priv->y_min);
416 }
417 }
418
419 return 0;
420 }
421
422 /*
423 * Apply quirk(s) if the hardware matches
424 */
425
426 static void synaptics_apply_quirks(struct psmouse *psmouse)
427 {
428 struct synaptics_data *priv = psmouse->private;
429 int i;
430
431 for (i = 0; min_max_pnpid_table[i].pnp_ids; i++) {
432 if (!psmouse_matches_pnp_id(psmouse,
433 min_max_pnpid_table[i].pnp_ids))
434 continue;
435
436 if (min_max_pnpid_table[i].board_id.min != ANY_BOARD_ID &&
437 priv->board_id < min_max_pnpid_table[i].board_id.min)
438 continue;
439
440 if (min_max_pnpid_table[i].board_id.max != ANY_BOARD_ID &&
441 priv->board_id > min_max_pnpid_table[i].board_id.max)
442 continue;
443
444 priv->x_min = min_max_pnpid_table[i].x_min;
445 priv->x_max = min_max_pnpid_table[i].x_max;
446 priv->y_min = min_max_pnpid_table[i].y_min;
447 priv->y_max = min_max_pnpid_table[i].y_max;
448 psmouse_info(psmouse,
449 "quirked min/max coordinates: x [%d..%d], y [%d..%d]\n",
450 priv->x_min, priv->x_max,
451 priv->y_min, priv->y_max);
452 break;
453 }
454 }
455
456 static int synaptics_query_hardware(struct psmouse *psmouse)
457 {
458 if (synaptics_identify(psmouse))
459 return -1;
460 if (synaptics_model_id(psmouse))
461 return -1;
462 if (synaptics_firmware_id(psmouse))
463 return -1;
464 if (synaptics_query_modes(psmouse))
465 return -1;
466 if (synaptics_capability(psmouse))
467 return -1;
468 if (synaptics_resolution(psmouse))
469 return -1;
470
471 synaptics_apply_quirks(psmouse);
472
473 return 0;
474 }
475
476 static int synaptics_set_advanced_gesture_mode(struct psmouse *psmouse)
477 {
478 static unsigned char param = 0xc8;
479 struct synaptics_data *priv = psmouse->private;
480
481 if (!(SYN_CAP_ADV_GESTURE(priv->ext_cap_0c) ||
482 SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)))
483 return 0;
484
485 if (psmouse_sliced_command(psmouse, SYN_QUE_MODEL))
486 return -1;
487
488 if (ps2_command(&psmouse->ps2dev, &param, PSMOUSE_CMD_SETRATE))
489 return -1;
490
491 /* Advanced gesture mode also sends multi finger data */
492 priv->capabilities |= BIT(1);
493
494 return 0;
495 }
496
497 static int synaptics_set_mode(struct psmouse *psmouse)
498 {
499 struct synaptics_data *priv = psmouse->private;
500
501 priv->mode = 0;
502 if (priv->absolute_mode)
503 priv->mode |= SYN_BIT_ABSOLUTE_MODE;
504 if (priv->disable_gesture)
505 priv->mode |= SYN_BIT_DISABLE_GESTURE;
506 if (psmouse->rate >= 80)
507 priv->mode |= SYN_BIT_HIGH_RATE;
508 if (SYN_CAP_EXTENDED(priv->capabilities))
509 priv->mode |= SYN_BIT_W_MODE;
510
511 if (synaptics_mode_cmd(psmouse, priv->mode))
512 return -1;
513
514 if (priv->absolute_mode &&
515 synaptics_set_advanced_gesture_mode(psmouse)) {
516 psmouse_err(psmouse, "Advanced gesture mode init failed.\n");
517 return -1;
518 }
519
520 return 0;
521 }
522
523 static void synaptics_set_rate(struct psmouse *psmouse, unsigned int rate)
524 {
525 struct synaptics_data *priv = psmouse->private;
526
527 if (rate >= 80) {
528 priv->mode |= SYN_BIT_HIGH_RATE;
529 psmouse->rate = 80;
530 } else {
531 priv->mode &= ~SYN_BIT_HIGH_RATE;
532 psmouse->rate = 40;
533 }
534
535 synaptics_mode_cmd(psmouse, priv->mode);
536 }
537
538 /*****************************************************************************
539 * Synaptics pass-through PS/2 port support
540 ****************************************************************************/
541 static int synaptics_pt_write(struct serio *serio, unsigned char c)
542 {
543 struct psmouse *parent = serio_get_drvdata(serio->parent);
544 char rate_param = SYN_PS_CLIENT_CMD; /* indicates that we want pass-through port */
545
546 if (psmouse_sliced_command(parent, c))
547 return -1;
548 if (ps2_command(&parent->ps2dev, &rate_param, PSMOUSE_CMD_SETRATE))
549 return -1;
550 return 0;
551 }
552
553 static int synaptics_pt_start(struct serio *serio)
554 {
555 struct psmouse *parent = serio_get_drvdata(serio->parent);
556 struct synaptics_data *priv = parent->private;
557
558 serio_pause_rx(parent->ps2dev.serio);
559 priv->pt_port = serio;
560 serio_continue_rx(parent->ps2dev.serio);
561
562 return 0;
563 }
564
565 static void synaptics_pt_stop(struct serio *serio)
566 {
567 struct psmouse *parent = serio_get_drvdata(serio->parent);
568 struct synaptics_data *priv = parent->private;
569
570 serio_pause_rx(parent->ps2dev.serio);
571 priv->pt_port = NULL;
572 serio_continue_rx(parent->ps2dev.serio);
573 }
574
575 static int synaptics_is_pt_packet(unsigned char *buf)
576 {
577 return (buf[0] & 0xFC) == 0x84 && (buf[3] & 0xCC) == 0xC4;
578 }
579
580 static void synaptics_pass_pt_packet(struct psmouse *psmouse,
581 struct serio *ptport,
582 unsigned char *packet)
583 {
584 struct synaptics_data *priv = psmouse->private;
585 struct psmouse *child = serio_get_drvdata(ptport);
586
587 if (child && child->state == PSMOUSE_ACTIVATED) {
588 serio_interrupt(ptport, packet[1] | priv->pt_buttons, 0);
589 serio_interrupt(ptport, packet[4], 0);
590 serio_interrupt(ptport, packet[5], 0);
591 if (child->pktsize == 4)
592 serio_interrupt(ptport, packet[2], 0);
593 } else {
594 serio_interrupt(ptport, packet[1], 0);
595 }
596 }
597
598 static void synaptics_pt_activate(struct psmouse *psmouse)
599 {
600 struct synaptics_data *priv = psmouse->private;
601 struct psmouse *child = serio_get_drvdata(priv->pt_port);
602
603 /* adjust the touchpad to child's choice of protocol */
604 if (child) {
605 if (child->pktsize == 4)
606 priv->mode |= SYN_BIT_FOUR_BYTE_CLIENT;
607 else
608 priv->mode &= ~SYN_BIT_FOUR_BYTE_CLIENT;
609
610 if (synaptics_mode_cmd(psmouse, priv->mode))
611 psmouse_warn(psmouse,
612 "failed to switch guest protocol\n");
613 }
614 }
615
616 static void synaptics_pt_create(struct psmouse *psmouse)
617 {
618 struct serio *serio;
619
620 serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
621 if (!serio) {
622 psmouse_err(psmouse,
623 "not enough memory for pass-through port\n");
624 return;
625 }
626
627 serio->id.type = SERIO_PS_PSTHRU;
628 strlcpy(serio->name, "Synaptics pass-through", sizeof(serio->name));
629 strlcpy(serio->phys, "synaptics-pt/serio0", sizeof(serio->name));
630 serio->write = synaptics_pt_write;
631 serio->start = synaptics_pt_start;
632 serio->stop = synaptics_pt_stop;
633 serio->parent = psmouse->ps2dev.serio;
634
635 psmouse->pt_activate = synaptics_pt_activate;
636
637 psmouse_info(psmouse, "serio: %s port at %s\n",
638 serio->name, psmouse->phys);
639 serio_register_port(serio);
640 }
641
642 /*****************************************************************************
643 * Functions to interpret the absolute mode packets
644 ****************************************************************************/
645
646 static void synaptics_parse_agm(const unsigned char buf[],
647 struct synaptics_data *priv,
648 struct synaptics_hw_state *hw)
649 {
650 struct synaptics_hw_state *agm = &priv->agm;
651 int agm_packet_type;
652
653 agm_packet_type = (buf[5] & 0x30) >> 4;
654 switch (agm_packet_type) {
655 case 1:
656 /* Gesture packet: (x, y, z) half resolution */
657 agm->w = hw->w;
658 agm->x = (((buf[4] & 0x0f) << 8) | buf[1]) << 1;
659 agm->y = (((buf[4] & 0xf0) << 4) | buf[2]) << 1;
660 agm->z = ((buf[3] & 0x30) | (buf[5] & 0x0f)) << 1;
661 break;
662
663 case 2:
664 /* AGM-CONTACT packet: we are only interested in the count */
665 priv->agm_count = buf[1];
666 break;
667
668 default:
669 break;
670 }
671 }
672
673 static void synaptics_parse_ext_buttons(const unsigned char buf[],
674 struct synaptics_data *priv,
675 struct synaptics_hw_state *hw)
676 {
677 unsigned int ext_bits =
678 (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) + 1) >> 1;
679 unsigned int ext_mask = GENMASK(ext_bits - 1, 0);
680
681 hw->ext_buttons = buf[4] & ext_mask;
682 hw->ext_buttons |= (buf[5] & ext_mask) << ext_bits;
683 }
684
685 static bool is_forcepad;
686
687 static int synaptics_parse_hw_state(const unsigned char buf[],
688 struct synaptics_data *priv,
689 struct synaptics_hw_state *hw)
690 {
691 memset(hw, 0, sizeof(struct synaptics_hw_state));
692
693 if (SYN_MODEL_NEWABS(priv->model_id)) {
694 hw->w = (((buf[0] & 0x30) >> 2) |
695 ((buf[0] & 0x04) >> 1) |
696 ((buf[3] & 0x04) >> 2));
697
698 if ((SYN_CAP_ADV_GESTURE(priv->ext_cap_0c) ||
699 SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) &&
700 hw->w == 2) {
701 synaptics_parse_agm(buf, priv, hw);
702 return 1;
703 }
704
705 hw->x = (((buf[3] & 0x10) << 8) |
706 ((buf[1] & 0x0f) << 8) |
707 buf[4]);
708 hw->y = (((buf[3] & 0x20) << 7) |
709 ((buf[1] & 0xf0) << 4) |
710 buf[5]);
711 hw->z = buf[2];
712
713 hw->left = (buf[0] & 0x01) ? 1 : 0;
714 hw->right = (buf[0] & 0x02) ? 1 : 0;
715
716 if (is_forcepad) {
717 /*
718 * ForcePads, like Clickpads, use middle button
719 * bits to report primary button clicks.
720 * Unfortunately they report primary button not
721 * only when user presses on the pad above certain
722 * threshold, but also when there are more than one
723 * finger on the touchpad, which interferes with
724 * out multi-finger gestures.
725 */
726 if (hw->z == 0) {
727 /* No contacts */
728 priv->press = priv->report_press = false;
729 } else if (hw->w >= 4 && ((buf[0] ^ buf[3]) & 0x01)) {
730 /*
731 * Single-finger touch with pressure above
732 * the threshold. If pressure stays long
733 * enough, we'll start reporting primary
734 * button. We rely on the device continuing
735 * sending data even if finger does not
736 * move.
737 */
738 if (!priv->press) {
739 priv->press_start = jiffies;
740 priv->press = true;
741 } else if (time_after(jiffies,
742 priv->press_start +
743 msecs_to_jiffies(50))) {
744 priv->report_press = true;
745 }
746 } else {
747 priv->press = false;
748 }
749
750 hw->left = priv->report_press;
751
752 } else if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
753 /*
754 * Clickpad's button is transmitted as middle button,
755 * however, since it is primary button, we will report
756 * it as BTN_LEFT.
757 */
758 hw->left = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
759
760 } else if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
761 hw->middle = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
762 if (hw->w == 2)
763 hw->scroll = (signed char)(buf[1]);
764 }
765
766 if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
767 hw->up = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
768 hw->down = ((buf[0] ^ buf[3]) & 0x02) ? 1 : 0;
769 }
770
771 if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) > 0 &&
772 ((buf[0] ^ buf[3]) & 0x02)) {
773 synaptics_parse_ext_buttons(buf, priv, hw);
774 }
775 } else {
776 hw->x = (((buf[1] & 0x1f) << 8) | buf[2]);
777 hw->y = (((buf[4] & 0x1f) << 8) | buf[5]);
778
779 hw->z = (((buf[0] & 0x30) << 2) | (buf[3] & 0x3F));
780 hw->w = (((buf[1] & 0x80) >> 4) | ((buf[0] & 0x04) >> 1));
781
782 hw->left = (buf[0] & 0x01) ? 1 : 0;
783 hw->right = (buf[0] & 0x02) ? 1 : 0;
784 }
785
786 /*
787 * Convert wrap-around values to negative. (X|Y)_MAX_POSITIVE
788 * is used by some firmware to indicate a finger at the edge of
789 * the touchpad whose precise position cannot be determined, so
790 * convert these values to the maximum axis value.
791 */
792 if (hw->x > X_MAX_POSITIVE)
793 hw->x -= 1 << ABS_POS_BITS;
794 else if (hw->x == X_MAX_POSITIVE)
795 hw->x = XMAX;
796
797 if (hw->y > Y_MAX_POSITIVE)
798 hw->y -= 1 << ABS_POS_BITS;
799 else if (hw->y == Y_MAX_POSITIVE)
800 hw->y = YMAX;
801
802 return 0;
803 }
804
805 static void synaptics_report_semi_mt_slot(struct input_dev *dev, int slot,
806 bool active, int x, int y)
807 {
808 input_mt_slot(dev, slot);
809 input_mt_report_slot_state(dev, MT_TOOL_FINGER, active);
810 if (active) {
811 input_report_abs(dev, ABS_MT_POSITION_X, x);
812 input_report_abs(dev, ABS_MT_POSITION_Y, synaptics_invert_y(y));
813 }
814 }
815
816 static void synaptics_report_semi_mt_data(struct input_dev *dev,
817 const struct synaptics_hw_state *a,
818 const struct synaptics_hw_state *b,
819 int num_fingers)
820 {
821 if (num_fingers >= 2) {
822 synaptics_report_semi_mt_slot(dev, 0, true, min(a->x, b->x),
823 min(a->y, b->y));
824 synaptics_report_semi_mt_slot(dev, 1, true, max(a->x, b->x),
825 max(a->y, b->y));
826 } else if (num_fingers == 1) {
827 synaptics_report_semi_mt_slot(dev, 0, true, a->x, a->y);
828 synaptics_report_semi_mt_slot(dev, 1, false, 0, 0);
829 } else {
830 synaptics_report_semi_mt_slot(dev, 0, false, 0, 0);
831 synaptics_report_semi_mt_slot(dev, 1, false, 0, 0);
832 }
833 }
834
835 static void synaptics_report_ext_buttons(struct psmouse *psmouse,
836 const struct synaptics_hw_state *hw)
837 {
838 struct input_dev *dev = psmouse->dev;
839 struct synaptics_data *priv = psmouse->private;
840 int ext_bits = (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) + 1) >> 1;
841 char buf[6] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
842 int i;
843
844 if (!SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap))
845 return;
846
847 /* Bug in FW 8.1, buttons are reported only when ExtBit is 1 */
848 if (SYN_ID_FULL(priv->identity) == 0x801 &&
849 !((psmouse->packet[0] ^ psmouse->packet[3]) & 0x02))
850 return;
851
852 if (!SYN_CAP_EXT_BUTTONS_STICK(priv->ext_cap_10)) {
853 for (i = 0; i < ext_bits; i++) {
854 input_report_key(dev, BTN_0 + 2 * i,
855 hw->ext_buttons & (1 << i));
856 input_report_key(dev, BTN_1 + 2 * i,
857 hw->ext_buttons & (1 << (i + ext_bits)));
858 }
859 return;
860 }
861
862 /*
863 * This generation of touchpads has the trackstick buttons
864 * physically wired to the touchpad. Re-route them through
865 * the pass-through interface.
866 */
867 if (!priv->pt_port)
868 return;
869
870 /* The trackstick expects at most 3 buttons */
871 priv->pt_buttons = SYN_CAP_EXT_BUTTON_STICK_L(hw->ext_buttons) |
872 SYN_CAP_EXT_BUTTON_STICK_R(hw->ext_buttons) << 1 |
873 SYN_CAP_EXT_BUTTON_STICK_M(hw->ext_buttons) << 2;
874
875 synaptics_pass_pt_packet(psmouse, priv->pt_port, buf);
876 }
877
878 static void synaptics_report_buttons(struct psmouse *psmouse,
879 const struct synaptics_hw_state *hw)
880 {
881 struct input_dev *dev = psmouse->dev;
882 struct synaptics_data *priv = psmouse->private;
883
884 input_report_key(dev, BTN_LEFT, hw->left);
885 input_report_key(dev, BTN_RIGHT, hw->right);
886
887 if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
888 input_report_key(dev, BTN_MIDDLE, hw->middle);
889
890 if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
891 input_report_key(dev, BTN_FORWARD, hw->up);
892 input_report_key(dev, BTN_BACK, hw->down);
893 }
894
895 synaptics_report_ext_buttons(psmouse, hw);
896 }
897
898 static void synaptics_report_mt_data(struct psmouse *psmouse,
899 const struct synaptics_hw_state *sgm,
900 int num_fingers)
901 {
902 struct input_dev *dev = psmouse->dev;
903 struct synaptics_data *priv = psmouse->private;
904 const struct synaptics_hw_state *hw[2] = { sgm, &priv->agm };
905 struct input_mt_pos pos[2];
906 int slot[2], nsemi, i;
907
908 nsemi = clamp_val(num_fingers, 0, 2);
909
910 for (i = 0; i < nsemi; i++) {
911 pos[i].x = hw[i]->x;
912 pos[i].y = synaptics_invert_y(hw[i]->y);
913 }
914
915 input_mt_assign_slots(dev, slot, pos, nsemi, 0);
916
917 for (i = 0; i < nsemi; i++) {
918 input_mt_slot(dev, slot[i]);
919 input_mt_report_slot_state(dev, MT_TOOL_FINGER, true);
920 input_report_abs(dev, ABS_MT_POSITION_X, pos[i].x);
921 input_report_abs(dev, ABS_MT_POSITION_Y, pos[i].y);
922 input_report_abs(dev, ABS_MT_PRESSURE, hw[i]->z);
923 }
924
925 input_mt_drop_unused(dev);
926
927 /* Don't use active slot count to generate BTN_TOOL events. */
928 input_mt_report_pointer_emulation(dev, false);
929
930 /* Send the number of fingers reported by touchpad itself. */
931 input_mt_report_finger_count(dev, num_fingers);
932
933 synaptics_report_buttons(psmouse, sgm);
934
935 input_sync(dev);
936 }
937
938 static void synaptics_image_sensor_process(struct psmouse *psmouse,
939 struct synaptics_hw_state *sgm)
940 {
941 struct synaptics_data *priv = psmouse->private;
942 int num_fingers;
943
944 /*
945 * Update mt_state using the new finger count and current mt_state.
946 */
947 if (sgm->z == 0)
948 num_fingers = 0;
949 else if (sgm->w >= 4)
950 num_fingers = 1;
951 else if (sgm->w == 0)
952 num_fingers = 2;
953 else if (sgm->w == 1)
954 num_fingers = priv->agm_count ? priv->agm_count : 3;
955 else
956 num_fingers = 4;
957
958 /* Send resulting input events to user space */
959 synaptics_report_mt_data(psmouse, sgm, num_fingers);
960 }
961
962 /*
963 * called for each full received packet from the touchpad
964 */
965 static void synaptics_process_packet(struct psmouse *psmouse)
966 {
967 struct input_dev *dev = psmouse->dev;
968 struct synaptics_data *priv = psmouse->private;
969 struct synaptics_hw_state hw;
970 int num_fingers;
971 int finger_width;
972
973 if (synaptics_parse_hw_state(psmouse->packet, priv, &hw))
974 return;
975
976 if (SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) {
977 synaptics_image_sensor_process(psmouse, &hw);
978 return;
979 }
980
981 if (hw.scroll) {
982 priv->scroll += hw.scroll;
983
984 while (priv->scroll >= 4) {
985 input_report_key(dev, BTN_BACK, !hw.down);
986 input_sync(dev);
987 input_report_key(dev, BTN_BACK, hw.down);
988 input_sync(dev);
989 priv->scroll -= 4;
990 }
991 while (priv->scroll <= -4) {
992 input_report_key(dev, BTN_FORWARD, !hw.up);
993 input_sync(dev);
994 input_report_key(dev, BTN_FORWARD, hw.up);
995 input_sync(dev);
996 priv->scroll += 4;
997 }
998 return;
999 }
1000
1001 if (hw.z > 0 && hw.x > 1) {
1002 num_fingers = 1;
1003 finger_width = 5;
1004 if (SYN_CAP_EXTENDED(priv->capabilities)) {
1005 switch (hw.w) {
1006 case 0 ... 1:
1007 if (SYN_CAP_MULTIFINGER(priv->capabilities))
1008 num_fingers = hw.w + 2;
1009 break;
1010 case 2:
1011 if (SYN_MODEL_PEN(priv->model_id))
1012 ; /* Nothing, treat a pen as a single finger */
1013 break;
1014 case 4 ... 15:
1015 if (SYN_CAP_PALMDETECT(priv->capabilities))
1016 finger_width = hw.w;
1017 break;
1018 }
1019 }
1020 } else {
1021 num_fingers = 0;
1022 finger_width = 0;
1023 }
1024
1025 if (cr48_profile_sensor) {
1026 synaptics_report_mt_data(psmouse, &hw, num_fingers);
1027 return;
1028 }
1029
1030 if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c))
1031 synaptics_report_semi_mt_data(dev, &hw, &priv->agm,
1032 num_fingers);
1033
1034 /* Post events
1035 * BTN_TOUCH has to be first as mousedev relies on it when doing
1036 * absolute -> relative conversion
1037 */
1038 if (hw.z > 30) input_report_key(dev, BTN_TOUCH, 1);
1039 if (hw.z < 25) input_report_key(dev, BTN_TOUCH, 0);
1040
1041 if (num_fingers > 0) {
1042 input_report_abs(dev, ABS_X, hw.x);
1043 input_report_abs(dev, ABS_Y, synaptics_invert_y(hw.y));
1044 }
1045 input_report_abs(dev, ABS_PRESSURE, hw.z);
1046
1047 if (SYN_CAP_PALMDETECT(priv->capabilities))
1048 input_report_abs(dev, ABS_TOOL_WIDTH, finger_width);
1049
1050 input_report_key(dev, BTN_TOOL_FINGER, num_fingers == 1);
1051 if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
1052 input_report_key(dev, BTN_TOOL_DOUBLETAP, num_fingers == 2);
1053 input_report_key(dev, BTN_TOOL_TRIPLETAP, num_fingers == 3);
1054 }
1055
1056 synaptics_report_buttons(psmouse, &hw);
1057
1058 input_sync(dev);
1059 }
1060
1061 static int synaptics_validate_byte(struct psmouse *psmouse,
1062 int idx, unsigned char pkt_type)
1063 {
1064 static const unsigned char newabs_mask[] = { 0xC8, 0x00, 0x00, 0xC8, 0x00 };
1065 static const unsigned char newabs_rel_mask[] = { 0xC0, 0x00, 0x00, 0xC0, 0x00 };
1066 static const unsigned char newabs_rslt[] = { 0x80, 0x00, 0x00, 0xC0, 0x00 };
1067 static const unsigned char oldabs_mask[] = { 0xC0, 0x60, 0x00, 0xC0, 0x60 };
1068 static const unsigned char oldabs_rslt[] = { 0xC0, 0x00, 0x00, 0x80, 0x00 };
1069 const char *packet = psmouse->packet;
1070
1071 if (idx < 0 || idx > 4)
1072 return 0;
1073
1074 switch (pkt_type) {
1075
1076 case SYN_NEWABS:
1077 case SYN_NEWABS_RELAXED:
1078 return (packet[idx] & newabs_rel_mask[idx]) == newabs_rslt[idx];
1079
1080 case SYN_NEWABS_STRICT:
1081 return (packet[idx] & newabs_mask[idx]) == newabs_rslt[idx];
1082
1083 case SYN_OLDABS:
1084 return (packet[idx] & oldabs_mask[idx]) == oldabs_rslt[idx];
1085
1086 default:
1087 psmouse_err(psmouse, "unknown packet type %d\n", pkt_type);
1088 return 0;
1089 }
1090 }
1091
1092 static unsigned char synaptics_detect_pkt_type(struct psmouse *psmouse)
1093 {
1094 int i;
1095
1096 for (i = 0; i < 5; i++)
1097 if (!synaptics_validate_byte(psmouse, i, SYN_NEWABS_STRICT)) {
1098 psmouse_info(psmouse, "using relaxed packet validation\n");
1099 return SYN_NEWABS_RELAXED;
1100 }
1101
1102 return SYN_NEWABS_STRICT;
1103 }
1104
1105 static psmouse_ret_t synaptics_process_byte(struct psmouse *psmouse)
1106 {
1107 struct synaptics_data *priv = psmouse->private;
1108
1109 if (psmouse->pktcnt >= 6) { /* Full packet received */
1110 if (unlikely(priv->pkt_type == SYN_NEWABS))
1111 priv->pkt_type = synaptics_detect_pkt_type(psmouse);
1112
1113 if (SYN_CAP_PASS_THROUGH(priv->capabilities) &&
1114 synaptics_is_pt_packet(psmouse->packet)) {
1115 if (priv->pt_port)
1116 synaptics_pass_pt_packet(psmouse, priv->pt_port,
1117 psmouse->packet);
1118 } else
1119 synaptics_process_packet(psmouse);
1120
1121 return PSMOUSE_FULL_PACKET;
1122 }
1123
1124 return synaptics_validate_byte(psmouse, psmouse->pktcnt - 1, priv->pkt_type) ?
1125 PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
1126 }
1127
1128 /*****************************************************************************
1129 * Driver initialization/cleanup functions
1130 ****************************************************************************/
1131 static void set_abs_position_params(struct input_dev *dev,
1132 struct synaptics_data *priv, int x_code,
1133 int y_code)
1134 {
1135 int x_min = priv->x_min ?: XMIN_NOMINAL;
1136 int x_max = priv->x_max ?: XMAX_NOMINAL;
1137 int y_min = priv->y_min ?: YMIN_NOMINAL;
1138 int y_max = priv->y_max ?: YMAX_NOMINAL;
1139 int fuzz = SYN_CAP_REDUCED_FILTERING(priv->ext_cap_0c) ?
1140 SYN_REDUCED_FILTER_FUZZ : 0;
1141
1142 input_set_abs_params(dev, x_code, x_min, x_max, fuzz, 0);
1143 input_set_abs_params(dev, y_code, y_min, y_max, fuzz, 0);
1144 input_abs_set_res(dev, x_code, priv->x_res);
1145 input_abs_set_res(dev, y_code, priv->y_res);
1146 }
1147
1148 static void set_input_params(struct psmouse *psmouse,
1149 struct synaptics_data *priv)
1150 {
1151 struct input_dev *dev = psmouse->dev;
1152 int i;
1153
1154 /* Things that apply to both modes */
1155 __set_bit(INPUT_PROP_POINTER, dev->propbit);
1156 __set_bit(EV_KEY, dev->evbit);
1157 __set_bit(BTN_LEFT, dev->keybit);
1158 __set_bit(BTN_RIGHT, dev->keybit);
1159
1160 if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
1161 __set_bit(BTN_MIDDLE, dev->keybit);
1162
1163 if (!priv->absolute_mode) {
1164 /* Relative mode */
1165 __set_bit(EV_REL, dev->evbit);
1166 __set_bit(REL_X, dev->relbit);
1167 __set_bit(REL_Y, dev->relbit);
1168 return;
1169 }
1170
1171 /* Absolute mode */
1172 __set_bit(EV_ABS, dev->evbit);
1173 set_abs_position_params(dev, priv, ABS_X, ABS_Y);
1174 input_set_abs_params(dev, ABS_PRESSURE, 0, 255, 0, 0);
1175
1176 if (cr48_profile_sensor)
1177 input_set_abs_params(dev, ABS_MT_PRESSURE, 0, 255, 0, 0);
1178
1179 if (SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) {
1180 set_abs_position_params(dev, priv, ABS_MT_POSITION_X,
1181 ABS_MT_POSITION_Y);
1182 /* Image sensors can report per-contact pressure */
1183 input_set_abs_params(dev, ABS_MT_PRESSURE, 0, 255, 0, 0);
1184 input_mt_init_slots(dev, 2, INPUT_MT_POINTER | INPUT_MT_TRACK);
1185
1186 /* Image sensors can signal 4 and 5 finger clicks */
1187 __set_bit(BTN_TOOL_QUADTAP, dev->keybit);
1188 __set_bit(BTN_TOOL_QUINTTAP, dev->keybit);
1189 } else if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c)) {
1190 set_abs_position_params(dev, priv, ABS_MT_POSITION_X,
1191 ABS_MT_POSITION_Y);
1192 /*
1193 * Profile sensor in CR-48 tracks contacts reasonably well,
1194 * other non-image sensors with AGM use semi-mt.
1195 */
1196 input_mt_init_slots(dev, 2,
1197 INPUT_MT_POINTER |
1198 (cr48_profile_sensor ?
1199 INPUT_MT_TRACK : INPUT_MT_SEMI_MT));
1200 }
1201
1202 if (SYN_CAP_PALMDETECT(priv->capabilities))
1203 input_set_abs_params(dev, ABS_TOOL_WIDTH, 0, 15, 0, 0);
1204
1205 __set_bit(BTN_TOUCH, dev->keybit);
1206 __set_bit(BTN_TOOL_FINGER, dev->keybit);
1207
1208 if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
1209 __set_bit(BTN_TOOL_DOUBLETAP, dev->keybit);
1210 __set_bit(BTN_TOOL_TRIPLETAP, dev->keybit);
1211 }
1212
1213 if (SYN_CAP_FOUR_BUTTON(priv->capabilities) ||
1214 SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
1215 __set_bit(BTN_FORWARD, dev->keybit);
1216 __set_bit(BTN_BACK, dev->keybit);
1217 }
1218
1219 if (!SYN_CAP_EXT_BUTTONS_STICK(priv->ext_cap_10))
1220 for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
1221 __set_bit(BTN_0 + i, dev->keybit);
1222
1223 __clear_bit(EV_REL, dev->evbit);
1224 __clear_bit(REL_X, dev->relbit);
1225 __clear_bit(REL_Y, dev->relbit);
1226
1227 if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
1228 __set_bit(INPUT_PROP_BUTTONPAD, dev->propbit);
1229 if (psmouse_matches_pnp_id(psmouse, topbuttonpad_pnp_ids) &&
1230 !SYN_CAP_EXT_BUTTONS_STICK(priv->ext_cap_10))
1231 __set_bit(INPUT_PROP_TOPBUTTONPAD, dev->propbit);
1232 /* Clickpads report only left button */
1233 __clear_bit(BTN_RIGHT, dev->keybit);
1234 __clear_bit(BTN_MIDDLE, dev->keybit);
1235 }
1236 }
1237
1238 static ssize_t synaptics_show_disable_gesture(struct psmouse *psmouse,
1239 void *data, char *buf)
1240 {
1241 struct synaptics_data *priv = psmouse->private;
1242
1243 return sprintf(buf, "%c\n", priv->disable_gesture ? '1' : '0');
1244 }
1245
1246 static ssize_t synaptics_set_disable_gesture(struct psmouse *psmouse,
1247 void *data, const char *buf,
1248 size_t len)
1249 {
1250 struct synaptics_data *priv = psmouse->private;
1251 unsigned int value;
1252 int err;
1253
1254 err = kstrtouint(buf, 10, &value);
1255 if (err)
1256 return err;
1257
1258 if (value > 1)
1259 return -EINVAL;
1260
1261 if (value == priv->disable_gesture)
1262 return len;
1263
1264 priv->disable_gesture = value;
1265 if (value)
1266 priv->mode |= SYN_BIT_DISABLE_GESTURE;
1267 else
1268 priv->mode &= ~SYN_BIT_DISABLE_GESTURE;
1269
1270 if (synaptics_mode_cmd(psmouse, priv->mode))
1271 return -EIO;
1272
1273 return len;
1274 }
1275
1276 PSMOUSE_DEFINE_ATTR(disable_gesture, S_IWUSR | S_IRUGO, NULL,
1277 synaptics_show_disable_gesture,
1278 synaptics_set_disable_gesture);
1279
1280 static void synaptics_disconnect(struct psmouse *psmouse)
1281 {
1282 struct synaptics_data *priv = psmouse->private;
1283
1284 if (!priv->absolute_mode && SYN_ID_DISGEST_SUPPORTED(priv->identity))
1285 device_remove_file(&psmouse->ps2dev.serio->dev,
1286 &psmouse_attr_disable_gesture.dattr);
1287
1288 synaptics_reset(psmouse);
1289 kfree(priv);
1290 psmouse->private = NULL;
1291 }
1292
1293 static int synaptics_reconnect(struct psmouse *psmouse)
1294 {
1295 struct synaptics_data *priv = psmouse->private;
1296 struct synaptics_data old_priv = *priv;
1297 unsigned char param[2];
1298 int retry = 0;
1299 int error;
1300
1301 do {
1302 psmouse_reset(psmouse);
1303 if (retry) {
1304 /*
1305 * On some boxes, right after resuming, the touchpad
1306 * needs some time to finish initializing (I assume
1307 * it needs time to calibrate) and start responding
1308 * to Synaptics-specific queries, so let's wait a
1309 * bit.
1310 */
1311 ssleep(1);
1312 }
1313 ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETID);
1314 error = synaptics_detect(psmouse, 0);
1315 } while (error && ++retry < 3);
1316
1317 if (error)
1318 return -1;
1319
1320 if (retry > 1)
1321 psmouse_dbg(psmouse, "reconnected after %d tries\n", retry);
1322
1323 if (synaptics_query_hardware(psmouse)) {
1324 psmouse_err(psmouse, "Unable to query device.\n");
1325 return -1;
1326 }
1327
1328 if (synaptics_set_mode(psmouse)) {
1329 psmouse_err(psmouse, "Unable to initialize device.\n");
1330 return -1;
1331 }
1332
1333 if (old_priv.identity != priv->identity ||
1334 old_priv.model_id != priv->model_id ||
1335 old_priv.capabilities != priv->capabilities ||
1336 old_priv.ext_cap != priv->ext_cap) {
1337 psmouse_err(psmouse,
1338 "hardware appears to be different: id(%ld-%ld), model(%ld-%ld), caps(%lx-%lx), ext(%lx-%lx).\n",
1339 old_priv.identity, priv->identity,
1340 old_priv.model_id, priv->model_id,
1341 old_priv.capabilities, priv->capabilities,
1342 old_priv.ext_cap, priv->ext_cap);
1343 return -1;
1344 }
1345
1346 return 0;
1347 }
1348
1349 static bool impaired_toshiba_kbc;
1350
1351 static const struct dmi_system_id toshiba_dmi_table[] __initconst = {
1352 #if defined(CONFIG_DMI) && defined(CONFIG_X86)
1353 {
1354 /* Toshiba Satellite */
1355 .matches = {
1356 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1357 DMI_MATCH(DMI_PRODUCT_NAME, "Satellite"),
1358 },
1359 },
1360 {
1361 /* Toshiba Dynabook */
1362 .matches = {
1363 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1364 DMI_MATCH(DMI_PRODUCT_NAME, "dynabook"),
1365 },
1366 },
1367 {
1368 /* Toshiba Portege M300 */
1369 .matches = {
1370 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1371 DMI_MATCH(DMI_PRODUCT_NAME, "PORTEGE M300"),
1372 },
1373
1374 },
1375 {
1376 /* Toshiba Portege M300 */
1377 .matches = {
1378 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1379 DMI_MATCH(DMI_PRODUCT_NAME, "Portable PC"),
1380 DMI_MATCH(DMI_PRODUCT_VERSION, "Version 1.0"),
1381 },
1382
1383 },
1384 #endif
1385 { }
1386 };
1387
1388 static bool broken_olpc_ec;
1389
1390 static const struct dmi_system_id olpc_dmi_table[] __initconst = {
1391 #if defined(CONFIG_DMI) && defined(CONFIG_OLPC)
1392 {
1393 /* OLPC XO-1 or XO-1.5 */
1394 .matches = {
1395 DMI_MATCH(DMI_SYS_VENDOR, "OLPC"),
1396 DMI_MATCH(DMI_PRODUCT_NAME, "XO"),
1397 },
1398 },
1399 #endif
1400 { }
1401 };
1402
1403 static const struct dmi_system_id __initconst cr48_dmi_table[] = {
1404 #if defined(CONFIG_DMI) && defined(CONFIG_X86)
1405 {
1406 /* Cr-48 Chromebook (Codename Mario) */
1407 .matches = {
1408 DMI_MATCH(DMI_SYS_VENDOR, "IEC"),
1409 DMI_MATCH(DMI_PRODUCT_NAME, "Mario"),
1410 },
1411 },
1412 #endif
1413 { }
1414 };
1415
1416 static const struct dmi_system_id forcepad_dmi_table[] __initconst = {
1417 #if defined(CONFIG_DMI) && defined(CONFIG_X86)
1418 {
1419 .matches = {
1420 DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
1421 DMI_MATCH(DMI_PRODUCT_NAME, "HP EliteBook Folio 1040 G1"),
1422 },
1423 },
1424 #endif
1425 { }
1426 };
1427
1428 void __init synaptics_module_init(void)
1429 {
1430 impaired_toshiba_kbc = dmi_check_system(toshiba_dmi_table);
1431 broken_olpc_ec = dmi_check_system(olpc_dmi_table);
1432 cr48_profile_sensor = dmi_check_system(cr48_dmi_table);
1433
1434 /*
1435 * Unfortunately ForcePad capability is not exported over PS/2,
1436 * so we have to resort to checking DMI.
1437 */
1438 is_forcepad = dmi_check_system(forcepad_dmi_table);
1439 }
1440
1441 static int __synaptics_init(struct psmouse *psmouse, bool absolute_mode)
1442 {
1443 struct synaptics_data *priv;
1444 int err = -1;
1445
1446 /*
1447 * The OLPC XO has issues with Synaptics' absolute mode; the constant
1448 * packet spew overloads the EC such that key presses on the keyboard
1449 * are missed. Given that, don't even attempt to use Absolute mode.
1450 * Relative mode seems to work just fine.
1451 */
1452 if (absolute_mode && broken_olpc_ec) {
1453 psmouse_info(psmouse,
1454 "OLPC XO detected, not enabling Synaptics protocol.\n");
1455 return -ENODEV;
1456 }
1457
1458 psmouse->private = priv = kzalloc(sizeof(struct synaptics_data), GFP_KERNEL);
1459 if (!priv)
1460 return -ENOMEM;
1461
1462 psmouse_reset(psmouse);
1463
1464 if (synaptics_query_hardware(psmouse)) {
1465 psmouse_err(psmouse, "Unable to query device.\n");
1466 goto init_fail;
1467 }
1468
1469 priv->absolute_mode = absolute_mode;
1470 if (SYN_ID_DISGEST_SUPPORTED(priv->identity))
1471 priv->disable_gesture = true;
1472
1473 if (synaptics_set_mode(psmouse)) {
1474 psmouse_err(psmouse, "Unable to initialize device.\n");
1475 goto init_fail;
1476 }
1477
1478 priv->pkt_type = SYN_MODEL_NEWABS(priv->model_id) ? SYN_NEWABS : SYN_OLDABS;
1479
1480 psmouse_info(psmouse,
1481 "Touchpad model: %ld, fw: %ld.%ld, id: %#lx, caps: %#lx/%#lx/%#lx, board id: %lu, fw id: %lu\n",
1482 SYN_ID_MODEL(priv->identity),
1483 SYN_ID_MAJOR(priv->identity), SYN_ID_MINOR(priv->identity),
1484 priv->model_id,
1485 priv->capabilities, priv->ext_cap, priv->ext_cap_0c,
1486 priv->board_id, priv->firmware_id);
1487
1488 set_input_params(psmouse, priv);
1489
1490 /*
1491 * Encode touchpad model so that it can be used to set
1492 * input device->id.version and be visible to userspace.
1493 * Because version is __u16 we have to drop something.
1494 * Hardware info bits seem to be good candidates as they
1495 * are documented to be for Synaptics corp. internal use.
1496 */
1497 psmouse->model = ((priv->model_id & 0x00ff0000) >> 8) |
1498 (priv->model_id & 0x000000ff);
1499
1500 if (absolute_mode) {
1501 psmouse->protocol_handler = synaptics_process_byte;
1502 psmouse->pktsize = 6;
1503 } else {
1504 /* Relative mode follows standard PS/2 mouse protocol */
1505 psmouse->protocol_handler = psmouse_process_byte;
1506 psmouse->pktsize = 3;
1507 }
1508
1509 psmouse->set_rate = synaptics_set_rate;
1510 psmouse->disconnect = synaptics_disconnect;
1511 psmouse->reconnect = synaptics_reconnect;
1512 psmouse->cleanup = synaptics_reset;
1513 /* Synaptics can usually stay in sync without extra help */
1514 psmouse->resync_time = 0;
1515
1516 if (SYN_CAP_PASS_THROUGH(priv->capabilities))
1517 synaptics_pt_create(psmouse);
1518
1519 /*
1520 * Toshiba's KBC seems to have trouble handling data from
1521 * Synaptics at full rate. Switch to a lower rate (roughly
1522 * the same rate as a standard PS/2 mouse).
1523 */
1524 if (psmouse->rate >= 80 && impaired_toshiba_kbc) {
1525 psmouse_info(psmouse,
1526 "Toshiba %s detected, limiting rate to 40pps.\n",
1527 dmi_get_system_info(DMI_PRODUCT_NAME));
1528 psmouse->rate = 40;
1529 }
1530
1531 if (!priv->absolute_mode && SYN_ID_DISGEST_SUPPORTED(priv->identity)) {
1532 err = device_create_file(&psmouse->ps2dev.serio->dev,
1533 &psmouse_attr_disable_gesture.dattr);
1534 if (err) {
1535 psmouse_err(psmouse,
1536 "Failed to create disable_gesture attribute (%d)",
1537 err);
1538 goto init_fail;
1539 }
1540 }
1541
1542 return 0;
1543
1544 init_fail:
1545 kfree(priv);
1546 return err;
1547 }
1548
1549 int synaptics_init(struct psmouse *psmouse)
1550 {
1551 return __synaptics_init(psmouse, true);
1552 }
1553
1554 int synaptics_init_relative(struct psmouse *psmouse)
1555 {
1556 return __synaptics_init(psmouse, false);
1557 }
1558
1559 #else /* CONFIG_MOUSE_PS2_SYNAPTICS */
1560
1561 void __init synaptics_module_init(void)
1562 {
1563 }
1564
1565 int synaptics_init(struct psmouse *psmouse)
1566 {
1567 return -ENOSYS;
1568 }
1569
1570 #endif /* CONFIG_MOUSE_PS2_SYNAPTICS */
Ubuntu Artful kernel mirror