projects / deliverable / linux.git / blob
? search:


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