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


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