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