mfd: wm8350-i2c: Make sure the i2c regmap functions are compiled
[linux/fpc-iii.git] / drivers / input / mouse / synaptics.c
blob53f09a8b0b72d66dd12abe5c4e6a2f263152db8d
1 /*
2 * Synaptics TouchPad PS/2 mouse driver
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.
8 * 2003 Peter Osterlund <petero2@telia.com>
9 * Ported to 2.5 input device infrastructure.
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)
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)
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.
23 * Trademarks are the property of their respective owners.
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"
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.
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
52 /* Size in bits of absolute position values reported by the hardware */
53 #define ABS_POS_BITS 13
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.
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.
67 #define X_MAX_POSITIVE 8176
68 #define Y_MAX_POSITIVE 8176
70 /*****************************************************************************
71 * Stuff we need even when we do not want native Synaptics support
72 ****************************************************************************/
75 * Set the synaptics touchpad mode byte by special commands
77 static int synaptics_mode_cmd(struct psmouse *psmouse, unsigned char mode)
79 unsigned char param[1];
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;
89 int synaptics_detect(struct psmouse *psmouse, bool set_properties)
91 struct ps2dev *ps2dev = &psmouse->ps2dev;
92 unsigned char param[4];
94 param[0] = 0;
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);
102 if (param[1] != 0x47)
103 return -ENODEV;
105 if (set_properties) {
106 psmouse->vendor = "Synaptics";
107 psmouse->name = "TouchPad";
110 return 0;
113 void synaptics_reset(struct psmouse *psmouse)
115 /* reset touchpad back to relative mode, gestures enabled */
116 synaptics_mode_cmd(psmouse, 0);
119 #ifdef CONFIG_MOUSE_PS2_SYNAPTICS
120 struct min_max_quirk {
121 const char * const *pnp_ids;
122 int x_min, x_max, y_min, y_max;
125 static const struct min_max_quirk min_max_pnpid_table[] = {
127 (const char * const []){"LEN0033", NULL},
128 1024, 5052, 2258, 4832
131 (const char * const []){"LEN0035", "LEN0042", NULL},
132 1232, 5710, 1156, 4696
135 (const char * const []){"LEN0034", "LEN0036", "LEN0037",
136 "LEN0039", "LEN2002", "LEN2004",
137 NULL},
138 1024, 5112, 2024, 4832
141 (const char * const []){"LEN2000", NULL},
142 1024, 5113, 2021, 4832
145 (const char * const []){"LEN2001", NULL},
146 1024, 5022, 2508, 4832
149 (const char * const []){"LEN2006", NULL},
150 1264, 5675, 1171, 4688
155 /* This list has been kindly provided by Synaptics. */
156 static const char * const topbuttonpad_pnp_ids[] = {
157 "LEN0017",
158 "LEN0018",
159 "LEN0019",
160 "LEN0023",
161 "LEN002A",
162 "LEN002B",
163 "LEN002C",
164 "LEN002D",
165 "LEN002E",
166 "LEN0033", /* Helix */
167 "LEN0034", /* T431s, L440, L540, T540, W540, X1 Carbon 2nd */
168 "LEN0035", /* X240 */
169 "LEN0036", /* T440 */
170 "LEN0037", /* X1 Carbon 2nd */
171 "LEN0038",
172 "LEN0039", /* T440s */
173 "LEN0041",
174 "LEN0042", /* Yoga */
175 "LEN0045",
176 "LEN0046",
177 "LEN0047",
178 "LEN0048",
179 "LEN0049",
180 "LEN2000", /* S540 */
181 "LEN2001", /* Edge E431 */
182 "LEN2002", /* Edge E531 */
183 "LEN2003",
184 "LEN2004", /* L440 */
185 "LEN2005",
186 "LEN2006",
187 "LEN2007",
188 "LEN2008",
189 "LEN2009",
190 "LEN200A",
191 "LEN200B",
192 NULL
195 static bool matches_pnp_id(struct psmouse *psmouse, const char * const ids[])
197 int i;
199 if (!strncmp(psmouse->ps2dev.serio->firmware_id, "PNP:", 4))
200 for (i = 0; ids[i]; i++)
201 if (strstr(psmouse->ps2dev.serio->firmware_id, ids[i]))
202 return true;
204 return false;
207 /*****************************************************************************
208 * Synaptics communications functions
209 ****************************************************************************/
212 * Synaptics touchpads report the y coordinate from bottom to top, which is
213 * opposite from what userspace expects.
214 * This function is used to invert y before reporting.
216 static int synaptics_invert_y(int y)
218 return YMAX_NOMINAL + YMIN_NOMINAL - y;
222 * Send a command to the synpatics touchpad by special commands
224 static int synaptics_send_cmd(struct psmouse *psmouse, unsigned char c, unsigned char *param)
226 if (psmouse_sliced_command(psmouse, c))
227 return -1;
228 if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETINFO))
229 return -1;
230 return 0;
234 * Read the model-id bytes from the touchpad
235 * see also SYN_MODEL_* macros
237 static int synaptics_model_id(struct psmouse *psmouse)
239 struct synaptics_data *priv = psmouse->private;
240 unsigned char mi[3];
242 if (synaptics_send_cmd(psmouse, SYN_QUE_MODEL, mi))
243 return -1;
244 priv->model_id = (mi[0]<<16) | (mi[1]<<8) | mi[2];
245 return 0;
249 * Read the board id from the touchpad
250 * The board id is encoded in the "QUERY MODES" response
252 static int synaptics_board_id(struct psmouse *psmouse)
254 struct synaptics_data *priv = psmouse->private;
255 unsigned char bid[3];
257 if (synaptics_send_cmd(psmouse, SYN_QUE_MODES, bid))
258 return -1;
259 priv->board_id = ((bid[0] & 0xfc) << 6) | bid[1];
260 return 0;
264 * Read the firmware id from the touchpad
266 static int synaptics_firmware_id(struct psmouse *psmouse)
268 struct synaptics_data *priv = psmouse->private;
269 unsigned char fwid[3];
271 if (synaptics_send_cmd(psmouse, SYN_QUE_FIRMWARE_ID, fwid))
272 return -1;
273 priv->firmware_id = (fwid[0] << 16) | (fwid[1] << 8) | fwid[2];
274 return 0;
278 * Read the capability-bits from the touchpad
279 * see also the SYN_CAP_* macros
281 static int synaptics_capability(struct psmouse *psmouse)
283 struct synaptics_data *priv = psmouse->private;
284 unsigned char cap[3];
286 if (synaptics_send_cmd(psmouse, SYN_QUE_CAPABILITIES, cap))
287 return -1;
288 priv->capabilities = (cap[0] << 16) | (cap[1] << 8) | cap[2];
289 priv->ext_cap = priv->ext_cap_0c = 0;
292 * Older firmwares had submodel ID fixed to 0x47
294 if (SYN_ID_FULL(priv->identity) < 0x705 &&
295 SYN_CAP_SUBMODEL_ID(priv->capabilities) != 0x47) {
296 return -1;
300 * Unless capExtended is set the rest of the flags should be ignored
302 if (!SYN_CAP_EXTENDED(priv->capabilities))
303 priv->capabilities = 0;
305 if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 1) {
306 if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB, cap)) {
307 psmouse_warn(psmouse,
308 "device claims to have extended capabilities, but I'm not able to read them.\n");
309 } else {
310 priv->ext_cap = (cap[0] << 16) | (cap[1] << 8) | cap[2];
313 * if nExtBtn is greater than 8 it should be considered
314 * invalid and treated as 0
316 if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) > 8)
317 priv->ext_cap &= 0xff0fff;
321 if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 4) {
322 if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB_0C, cap)) {
323 psmouse_warn(psmouse,
324 "device claims to have extended capability 0x0c, but I'm not able to read it.\n");
325 } else {
326 priv->ext_cap_0c = (cap[0] << 16) | (cap[1] << 8) | cap[2];
330 return 0;
334 * Identify Touchpad
335 * See also the SYN_ID_* macros
337 static int synaptics_identify(struct psmouse *psmouse)
339 struct synaptics_data *priv = psmouse->private;
340 unsigned char id[3];
342 if (synaptics_send_cmd(psmouse, SYN_QUE_IDENTIFY, id))
343 return -1;
344 priv->identity = (id[0]<<16) | (id[1]<<8) | id[2];
345 if (SYN_ID_IS_SYNAPTICS(priv->identity))
346 return 0;
347 return -1;
351 * Read touchpad resolution and maximum reported coordinates
352 * Resolution is left zero if touchpad does not support the query
355 static int synaptics_resolution(struct psmouse *psmouse)
357 struct synaptics_data *priv = psmouse->private;
358 unsigned char resp[3];
359 int i;
361 if (SYN_ID_MAJOR(priv->identity) < 4)
362 return 0;
364 if (synaptics_send_cmd(psmouse, SYN_QUE_RESOLUTION, resp) == 0) {
365 if (resp[0] != 0 && (resp[1] & 0x80) && resp[2] != 0) {
366 priv->x_res = resp[0]; /* x resolution in units/mm */
367 priv->y_res = resp[2]; /* y resolution in units/mm */
371 for (i = 0; min_max_pnpid_table[i].pnp_ids; i++) {
372 if (matches_pnp_id(psmouse, min_max_pnpid_table[i].pnp_ids)) {
373 priv->x_min = min_max_pnpid_table[i].x_min;
374 priv->x_max = min_max_pnpid_table[i].x_max;
375 priv->y_min = min_max_pnpid_table[i].y_min;
376 priv->y_max = min_max_pnpid_table[i].y_max;
377 return 0;
381 if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 5 &&
382 SYN_CAP_MAX_DIMENSIONS(priv->ext_cap_0c)) {
383 if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_MAX_COORDS, resp)) {
384 psmouse_warn(psmouse,
385 "device claims to have max coordinates query, but I'm not able to read it.\n");
386 } else {
387 priv->x_max = (resp[0] << 5) | ((resp[1] & 0x0f) << 1);
388 priv->y_max = (resp[2] << 5) | ((resp[1] & 0xf0) >> 3);
392 if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 7 &&
393 SYN_CAP_MIN_DIMENSIONS(priv->ext_cap_0c)) {
394 if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_MIN_COORDS, resp)) {
395 psmouse_warn(psmouse,
396 "device claims to have min coordinates query, but I'm not able to read it.\n");
397 } else {
398 priv->x_min = (resp[0] << 5) | ((resp[1] & 0x0f) << 1);
399 priv->y_min = (resp[2] << 5) | ((resp[1] & 0xf0) >> 3);
403 return 0;
406 static int synaptics_query_hardware(struct psmouse *psmouse)
408 if (synaptics_identify(psmouse))
409 return -1;
410 if (synaptics_model_id(psmouse))
411 return -1;
412 if (synaptics_firmware_id(psmouse))
413 return -1;
414 if (synaptics_board_id(psmouse))
415 return -1;
416 if (synaptics_capability(psmouse))
417 return -1;
418 if (synaptics_resolution(psmouse))
419 return -1;
421 return 0;
424 static int synaptics_set_advanced_gesture_mode(struct psmouse *psmouse)
426 static unsigned char param = 0xc8;
427 struct synaptics_data *priv = psmouse->private;
429 if (!(SYN_CAP_ADV_GESTURE(priv->ext_cap_0c) ||
430 SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)))
431 return 0;
433 if (psmouse_sliced_command(psmouse, SYN_QUE_MODEL))
434 return -1;
436 if (ps2_command(&psmouse->ps2dev, &param, PSMOUSE_CMD_SETRATE))
437 return -1;
439 /* Advanced gesture mode also sends multi finger data */
440 priv->capabilities |= BIT(1);
442 return 0;
445 static int synaptics_set_mode(struct psmouse *psmouse)
447 struct synaptics_data *priv = psmouse->private;
449 priv->mode = 0;
450 if (priv->absolute_mode)
451 priv->mode |= SYN_BIT_ABSOLUTE_MODE;
452 if (priv->disable_gesture)
453 priv->mode |= SYN_BIT_DISABLE_GESTURE;
454 if (psmouse->rate >= 80)
455 priv->mode |= SYN_BIT_HIGH_RATE;
456 if (SYN_CAP_EXTENDED(priv->capabilities))
457 priv->mode |= SYN_BIT_W_MODE;
459 if (synaptics_mode_cmd(psmouse, priv->mode))
460 return -1;
462 if (priv->absolute_mode &&
463 synaptics_set_advanced_gesture_mode(psmouse)) {
464 psmouse_err(psmouse, "Advanced gesture mode init failed.\n");
465 return -1;
468 return 0;
471 static void synaptics_set_rate(struct psmouse *psmouse, unsigned int rate)
473 struct synaptics_data *priv = psmouse->private;
475 if (rate >= 80) {
476 priv->mode |= SYN_BIT_HIGH_RATE;
477 psmouse->rate = 80;
478 } else {
479 priv->mode &= ~SYN_BIT_HIGH_RATE;
480 psmouse->rate = 40;
483 synaptics_mode_cmd(psmouse, priv->mode);
486 /*****************************************************************************
487 * Synaptics pass-through PS/2 port support
488 ****************************************************************************/
489 static int synaptics_pt_write(struct serio *serio, unsigned char c)
491 struct psmouse *parent = serio_get_drvdata(serio->parent);
492 char rate_param = SYN_PS_CLIENT_CMD; /* indicates that we want pass-through port */
494 if (psmouse_sliced_command(parent, c))
495 return -1;
496 if (ps2_command(&parent->ps2dev, &rate_param, PSMOUSE_CMD_SETRATE))
497 return -1;
498 return 0;
501 static int synaptics_pt_start(struct serio *serio)
503 struct psmouse *parent = serio_get_drvdata(serio->parent);
504 struct synaptics_data *priv = parent->private;
506 serio_pause_rx(parent->ps2dev.serio);
507 priv->pt_port = serio;
508 serio_continue_rx(parent->ps2dev.serio);
510 return 0;
513 static void synaptics_pt_stop(struct serio *serio)
515 struct psmouse *parent = serio_get_drvdata(serio->parent);
516 struct synaptics_data *priv = parent->private;
518 serio_pause_rx(parent->ps2dev.serio);
519 priv->pt_port = NULL;
520 serio_continue_rx(parent->ps2dev.serio);
523 static int synaptics_is_pt_packet(unsigned char *buf)
525 return (buf[0] & 0xFC) == 0x84 && (buf[3] & 0xCC) == 0xC4;
528 static void synaptics_pass_pt_packet(struct serio *ptport, unsigned char *packet)
530 struct psmouse *child = serio_get_drvdata(ptport);
532 if (child && child->state == PSMOUSE_ACTIVATED) {
533 serio_interrupt(ptport, packet[1], 0);
534 serio_interrupt(ptport, packet[4], 0);
535 serio_interrupt(ptport, packet[5], 0);
536 if (child->pktsize == 4)
537 serio_interrupt(ptport, packet[2], 0);
538 } else
539 serio_interrupt(ptport, packet[1], 0);
542 static void synaptics_pt_activate(struct psmouse *psmouse)
544 struct synaptics_data *priv = psmouse->private;
545 struct psmouse *child = serio_get_drvdata(priv->pt_port);
547 /* adjust the touchpad to child's choice of protocol */
548 if (child) {
549 if (child->pktsize == 4)
550 priv->mode |= SYN_BIT_FOUR_BYTE_CLIENT;
551 else
552 priv->mode &= ~SYN_BIT_FOUR_BYTE_CLIENT;
554 if (synaptics_mode_cmd(psmouse, priv->mode))
555 psmouse_warn(psmouse,
556 "failed to switch guest protocol\n");
560 static void synaptics_pt_create(struct psmouse *psmouse)
562 struct serio *serio;
564 serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
565 if (!serio) {
566 psmouse_err(psmouse,
567 "not enough memory for pass-through port\n");
568 return;
571 serio->id.type = SERIO_PS_PSTHRU;
572 strlcpy(serio->name, "Synaptics pass-through", sizeof(serio->name));
573 strlcpy(serio->phys, "synaptics-pt/serio0", sizeof(serio->name));
574 serio->write = synaptics_pt_write;
575 serio->start = synaptics_pt_start;
576 serio->stop = synaptics_pt_stop;
577 serio->parent = psmouse->ps2dev.serio;
579 psmouse->pt_activate = synaptics_pt_activate;
581 psmouse_info(psmouse, "serio: %s port at %s\n",
582 serio->name, psmouse->phys);
583 serio_register_port(serio);
586 /*****************************************************************************
587 * Functions to interpret the absolute mode packets
588 ****************************************************************************/
590 static void synaptics_mt_state_set(struct synaptics_mt_state *state, int count,
591 int sgm, int agm)
593 state->count = count;
594 state->sgm = sgm;
595 state->agm = agm;
598 static void synaptics_parse_agm(const unsigned char buf[],
599 struct synaptics_data *priv,
600 struct synaptics_hw_state *hw)
602 struct synaptics_hw_state *agm = &priv->agm;
603 int agm_packet_type;
605 agm_packet_type = (buf[5] & 0x30) >> 4;
606 switch (agm_packet_type) {
607 case 1:
608 /* Gesture packet: (x, y, z) half resolution */
609 agm->w = hw->w;
610 agm->x = (((buf[4] & 0x0f) << 8) | buf[1]) << 1;
611 agm->y = (((buf[4] & 0xf0) << 4) | buf[2]) << 1;
612 agm->z = ((buf[3] & 0x30) | (buf[5] & 0x0f)) << 1;
613 break;
615 case 2:
616 /* AGM-CONTACT packet: (count, sgm, agm) */
617 synaptics_mt_state_set(&agm->mt_state, buf[1], buf[2], buf[4]);
618 break;
620 default:
621 break;
624 /* Record that at least one AGM has been received since last SGM */
625 priv->agm_pending = true;
628 static int synaptics_parse_hw_state(const unsigned char buf[],
629 struct synaptics_data *priv,
630 struct synaptics_hw_state *hw)
632 memset(hw, 0, sizeof(struct synaptics_hw_state));
634 if (SYN_MODEL_NEWABS(priv->model_id)) {
635 hw->w = (((buf[0] & 0x30) >> 2) |
636 ((buf[0] & 0x04) >> 1) |
637 ((buf[3] & 0x04) >> 2));
639 if ((SYN_CAP_ADV_GESTURE(priv->ext_cap_0c) ||
640 SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) &&
641 hw->w == 2) {
642 synaptics_parse_agm(buf, priv, hw);
643 return 1;
646 hw->x = (((buf[3] & 0x10) << 8) |
647 ((buf[1] & 0x0f) << 8) |
648 buf[4]);
649 hw->y = (((buf[3] & 0x20) << 7) |
650 ((buf[1] & 0xf0) << 4) |
651 buf[5]);
652 hw->z = buf[2];
654 hw->left = (buf[0] & 0x01) ? 1 : 0;
655 hw->right = (buf[0] & 0x02) ? 1 : 0;
657 if (SYN_CAP_FORCEPAD(priv->ext_cap_0c)) {
659 * ForcePads, like Clickpads, use middle button
660 * bits to report primary button clicks.
661 * Unfortunately they report primary button not
662 * only when user presses on the pad above certain
663 * threshold, but also when there are more than one
664 * finger on the touchpad, which interferes with
665 * out multi-finger gestures.
667 if (hw->z == 0) {
668 /* No contacts */
669 priv->press = priv->report_press = false;
670 } else if (hw->w >= 4 && ((buf[0] ^ buf[3]) & 0x01)) {
672 * Single-finger touch with pressure above
673 * the threshold. If pressure stays long
674 * enough, we'll start reporting primary
675 * button. We rely on the device continuing
676 * sending data even if finger does not
677 * move.
679 if (!priv->press) {
680 priv->press_start = jiffies;
681 priv->press = true;
682 } else if (time_after(jiffies,
683 priv->press_start +
684 msecs_to_jiffies(50))) {
685 priv->report_press = true;
687 } else {
688 priv->press = false;
691 hw->left = priv->report_press;
693 } else if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
695 * Clickpad's button is transmitted as middle button,
696 * however, since it is primary button, we will report
697 * it as BTN_LEFT.
699 hw->left = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
701 } else if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
702 hw->middle = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
703 if (hw->w == 2)
704 hw->scroll = (signed char)(buf[1]);
707 if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
708 hw->up = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
709 hw->down = ((buf[0] ^ buf[3]) & 0x02) ? 1 : 0;
712 if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) &&
713 ((buf[0] ^ buf[3]) & 0x02)) {
714 switch (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) & ~0x01) {
715 default:
717 * if nExtBtn is greater than 8 it should be
718 * considered invalid and treated as 0
720 break;
721 case 8:
722 hw->ext_buttons |= ((buf[5] & 0x08)) ? 0x80 : 0;
723 hw->ext_buttons |= ((buf[4] & 0x08)) ? 0x40 : 0;
724 case 6:
725 hw->ext_buttons |= ((buf[5] & 0x04)) ? 0x20 : 0;
726 hw->ext_buttons |= ((buf[4] & 0x04)) ? 0x10 : 0;
727 case 4:
728 hw->ext_buttons |= ((buf[5] & 0x02)) ? 0x08 : 0;
729 hw->ext_buttons |= ((buf[4] & 0x02)) ? 0x04 : 0;
730 case 2:
731 hw->ext_buttons |= ((buf[5] & 0x01)) ? 0x02 : 0;
732 hw->ext_buttons |= ((buf[4] & 0x01)) ? 0x01 : 0;
735 } else {
736 hw->x = (((buf[1] & 0x1f) << 8) | buf[2]);
737 hw->y = (((buf[4] & 0x1f) << 8) | buf[5]);
739 hw->z = (((buf[0] & 0x30) << 2) | (buf[3] & 0x3F));
740 hw->w = (((buf[1] & 0x80) >> 4) | ((buf[0] & 0x04) >> 1));
742 hw->left = (buf[0] & 0x01) ? 1 : 0;
743 hw->right = (buf[0] & 0x02) ? 1 : 0;
747 * Convert wrap-around values to negative. (X|Y)_MAX_POSITIVE
748 * is used by some firmware to indicate a finger at the edge of
749 * the touchpad whose precise position cannot be determined, so
750 * convert these values to the maximum axis value.
752 if (hw->x > X_MAX_POSITIVE)
753 hw->x -= 1 << ABS_POS_BITS;
754 else if (hw->x == X_MAX_POSITIVE)
755 hw->x = XMAX;
757 if (hw->y > Y_MAX_POSITIVE)
758 hw->y -= 1 << ABS_POS_BITS;
759 else if (hw->y == Y_MAX_POSITIVE)
760 hw->y = YMAX;
762 return 0;
765 static void synaptics_report_semi_mt_slot(struct input_dev *dev, int slot,
766 bool active, int x, int y)
768 input_mt_slot(dev, slot);
769 input_mt_report_slot_state(dev, MT_TOOL_FINGER, active);
770 if (active) {
771 input_report_abs(dev, ABS_MT_POSITION_X, x);
772 input_report_abs(dev, ABS_MT_POSITION_Y, synaptics_invert_y(y));
776 static void synaptics_report_semi_mt_data(struct input_dev *dev,
777 const struct synaptics_hw_state *a,
778 const struct synaptics_hw_state *b,
779 int num_fingers)
781 if (num_fingers >= 2) {
782 synaptics_report_semi_mt_slot(dev, 0, true, min(a->x, b->x),
783 min(a->y, b->y));
784 synaptics_report_semi_mt_slot(dev, 1, true, max(a->x, b->x),
785 max(a->y, b->y));
786 } else if (num_fingers == 1) {
787 synaptics_report_semi_mt_slot(dev, 0, true, a->x, a->y);
788 synaptics_report_semi_mt_slot(dev, 1, false, 0, 0);
789 } else {
790 synaptics_report_semi_mt_slot(dev, 0, false, 0, 0);
791 synaptics_report_semi_mt_slot(dev, 1, false, 0, 0);
795 static void synaptics_report_buttons(struct psmouse *psmouse,
796 const struct synaptics_hw_state *hw)
798 struct input_dev *dev = psmouse->dev;
799 struct synaptics_data *priv = psmouse->private;
800 int i;
802 input_report_key(dev, BTN_LEFT, hw->left);
803 input_report_key(dev, BTN_RIGHT, hw->right);
805 if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
806 input_report_key(dev, BTN_MIDDLE, hw->middle);
808 if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
809 input_report_key(dev, BTN_FORWARD, hw->up);
810 input_report_key(dev, BTN_BACK, hw->down);
813 for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
814 input_report_key(dev, BTN_0 + i, hw->ext_buttons & (1 << i));
817 static void synaptics_report_slot(struct input_dev *dev, int slot,
818 const struct synaptics_hw_state *hw)
820 input_mt_slot(dev, slot);
821 input_mt_report_slot_state(dev, MT_TOOL_FINGER, (hw != NULL));
822 if (!hw)
823 return;
825 input_report_abs(dev, ABS_MT_POSITION_X, hw->x);
826 input_report_abs(dev, ABS_MT_POSITION_Y, synaptics_invert_y(hw->y));
827 input_report_abs(dev, ABS_MT_PRESSURE, hw->z);
830 static void synaptics_report_mt_data(struct psmouse *psmouse,
831 struct synaptics_mt_state *mt_state,
832 const struct synaptics_hw_state *sgm)
834 struct input_dev *dev = psmouse->dev;
835 struct synaptics_data *priv = psmouse->private;
836 struct synaptics_hw_state *agm = &priv->agm;
837 struct synaptics_mt_state *old = &priv->mt_state;
839 switch (mt_state->count) {
840 case 0:
841 synaptics_report_slot(dev, 0, NULL);
842 synaptics_report_slot(dev, 1, NULL);
843 break;
844 case 1:
845 if (mt_state->sgm == -1) {
846 synaptics_report_slot(dev, 0, NULL);
847 synaptics_report_slot(dev, 1, NULL);
848 } else if (mt_state->sgm == 0) {
849 synaptics_report_slot(dev, 0, sgm);
850 synaptics_report_slot(dev, 1, NULL);
851 } else {
852 synaptics_report_slot(dev, 0, NULL);
853 synaptics_report_slot(dev, 1, sgm);
855 break;
856 default:
858 * If the finger slot contained in SGM is valid, and either
859 * hasn't changed, or is new, or the old SGM has now moved to
860 * AGM, then report SGM in MTB slot 0.
861 * Otherwise, empty MTB slot 0.
863 if (mt_state->sgm != -1 &&
864 (mt_state->sgm == old->sgm ||
865 old->sgm == -1 || mt_state->agm == old->sgm))
866 synaptics_report_slot(dev, 0, sgm);
867 else
868 synaptics_report_slot(dev, 0, NULL);
871 * If the finger slot contained in AGM is valid, and either
872 * hasn't changed, or is new, then report AGM in MTB slot 1.
873 * Otherwise, empty MTB slot 1.
875 * However, in the case where the AGM is new, make sure that
876 * that it is either the same as the old SGM, or there was no
877 * SGM.
879 * Otherwise, if the SGM was just 1, and the new AGM is 2, then
880 * the new AGM will keep the old SGM's tracking ID, which can
881 * cause apparent drumroll. This happens if in the following
882 * valid finger sequence:
884 * Action SGM AGM (MTB slot:Contact)
885 * 1. Touch contact 0 (0:0)
886 * 2. Touch contact 1 (0:0, 1:1)
887 * 3. Lift contact 0 (1:1)
888 * 4. Touch contacts 2,3 (0:2, 1:3)
890 * In step 4, contact 3, in AGM must not be given the same
891 * tracking ID as contact 1 had in step 3. To avoid this,
892 * the first agm with contact 3 is dropped and slot 1 is
893 * invalidated (tracking ID = -1).
895 if (mt_state->agm != -1 &&
896 (mt_state->agm == old->agm ||
897 (old->agm == -1 &&
898 (old->sgm == -1 || mt_state->agm == old->sgm))))
899 synaptics_report_slot(dev, 1, agm);
900 else
901 synaptics_report_slot(dev, 1, NULL);
902 break;
905 /* Don't use active slot count to generate BTN_TOOL events. */
906 input_mt_report_pointer_emulation(dev, false);
908 /* Send the number of fingers reported by touchpad itself. */
909 input_mt_report_finger_count(dev, mt_state->count);
911 synaptics_report_buttons(psmouse, sgm);
913 input_sync(dev);
916 /* Handle case where mt_state->count = 0 */
917 static void synaptics_image_sensor_0f(struct synaptics_data *priv,
918 struct synaptics_mt_state *mt_state)
920 synaptics_mt_state_set(mt_state, 0, -1, -1);
921 priv->mt_state_lost = false;
924 /* Handle case where mt_state->count = 1 */
925 static void synaptics_image_sensor_1f(struct synaptics_data *priv,
926 struct synaptics_mt_state *mt_state)
928 struct synaptics_hw_state *agm = &priv->agm;
929 struct synaptics_mt_state *old = &priv->mt_state;
932 * If the last AGM was (0,0,0), and there is only one finger left,
933 * then we absolutely know that SGM contains slot 0, and all other
934 * fingers have been removed.
936 if (priv->agm_pending && agm->z == 0) {
937 synaptics_mt_state_set(mt_state, 1, 0, -1);
938 priv->mt_state_lost = false;
939 return;
942 switch (old->count) {
943 case 0:
944 synaptics_mt_state_set(mt_state, 1, 0, -1);
945 break;
946 case 1:
948 * If mt_state_lost, then the previous transition was 3->1,
949 * and SGM now contains either slot 0 or 1, but we don't know
950 * which. So, we just assume that the SGM now contains slot 1.
952 * If pending AGM and either:
953 * (a) the previous SGM slot contains slot 0, or
954 * (b) there was no SGM slot
955 * then, the SGM now contains slot 1
957 * Case (a) happens with very rapid "drum roll" gestures, where
958 * slot 0 finger is lifted and a new slot 1 finger touches
959 * within one reporting interval.
961 * Case (b) happens if initially two or more fingers tap
962 * briefly, and all but one lift before the end of the first
963 * reporting interval.
965 * (In both these cases, slot 0 will becomes empty, so SGM
966 * contains slot 1 with the new finger)
968 * Else, if there was no previous SGM, it now contains slot 0.
970 * Otherwise, SGM still contains the same slot.
972 if (priv->mt_state_lost ||
973 (priv->agm_pending && old->sgm <= 0))
974 synaptics_mt_state_set(mt_state, 1, 1, -1);
975 else if (old->sgm == -1)
976 synaptics_mt_state_set(mt_state, 1, 0, -1);
977 break;
978 case 2:
980 * If mt_state_lost, we don't know which finger SGM contains.
982 * So, report 1 finger, but with both slots empty.
983 * We will use slot 1 on subsequent 1->1
985 if (priv->mt_state_lost) {
986 synaptics_mt_state_set(mt_state, 1, -1, -1);
987 break;
990 * Since the last AGM was NOT (0,0,0), it was the finger in
991 * slot 0 that has been removed.
992 * So, SGM now contains previous AGM's slot, and AGM is now
993 * empty.
995 synaptics_mt_state_set(mt_state, 1, old->agm, -1);
996 break;
997 case 3:
999 * Since last AGM was not (0,0,0), we don't know which finger
1000 * is left.
1002 * So, report 1 finger, but with both slots empty.
1003 * We will use slot 1 on subsequent 1->1
1005 synaptics_mt_state_set(mt_state, 1, -1, -1);
1006 priv->mt_state_lost = true;
1007 break;
1008 case 4:
1009 case 5:
1010 /* mt_state was updated by AGM-CONTACT packet */
1011 break;
1015 /* Handle case where mt_state->count = 2 */
1016 static void synaptics_image_sensor_2f(struct synaptics_data *priv,
1017 struct synaptics_mt_state *mt_state)
1019 struct synaptics_mt_state *old = &priv->mt_state;
1021 switch (old->count) {
1022 case 0:
1023 synaptics_mt_state_set(mt_state, 2, 0, 1);
1024 break;
1025 case 1:
1027 * If previous SGM contained slot 1 or higher, SGM now contains
1028 * slot 0 (the newly touching finger) and AGM contains SGM's
1029 * previous slot.
1031 * Otherwise, SGM still contains slot 0 and AGM now contains
1032 * slot 1.
1034 if (old->sgm >= 1)
1035 synaptics_mt_state_set(mt_state, 2, 0, old->sgm);
1036 else
1037 synaptics_mt_state_set(mt_state, 2, 0, 1);
1038 break;
1039 case 2:
1041 * If mt_state_lost, SGM now contains either finger 1 or 2, but
1042 * we don't know which.
1043 * So, we just assume that the SGM contains slot 0 and AGM 1.
1045 if (priv->mt_state_lost)
1046 synaptics_mt_state_set(mt_state, 2, 0, 1);
1048 * Otherwise, use the same mt_state, since it either hasn't
1049 * changed, or was updated by a recently received AGM-CONTACT
1050 * packet.
1052 break;
1053 case 3:
1055 * 3->2 transitions have two unsolvable problems:
1056 * 1) no indication is given which finger was removed
1057 * 2) no way to tell if agm packet was for finger 3
1058 * before 3->2, or finger 2 after 3->2.
1060 * So, report 2 fingers, but empty all slots.
1061 * We will guess slots [0,1] on subsequent 2->2.
1063 synaptics_mt_state_set(mt_state, 2, -1, -1);
1064 priv->mt_state_lost = true;
1065 break;
1066 case 4:
1067 case 5:
1068 /* mt_state was updated by AGM-CONTACT packet */
1069 break;
1073 /* Handle case where mt_state->count = 3 */
1074 static void synaptics_image_sensor_3f(struct synaptics_data *priv,
1075 struct synaptics_mt_state *mt_state)
1077 struct synaptics_mt_state *old = &priv->mt_state;
1079 switch (old->count) {
1080 case 0:
1081 synaptics_mt_state_set(mt_state, 3, 0, 2);
1082 break;
1083 case 1:
1085 * If previous SGM contained slot 2 or higher, SGM now contains
1086 * slot 0 (one of the newly touching fingers) and AGM contains
1087 * SGM's previous slot.
1089 * Otherwise, SGM now contains slot 0 and AGM contains slot 2.
1091 if (old->sgm >= 2)
1092 synaptics_mt_state_set(mt_state, 3, 0, old->sgm);
1093 else
1094 synaptics_mt_state_set(mt_state, 3, 0, 2);
1095 break;
1096 case 2:
1098 * If the AGM previously contained slot 3 or higher, then the
1099 * newly touching finger is in the lowest available slot.
1101 * If SGM was previously 1 or higher, then the new SGM is
1102 * now slot 0 (with a new finger), otherwise, the new finger
1103 * is now in a hidden slot between 0 and AGM's slot.
1105 * In all such cases, the SGM now contains slot 0, and the AGM
1106 * continues to contain the same slot as before.
1108 if (old->agm >= 3) {
1109 synaptics_mt_state_set(mt_state, 3, 0, old->agm);
1110 break;
1114 * After some 3->1 and all 3->2 transitions, we lose track
1115 * of which slot is reported by SGM and AGM.
1117 * For 2->3 in this state, report 3 fingers, but empty all
1118 * slots, and we will guess (0,2) on a subsequent 0->3.
1120 * To userspace, the resulting transition will look like:
1121 * 2:[0,1] -> 3:[-1,-1] -> 3:[0,2]
1123 if (priv->mt_state_lost) {
1124 synaptics_mt_state_set(mt_state, 3, -1, -1);
1125 break;
1129 * If the (SGM,AGM) really previously contained slots (0, 1),
1130 * then we cannot know what slot was just reported by the AGM,
1131 * because the 2->3 transition can occur either before or after
1132 * the AGM packet. Thus, this most recent AGM could contain
1133 * either the same old slot 1 or the new slot 2.
1134 * Subsequent AGMs will be reporting slot 2.
1136 * To userspace, the resulting transition will look like:
1137 * 2:[0,1] -> 3:[0,-1] -> 3:[0,2]
1139 synaptics_mt_state_set(mt_state, 3, 0, -1);
1140 break;
1141 case 3:
1143 * If, for whatever reason, the previous agm was invalid,
1144 * Assume SGM now contains slot 0, AGM now contains slot 2.
1146 if (old->agm <= 2)
1147 synaptics_mt_state_set(mt_state, 3, 0, 2);
1149 * mt_state either hasn't changed, or was updated by a recently
1150 * received AGM-CONTACT packet.
1152 break;
1154 case 4:
1155 case 5:
1156 /* mt_state was updated by AGM-CONTACT packet */
1157 break;
1161 /* Handle case where mt_state->count = 4, or = 5 */
1162 static void synaptics_image_sensor_45f(struct synaptics_data *priv,
1163 struct synaptics_mt_state *mt_state)
1165 /* mt_state was updated correctly by AGM-CONTACT packet */
1166 priv->mt_state_lost = false;
1169 static void synaptics_image_sensor_process(struct psmouse *psmouse,
1170 struct synaptics_hw_state *sgm)
1172 struct synaptics_data *priv = psmouse->private;
1173 struct synaptics_hw_state *agm = &priv->agm;
1174 struct synaptics_mt_state mt_state;
1176 /* Initialize using current mt_state (as updated by last agm) */
1177 mt_state = agm->mt_state;
1180 * Update mt_state using the new finger count and current mt_state.
1182 if (sgm->z == 0)
1183 synaptics_image_sensor_0f(priv, &mt_state);
1184 else if (sgm->w >= 4)
1185 synaptics_image_sensor_1f(priv, &mt_state);
1186 else if (sgm->w == 0)
1187 synaptics_image_sensor_2f(priv, &mt_state);
1188 else if (sgm->w == 1 && mt_state.count <= 3)
1189 synaptics_image_sensor_3f(priv, &mt_state);
1190 else
1191 synaptics_image_sensor_45f(priv, &mt_state);
1193 /* Send resulting input events to user space */
1194 synaptics_report_mt_data(psmouse, &mt_state, sgm);
1196 /* Store updated mt_state */
1197 priv->mt_state = agm->mt_state = mt_state;
1198 priv->agm_pending = false;
1202 * called for each full received packet from the touchpad
1204 static void synaptics_process_packet(struct psmouse *psmouse)
1206 struct input_dev *dev = psmouse->dev;
1207 struct synaptics_data *priv = psmouse->private;
1208 struct synaptics_hw_state hw;
1209 int num_fingers;
1210 int finger_width;
1212 if (synaptics_parse_hw_state(psmouse->packet, priv, &hw))
1213 return;
1215 if (SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) {
1216 synaptics_image_sensor_process(psmouse, &hw);
1217 return;
1220 if (hw.scroll) {
1221 priv->scroll += hw.scroll;
1223 while (priv->scroll >= 4) {
1224 input_report_key(dev, BTN_BACK, !hw.down);
1225 input_sync(dev);
1226 input_report_key(dev, BTN_BACK, hw.down);
1227 input_sync(dev);
1228 priv->scroll -= 4;
1230 while (priv->scroll <= -4) {
1231 input_report_key(dev, BTN_FORWARD, !hw.up);
1232 input_sync(dev);
1233 input_report_key(dev, BTN_FORWARD, hw.up);
1234 input_sync(dev);
1235 priv->scroll += 4;
1237 return;
1240 if (hw.z > 0 && hw.x > 1) {
1241 num_fingers = 1;
1242 finger_width = 5;
1243 if (SYN_CAP_EXTENDED(priv->capabilities)) {
1244 switch (hw.w) {
1245 case 0 ... 1:
1246 if (SYN_CAP_MULTIFINGER(priv->capabilities))
1247 num_fingers = hw.w + 2;
1248 break;
1249 case 2:
1250 if (SYN_MODEL_PEN(priv->model_id))
1251 ; /* Nothing, treat a pen as a single finger */
1252 break;
1253 case 4 ... 15:
1254 if (SYN_CAP_PALMDETECT(priv->capabilities))
1255 finger_width = hw.w;
1256 break;
1259 } else {
1260 num_fingers = 0;
1261 finger_width = 0;
1264 if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c))
1265 synaptics_report_semi_mt_data(dev, &hw, &priv->agm,
1266 num_fingers);
1268 /* Post events
1269 * BTN_TOUCH has to be first as mousedev relies on it when doing
1270 * absolute -> relative conversion
1272 if (hw.z > 30) input_report_key(dev, BTN_TOUCH, 1);
1273 if (hw.z < 25) input_report_key(dev, BTN_TOUCH, 0);
1275 if (num_fingers > 0) {
1276 input_report_abs(dev, ABS_X, hw.x);
1277 input_report_abs(dev, ABS_Y, synaptics_invert_y(hw.y));
1279 input_report_abs(dev, ABS_PRESSURE, hw.z);
1281 if (SYN_CAP_PALMDETECT(priv->capabilities))
1282 input_report_abs(dev, ABS_TOOL_WIDTH, finger_width);
1284 input_report_key(dev, BTN_TOOL_FINGER, num_fingers == 1);
1285 if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
1286 input_report_key(dev, BTN_TOOL_DOUBLETAP, num_fingers == 2);
1287 input_report_key(dev, BTN_TOOL_TRIPLETAP, num_fingers == 3);
1290 synaptics_report_buttons(psmouse, &hw);
1292 input_sync(dev);
1295 static int synaptics_validate_byte(struct psmouse *psmouse,
1296 int idx, unsigned char pkt_type)
1298 static const unsigned char newabs_mask[] = { 0xC8, 0x00, 0x00, 0xC8, 0x00 };
1299 static const unsigned char newabs_rel_mask[] = { 0xC0, 0x00, 0x00, 0xC0, 0x00 };
1300 static const unsigned char newabs_rslt[] = { 0x80, 0x00, 0x00, 0xC0, 0x00 };
1301 static const unsigned char oldabs_mask[] = { 0xC0, 0x60, 0x00, 0xC0, 0x60 };
1302 static const unsigned char oldabs_rslt[] = { 0xC0, 0x00, 0x00, 0x80, 0x00 };
1303 const char *packet = psmouse->packet;
1305 if (idx < 0 || idx > 4)
1306 return 0;
1308 switch (pkt_type) {
1310 case SYN_NEWABS:
1311 case SYN_NEWABS_RELAXED:
1312 return (packet[idx] & newabs_rel_mask[idx]) == newabs_rslt[idx];
1314 case SYN_NEWABS_STRICT:
1315 return (packet[idx] & newabs_mask[idx]) == newabs_rslt[idx];
1317 case SYN_OLDABS:
1318 return (packet[idx] & oldabs_mask[idx]) == oldabs_rslt[idx];
1320 default:
1321 psmouse_err(psmouse, "unknown packet type %d\n", pkt_type);
1322 return 0;
1326 static unsigned char synaptics_detect_pkt_type(struct psmouse *psmouse)
1328 int i;
1330 for (i = 0; i < 5; i++)
1331 if (!synaptics_validate_byte(psmouse, i, SYN_NEWABS_STRICT)) {
1332 psmouse_info(psmouse, "using relaxed packet validation\n");
1333 return SYN_NEWABS_RELAXED;
1336 return SYN_NEWABS_STRICT;
1339 static psmouse_ret_t synaptics_process_byte(struct psmouse *psmouse)
1341 struct synaptics_data *priv = psmouse->private;
1343 if (psmouse->pktcnt >= 6) { /* Full packet received */
1344 if (unlikely(priv->pkt_type == SYN_NEWABS))
1345 priv->pkt_type = synaptics_detect_pkt_type(psmouse);
1347 if (SYN_CAP_PASS_THROUGH(priv->capabilities) &&
1348 synaptics_is_pt_packet(psmouse->packet)) {
1349 if (priv->pt_port)
1350 synaptics_pass_pt_packet(priv->pt_port, psmouse->packet);
1351 } else
1352 synaptics_process_packet(psmouse);
1354 return PSMOUSE_FULL_PACKET;
1357 return synaptics_validate_byte(psmouse, psmouse->pktcnt - 1, priv->pkt_type) ?
1358 PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
1361 /*****************************************************************************
1362 * Driver initialization/cleanup functions
1363 ****************************************************************************/
1364 static void set_abs_position_params(struct input_dev *dev,
1365 struct synaptics_data *priv, int x_code,
1366 int y_code)
1368 int x_min = priv->x_min ?: XMIN_NOMINAL;
1369 int x_max = priv->x_max ?: XMAX_NOMINAL;
1370 int y_min = priv->y_min ?: YMIN_NOMINAL;
1371 int y_max = priv->y_max ?: YMAX_NOMINAL;
1372 int fuzz = SYN_CAP_REDUCED_FILTERING(priv->ext_cap_0c) ?
1373 SYN_REDUCED_FILTER_FUZZ : 0;
1375 input_set_abs_params(dev, x_code, x_min, x_max, fuzz, 0);
1376 input_set_abs_params(dev, y_code, y_min, y_max, fuzz, 0);
1377 input_abs_set_res(dev, x_code, priv->x_res);
1378 input_abs_set_res(dev, y_code, priv->y_res);
1381 static void set_input_params(struct psmouse *psmouse,
1382 struct synaptics_data *priv)
1384 struct input_dev *dev = psmouse->dev;
1385 int i;
1387 /* Things that apply to both modes */
1388 __set_bit(INPUT_PROP_POINTER, dev->propbit);
1389 __set_bit(EV_KEY, dev->evbit);
1390 __set_bit(BTN_LEFT, dev->keybit);
1391 __set_bit(BTN_RIGHT, dev->keybit);
1393 if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
1394 __set_bit(BTN_MIDDLE, dev->keybit);
1396 if (!priv->absolute_mode) {
1397 /* Relative mode */
1398 __set_bit(EV_REL, dev->evbit);
1399 __set_bit(REL_X, dev->relbit);
1400 __set_bit(REL_Y, dev->relbit);
1401 return;
1404 /* Absolute mode */
1405 __set_bit(EV_ABS, dev->evbit);
1406 set_abs_position_params(dev, priv, ABS_X, ABS_Y);
1407 input_set_abs_params(dev, ABS_PRESSURE, 0, 255, 0, 0);
1409 if (SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) {
1410 set_abs_position_params(dev, priv, ABS_MT_POSITION_X,
1411 ABS_MT_POSITION_Y);
1412 /* Image sensors can report per-contact pressure */
1413 input_set_abs_params(dev, ABS_MT_PRESSURE, 0, 255, 0, 0);
1414 input_mt_init_slots(dev, 2, INPUT_MT_POINTER);
1416 /* Image sensors can signal 4 and 5 finger clicks */
1417 __set_bit(BTN_TOOL_QUADTAP, dev->keybit);
1418 __set_bit(BTN_TOOL_QUINTTAP, dev->keybit);
1419 } else if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c)) {
1420 /* Non-image sensors with AGM use semi-mt */
1421 __set_bit(INPUT_PROP_SEMI_MT, dev->propbit);
1422 input_mt_init_slots(dev, 2, 0);
1423 set_abs_position_params(dev, priv, ABS_MT_POSITION_X,
1424 ABS_MT_POSITION_Y);
1427 if (SYN_CAP_PALMDETECT(priv->capabilities))
1428 input_set_abs_params(dev, ABS_TOOL_WIDTH, 0, 15, 0, 0);
1430 __set_bit(BTN_TOUCH, dev->keybit);
1431 __set_bit(BTN_TOOL_FINGER, dev->keybit);
1433 if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
1434 __set_bit(BTN_TOOL_DOUBLETAP, dev->keybit);
1435 __set_bit(BTN_TOOL_TRIPLETAP, dev->keybit);
1438 if (SYN_CAP_FOUR_BUTTON(priv->capabilities) ||
1439 SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
1440 __set_bit(BTN_FORWARD, dev->keybit);
1441 __set_bit(BTN_BACK, dev->keybit);
1444 for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
1445 __set_bit(BTN_0 + i, dev->keybit);
1447 __clear_bit(EV_REL, dev->evbit);
1448 __clear_bit(REL_X, dev->relbit);
1449 __clear_bit(REL_Y, dev->relbit);
1451 if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
1452 __set_bit(INPUT_PROP_BUTTONPAD, dev->propbit);
1453 if (matches_pnp_id(psmouse, topbuttonpad_pnp_ids))
1454 __set_bit(INPUT_PROP_TOPBUTTONPAD, dev->propbit);
1455 /* Clickpads report only left button */
1456 __clear_bit(BTN_RIGHT, dev->keybit);
1457 __clear_bit(BTN_MIDDLE, dev->keybit);
1461 static ssize_t synaptics_show_disable_gesture(struct psmouse *psmouse,
1462 void *data, char *buf)
1464 struct synaptics_data *priv = psmouse->private;
1466 return sprintf(buf, "%c\n", priv->disable_gesture ? '1' : '0');
1469 static ssize_t synaptics_set_disable_gesture(struct psmouse *psmouse,
1470 void *data, const char *buf,
1471 size_t len)
1473 struct synaptics_data *priv = psmouse->private;
1474 unsigned int value;
1475 int err;
1477 err = kstrtouint(buf, 10, &value);
1478 if (err)
1479 return err;
1481 if (value > 1)
1482 return -EINVAL;
1484 if (value == priv->disable_gesture)
1485 return len;
1487 priv->disable_gesture = value;
1488 if (value)
1489 priv->mode |= SYN_BIT_DISABLE_GESTURE;
1490 else
1491 priv->mode &= ~SYN_BIT_DISABLE_GESTURE;
1493 if (synaptics_mode_cmd(psmouse, priv->mode))
1494 return -EIO;
1496 return len;
1499 PSMOUSE_DEFINE_ATTR(disable_gesture, S_IWUSR | S_IRUGO, NULL,
1500 synaptics_show_disable_gesture,
1501 synaptics_set_disable_gesture);
1503 static void synaptics_disconnect(struct psmouse *psmouse)
1505 struct synaptics_data *priv = psmouse->private;
1507 if (!priv->absolute_mode && SYN_ID_DISGEST_SUPPORTED(priv->identity))
1508 device_remove_file(&psmouse->ps2dev.serio->dev,
1509 &psmouse_attr_disable_gesture.dattr);
1511 synaptics_reset(psmouse);
1512 kfree(priv);
1513 psmouse->private = NULL;
1516 static int synaptics_reconnect(struct psmouse *psmouse)
1518 struct synaptics_data *priv = psmouse->private;
1519 struct synaptics_data old_priv = *priv;
1520 unsigned char param[2];
1521 int retry = 0;
1522 int error;
1524 do {
1525 psmouse_reset(psmouse);
1526 if (retry) {
1528 * On some boxes, right after resuming, the touchpad
1529 * needs some time to finish initializing (I assume
1530 * it needs time to calibrate) and start responding
1531 * to Synaptics-specific queries, so let's wait a
1532 * bit.
1534 ssleep(1);
1536 ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETID);
1537 error = synaptics_detect(psmouse, 0);
1538 } while (error && ++retry < 3);
1540 if (error)
1541 return -1;
1543 if (retry > 1)
1544 psmouse_dbg(psmouse, "reconnected after %d tries\n", retry);
1546 if (synaptics_query_hardware(psmouse)) {
1547 psmouse_err(psmouse, "Unable to query device.\n");
1548 return -1;
1551 if (synaptics_set_mode(psmouse)) {
1552 psmouse_err(psmouse, "Unable to initialize device.\n");
1553 return -1;
1556 if (old_priv.identity != priv->identity ||
1557 old_priv.model_id != priv->model_id ||
1558 old_priv.capabilities != priv->capabilities ||
1559 old_priv.ext_cap != priv->ext_cap) {
1560 psmouse_err(psmouse,
1561 "hardware appears to be different: id(%ld-%ld), model(%ld-%ld), caps(%lx-%lx), ext(%lx-%lx).\n",
1562 old_priv.identity, priv->identity,
1563 old_priv.model_id, priv->model_id,
1564 old_priv.capabilities, priv->capabilities,
1565 old_priv.ext_cap, priv->ext_cap);
1566 return -1;
1569 return 0;
1572 static bool impaired_toshiba_kbc;
1574 static const struct dmi_system_id toshiba_dmi_table[] __initconst = {
1575 #if defined(CONFIG_DMI) && defined(CONFIG_X86)
1577 /* Toshiba Satellite */
1578 .matches = {
1579 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1580 DMI_MATCH(DMI_PRODUCT_NAME, "Satellite"),
1584 /* Toshiba Dynabook */
1585 .matches = {
1586 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1587 DMI_MATCH(DMI_PRODUCT_NAME, "dynabook"),
1591 /* Toshiba Portege M300 */
1592 .matches = {
1593 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1594 DMI_MATCH(DMI_PRODUCT_NAME, "PORTEGE M300"),
1599 /* Toshiba Portege M300 */
1600 .matches = {
1601 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1602 DMI_MATCH(DMI_PRODUCT_NAME, "Portable PC"),
1603 DMI_MATCH(DMI_PRODUCT_VERSION, "Version 1.0"),
1607 #endif
1611 static bool broken_olpc_ec;
1613 static const struct dmi_system_id olpc_dmi_table[] __initconst = {
1614 #if defined(CONFIG_DMI) && defined(CONFIG_OLPC)
1616 /* OLPC XO-1 or XO-1.5 */
1617 .matches = {
1618 DMI_MATCH(DMI_SYS_VENDOR, "OLPC"),
1619 DMI_MATCH(DMI_PRODUCT_NAME, "XO"),
1622 #endif
1626 void __init synaptics_module_init(void)
1628 impaired_toshiba_kbc = dmi_check_system(toshiba_dmi_table);
1629 broken_olpc_ec = dmi_check_system(olpc_dmi_table);
1632 static int __synaptics_init(struct psmouse *psmouse, bool absolute_mode)
1634 struct synaptics_data *priv;
1635 int err = -1;
1638 * The OLPC XO has issues with Synaptics' absolute mode; the constant
1639 * packet spew overloads the EC such that key presses on the keyboard
1640 * are missed. Given that, don't even attempt to use Absolute mode.
1641 * Relative mode seems to work just fine.
1643 if (absolute_mode && broken_olpc_ec) {
1644 psmouse_info(psmouse,
1645 "OLPC XO detected, not enabling Synaptics protocol.\n");
1646 return -ENODEV;
1649 psmouse->private = priv = kzalloc(sizeof(struct synaptics_data), GFP_KERNEL);
1650 if (!priv)
1651 return -ENOMEM;
1653 psmouse_reset(psmouse);
1655 if (synaptics_query_hardware(psmouse)) {
1656 psmouse_err(psmouse, "Unable to query device.\n");
1657 goto init_fail;
1660 priv->absolute_mode = absolute_mode;
1661 if (SYN_ID_DISGEST_SUPPORTED(priv->identity))
1662 priv->disable_gesture = true;
1664 if (synaptics_set_mode(psmouse)) {
1665 psmouse_err(psmouse, "Unable to initialize device.\n");
1666 goto init_fail;
1669 priv->pkt_type = SYN_MODEL_NEWABS(priv->model_id) ? SYN_NEWABS : SYN_OLDABS;
1671 psmouse_info(psmouse,
1672 "Touchpad model: %ld, fw: %ld.%ld, id: %#lx, caps: %#lx/%#lx/%#lx, board id: %lu, fw id: %lu\n",
1673 SYN_ID_MODEL(priv->identity),
1674 SYN_ID_MAJOR(priv->identity), SYN_ID_MINOR(priv->identity),
1675 priv->model_id,
1676 priv->capabilities, priv->ext_cap, priv->ext_cap_0c,
1677 priv->board_id, priv->firmware_id);
1679 set_input_params(psmouse, priv);
1682 * Encode touchpad model so that it can be used to set
1683 * input device->id.version and be visible to userspace.
1684 * Because version is __u16 we have to drop something.
1685 * Hardware info bits seem to be good candidates as they
1686 * are documented to be for Synaptics corp. internal use.
1688 psmouse->model = ((priv->model_id & 0x00ff0000) >> 8) |
1689 (priv->model_id & 0x000000ff);
1691 if (absolute_mode) {
1692 psmouse->protocol_handler = synaptics_process_byte;
1693 psmouse->pktsize = 6;
1694 } else {
1695 /* Relative mode follows standard PS/2 mouse protocol */
1696 psmouse->protocol_handler = psmouse_process_byte;
1697 psmouse->pktsize = 3;
1700 psmouse->set_rate = synaptics_set_rate;
1701 psmouse->disconnect = synaptics_disconnect;
1702 psmouse->reconnect = synaptics_reconnect;
1703 psmouse->cleanup = synaptics_reset;
1704 /* Synaptics can usually stay in sync without extra help */
1705 psmouse->resync_time = 0;
1707 if (SYN_CAP_PASS_THROUGH(priv->capabilities))
1708 synaptics_pt_create(psmouse);
1711 * Toshiba's KBC seems to have trouble handling data from
1712 * Synaptics at full rate. Switch to a lower rate (roughly
1713 * the same rate as a standard PS/2 mouse).
1715 if (psmouse->rate >= 80 && impaired_toshiba_kbc) {
1716 psmouse_info(psmouse,
1717 "Toshiba %s detected, limiting rate to 40pps.\n",
1718 dmi_get_system_info(DMI_PRODUCT_NAME));
1719 psmouse->rate = 40;
1722 if (!priv->absolute_mode && SYN_ID_DISGEST_SUPPORTED(priv->identity)) {
1723 err = device_create_file(&psmouse->ps2dev.serio->dev,
1724 &psmouse_attr_disable_gesture.dattr);
1725 if (err) {
1726 psmouse_err(psmouse,
1727 "Failed to create disable_gesture attribute (%d)",
1728 err);
1729 goto init_fail;
1733 return 0;
1735 init_fail:
1736 kfree(priv);
1737 return err;
1740 int synaptics_init(struct psmouse *psmouse)
1742 return __synaptics_init(psmouse, true);
1745 int synaptics_init_relative(struct psmouse *psmouse)
1747 return __synaptics_init(psmouse, false);
1750 bool synaptics_supported(void)
1752 return true;
1755 #else /* CONFIG_MOUSE_PS2_SYNAPTICS */
1757 void __init synaptics_module_init(void)
1761 int synaptics_init(struct psmouse *psmouse)
1763 return -ENOSYS;
1766 bool synaptics_supported(void)
1768 return false;
1771 #endif /* CONFIG_MOUSE_PS2_SYNAPTICS */