blob: 3b06c8a360b661f02ed3aa826e5a996b93e5b358 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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>
Dmitry Torokhov85214782011-12-12 00:05:53 -080027#include <linux/delay.h>
Dmitry Torokhov7705d542009-12-03 23:21:14 -080028#include <linux/dmi.h>
Henrik Rydbergfec6e522010-12-21 18:11:25 +010029#include <linux/input/mt.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070030#include <linux/serio.h>
31#include <linux/libps2.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090032#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070033#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.
Dmitry Torokhov83ba9ea82010-05-10 23:06:52 -070040 * Note that newer firmware allows querying device for maximum useable
41 * coordinates.
Linus Torvalds1da177e2005-04-16 15:20:36 -070042 */
Seth Forsheec03945062012-07-24 23:54:11 -070043#define XMIN 0
44#define XMAX 6143
45#define YMIN 0
46#define YMAX 6143
Linus Torvalds1da177e2005-04-16 15:20:36 -070047#define XMIN_NOMINAL 1472
48#define XMAX_NOMINAL 5472
49#define YMIN_NOMINAL 1408
50#define YMAX_NOMINAL 4448
51
Seth Forsheec03945062012-07-24 23:54:11 -070052/* Size in bits of absolute position values reported by the hardware */
53#define ABS_POS_BITS 13
54
55/*
Seth Forshee824efd32012-09-28 10:29:21 -070056 * 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.
Seth Forsheec03945062012-07-24 23:54:11 -070066 */
Seth Forshee824efd32012-09-28 10:29:21 -070067#define X_MAX_POSITIVE 8176
68#define Y_MAX_POSITIVE 8176
Linus Torvalds1da177e2005-04-16 15:20:36 -070069
Andres Salomon55e3d922007-03-10 01:39:54 -050070/*****************************************************************************
71 * Stuff we need even when we do not want native Synaptics support
72 ****************************************************************************/
Linus Torvalds1da177e2005-04-16 15:20:36 -070073
74/*
75 * Set the synaptics touchpad mode byte by special commands
76 */
77static 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
Dmitry Torokhovb7802c52009-09-09 19:13:20 -070089int synaptics_detect(struct psmouse *psmouse, bool set_properties)
Andres Salomon55e3d922007-03-10 01:39:54 -050090{
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
113void 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
Henrik Rydberge08d9af2014-07-14 10:26:56 -0700120
121static bool cr48_profile_sensor;
122
Daniel Martin5b3089d2015-03-08 22:29:15 -0700123#define ANY_BOARD_ID 0
Hans de Goede0f68f392014-05-19 22:54:09 -0700124struct min_max_quirk {
125 const char * const *pnp_ids;
Daniel Martin5b3089d2015-03-08 22:29:15 -0700126 struct {
127 unsigned long int min, max;
128 } board_id;
Hans de Goede0f68f392014-05-19 22:54:09 -0700129 int x_min, x_max, y_min, y_max;
130};
131
132static const struct min_max_quirk min_max_pnpid_table[] = {
133 {
134 (const char * const []){"LEN0033", NULL},
Daniel Martin5b3089d2015-03-08 22:29:15 -0700135 {ANY_BOARD_ID, ANY_BOARD_ID},
Hans de Goede0f68f392014-05-19 22:54:09 -0700136 1024, 5052, 2258, 4832
137 },
138 {
Daniel Martinb05f4d12015-03-08 22:29:07 -0700139 (const char * const []){"LEN0042", NULL},
Daniel Martin5b3089d2015-03-08 22:29:15 -0700140 {ANY_BOARD_ID, ANY_BOARD_ID},
Hans de Goede0f68f392014-05-19 22:54:09 -0700141 1232, 5710, 1156, 4696
142 },
143 {
Peter Hutterer8543cf12015-01-19 16:29:25 -0800144 (const char * const []){"LEN0034", "LEN0036", "LEN0037",
145 "LEN0039", "LEN2002", "LEN2004",
146 NULL},
Benjamin Tissoires02e07492015-03-08 22:29:25 -0700147 {ANY_BOARD_ID, 2961},
Hans de Goede0f68f392014-05-19 22:54:09 -0700148 1024, 5112, 2024, 4832
149 },
150 {
151 (const char * const []){"LEN2001", NULL},
Daniel Martin5b3089d2015-03-08 22:29:15 -0700152 {ANY_BOARD_ID, ANY_BOARD_ID},
Hans de Goede0f68f392014-05-19 22:54:09 -0700153 1024, 5022, 2508, 4832
154 },
Ben Sagalbce4f9e2014-11-16 17:23:40 -0800155 {
156 (const char * const []){"LEN2006", NULL},
Ramiro Morales98dc0702015-03-23 10:33:07 -0700157 {2691, 2691},
Filip Ayazi85734b12015-03-25 15:53:04 -0700158 1024, 5045, 2457, 4832
Ramiro Morales98dc0702015-03-23 10:33:07 -0700159 },
160 {
161 (const char * const []){"LEN2006", NULL},
Daniel Martin5b3089d2015-03-08 22:29:15 -0700162 {ANY_BOARD_ID, ANY_BOARD_ID},
Ben Sagalbce4f9e2014-11-16 17:23:40 -0800163 1264, 5675, 1171, 4688
164 },
Hans de Goede0f68f392014-05-19 22:54:09 -0700165 { }
166};
167
Hans de Goede43e19882014-04-19 22:26:41 -0700168/* This list has been kindly provided by Synaptics. */
169static const char * const topbuttonpad_pnp_ids[] = {
170 "LEN0017",
171 "LEN0018",
172 "LEN0019",
173 "LEN0023",
174 "LEN002A",
175 "LEN002B",
176 "LEN002C",
177 "LEN002D",
178 "LEN002E",
179 "LEN0033", /* Helix */
Hans de Goede0f68f392014-05-19 22:54:09 -0700180 "LEN0034", /* T431s, L440, L540, T540, W540, X1 Carbon 2nd */
Hans de Goede43e19882014-04-19 22:26:41 -0700181 "LEN0035", /* X240 */
182 "LEN0036", /* T440 */
Peter Hutterer8543cf12015-01-19 16:29:25 -0800183 "LEN0037", /* X1 Carbon 2nd */
Hans de Goede43e19882014-04-19 22:26:41 -0700184 "LEN0038",
Takashi Iwaie4742b12014-11-06 09:27:11 -0800185 "LEN0039", /* T440s */
Hans de Goede43e19882014-04-19 22:26:41 -0700186 "LEN0041",
187 "LEN0042", /* Yoga */
188 "LEN0045",
Hans de Goede43e19882014-04-19 22:26:41 -0700189 "LEN0047",
Hans de Goede43e19882014-04-19 22:26:41 -0700190 "LEN0049",
191 "LEN2000",
Hans de Goede0f68f392014-05-19 22:54:09 -0700192 "LEN2001", /* Edge E431 */
Hans de Goedee76aed92014-07-14 17:12:21 -0700193 "LEN2002", /* Edge E531 */
Hans de Goede43e19882014-04-19 22:26:41 -0700194 "LEN2003",
195 "LEN2004", /* L440 */
196 "LEN2005",
Ramiro Morales98dc0702015-03-23 10:33:07 -0700197 "LEN2006", /* Edge E440/E540 */
Hans de Goede43e19882014-04-19 22:26:41 -0700198 "LEN2007",
199 "LEN2008",
200 "LEN2009",
201 "LEN200A",
202 "LEN200B",
203 NULL
204};
Andres Salomon55e3d922007-03-10 01:39:54 -0500205
206/*****************************************************************************
207 * Synaptics communications functions
208 ****************************************************************************/
209
210/*
JJ Ding1a49a0a2012-05-10 22:32:00 -0700211 * Synaptics touchpads report the y coordinate from bottom to top, which is
212 * opposite from what userspace expects.
213 * This function is used to invert y before reporting.
214 */
215static int synaptics_invert_y(int y)
216{
217 return YMAX_NOMINAL + YMIN_NOMINAL - y;
218}
219
220/*
Andres Salomon55e3d922007-03-10 01:39:54 -0500221 * Send a command to the synpatics touchpad by special commands
222 */
223static int synaptics_send_cmd(struct psmouse *psmouse, unsigned char c, unsigned char *param)
224{
225 if (psmouse_sliced_command(psmouse, c))
226 return -1;
227 if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETINFO))
228 return -1;
229 return 0;
230}
231
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232/*
233 * Read the model-id bytes from the touchpad
234 * see also SYN_MODEL_* macros
235 */
236static int synaptics_model_id(struct psmouse *psmouse)
237{
238 struct synaptics_data *priv = psmouse->private;
239 unsigned char mi[3];
240
241 if (synaptics_send_cmd(psmouse, SYN_QUE_MODEL, mi))
242 return -1;
243 priv->model_id = (mi[0]<<16) | (mi[1]<<8) | mi[2];
244 return 0;
245}
246
Benjamin Tissoires06aa3742015-03-08 22:34:03 -0700247static int synaptics_more_extended_queries(struct psmouse *psmouse)
248{
249 struct synaptics_data *priv = psmouse->private;
250 unsigned char buf[3];
251
252 if (synaptics_send_cmd(psmouse, SYN_QUE_MEXT_CAPAB_10, buf))
253 return -1;
254
255 priv->ext_cap_10 = (buf[0]<<16) | (buf[1]<<8) | buf[2];
256
257 return 0;
258}
259
Linus Torvalds1da177e2005-04-16 15:20:36 -0700260/*
Benjamin Tissoires06aa3742015-03-08 22:34:03 -0700261 * Read the board id and the "More Extended Queries" from the touchpad
Daniel Kurtzc6bd9d42012-07-07 18:08:51 -0700262 * The board id is encoded in the "QUERY MODES" response
263 */
Benjamin Tissoires06aa3742015-03-08 22:34:03 -0700264static int synaptics_query_modes(struct psmouse *psmouse)
Daniel Kurtzc6bd9d42012-07-07 18:08:51 -0700265{
266 struct synaptics_data *priv = psmouse->private;
267 unsigned char bid[3];
268
Benjamin Tissoiresb57a7122015-03-08 22:33:36 -0700269 /* firmwares prior 7.5 have no board_id encoded */
270 if (SYN_ID_FULL(priv->identity) < 0x705)
271 return 0;
272
Daniel Kurtzc6bd9d42012-07-07 18:08:51 -0700273 if (synaptics_send_cmd(psmouse, SYN_QUE_MODES, bid))
274 return -1;
275 priv->board_id = ((bid[0] & 0xfc) << 6) | bid[1];
Benjamin Tissoires06aa3742015-03-08 22:34:03 -0700276
277 if (SYN_MEXT_CAP_BIT(bid[0]))
278 return synaptics_more_extended_queries(psmouse);
279
Daniel Kurtzc6bd9d42012-07-07 18:08:51 -0700280 return 0;
281}
282
283/*
284 * Read the firmware id from the touchpad
285 */
286static int synaptics_firmware_id(struct psmouse *psmouse)
287{
288 struct synaptics_data *priv = psmouse->private;
289 unsigned char fwid[3];
290
291 if (synaptics_send_cmd(psmouse, SYN_QUE_FIRMWARE_ID, fwid))
292 return -1;
293 priv->firmware_id = (fwid[0] << 16) | (fwid[1] << 8) | fwid[2];
294 return 0;
295}
296
297/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 * Read the capability-bits from the touchpad
299 * see also the SYN_CAP_* macros
300 */
301static int synaptics_capability(struct psmouse *psmouse)
302{
303 struct synaptics_data *priv = psmouse->private;
304 unsigned char cap[3];
305
306 if (synaptics_send_cmd(psmouse, SYN_QUE_CAPABILITIES, cap))
307 return -1;
308 priv->capabilities = (cap[0] << 16) | (cap[1] << 8) | cap[2];
Takashi Iwai5f57d672010-04-19 10:37:21 -0700309 priv->ext_cap = priv->ext_cap_0c = 0;
310
Dmitry Torokhov3619b8f2010-07-21 00:01:19 -0700311 /*
312 * Older firmwares had submodel ID fixed to 0x47
313 */
314 if (SYN_ID_FULL(priv->identity) < 0x705 &&
315 SYN_CAP_SUBMODEL_ID(priv->capabilities) != 0x47) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316 return -1;
Dmitry Torokhov3619b8f2010-07-21 00:01:19 -0700317 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700318
319 /*
320 * Unless capExtended is set the rest of the flags should be ignored
321 */
322 if (!SYN_CAP_EXTENDED(priv->capabilities))
323 priv->capabilities = 0;
324
325 if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 1) {
326 if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB, cap)) {
Dmitry Torokhovb5d21702011-10-10 18:27:03 -0700327 psmouse_warn(psmouse,
328 "device claims to have extended capabilities, but I'm not able to read them.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329 } else {
330 priv->ext_cap = (cap[0] << 16) | (cap[1] << 8) | cap[2];
331
332 /*
333 * if nExtBtn is greater than 8 it should be considered
334 * invalid and treated as 0
335 */
336 if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) > 8)
337 priv->ext_cap &= 0xff0fff;
338 }
339 }
Takashi Iwai5f57d672010-04-19 10:37:21 -0700340
341 if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 4) {
342 if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB_0C, cap)) {
Dmitry Torokhovb5d21702011-10-10 18:27:03 -0700343 psmouse_warn(psmouse,
344 "device claims to have extended capability 0x0c, but I'm not able to read it.\n");
Takashi Iwai5f57d672010-04-19 10:37:21 -0700345 } else {
346 priv->ext_cap_0c = (cap[0] << 16) | (cap[1] << 8) | cap[2];
347 }
348 }
349
Linus Torvalds1da177e2005-04-16 15:20:36 -0700350 return 0;
351}
352
353/*
354 * Identify Touchpad
355 * See also the SYN_ID_* macros
356 */
357static int synaptics_identify(struct psmouse *psmouse)
358{
359 struct synaptics_data *priv = psmouse->private;
360 unsigned char id[3];
361
362 if (synaptics_send_cmd(psmouse, SYN_QUE_IDENTIFY, id))
363 return -1;
364 priv->identity = (id[0]<<16) | (id[1]<<8) | id[2];
365 if (SYN_ID_IS_SYNAPTICS(priv->identity))
366 return 0;
367 return -1;
368}
369
Tero Saarniec20a022009-06-10 23:27:24 -0700370/*
Dmitry Torokhov83ba9ea82010-05-10 23:06:52 -0700371 * Read touchpad resolution and maximum reported coordinates
Tero Saarniec20a022009-06-10 23:27:24 -0700372 * Resolution is left zero if touchpad does not support the query
373 */
Benjamin Tissoires421e08c2014-03-28 00:43:00 -0700374
Tero Saarniec20a022009-06-10 23:27:24 -0700375static int synaptics_resolution(struct psmouse *psmouse)
376{
377 struct synaptics_data *priv = psmouse->private;
Dmitry Torokhova66413f2011-07-09 12:32:56 -0700378 unsigned char resp[3];
Tero Saarniec20a022009-06-10 23:27:24 -0700379
380 if (SYN_ID_MAJOR(priv->identity) < 4)
Takashi Iwaibbddd192010-07-14 09:32:46 -0700381 return 0;
Tero Saarniec20a022009-06-10 23:27:24 -0700382
Dmitry Torokhova66413f2011-07-09 12:32:56 -0700383 if (synaptics_send_cmd(psmouse, SYN_QUE_RESOLUTION, resp) == 0) {
384 if (resp[0] != 0 && (resp[1] & 0x80) && resp[2] != 0) {
385 priv->x_res = resp[0]; /* x resolution in units/mm */
386 priv->y_res = resp[2]; /* y resolution in units/mm */
Dmitry Torokhov83ba9ea82010-05-10 23:06:52 -0700387 }
388 }
Tero Saarniec20a022009-06-10 23:27:24 -0700389
Dmitry Torokhov83ba9ea82010-05-10 23:06:52 -0700390 if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 5 &&
391 SYN_CAP_MAX_DIMENSIONS(priv->ext_cap_0c)) {
Dmitry Torokhova66413f2011-07-09 12:32:56 -0700392 if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_MAX_COORDS, resp)) {
Dmitry Torokhovb5d21702011-10-10 18:27:03 -0700393 psmouse_warn(psmouse,
394 "device claims to have max coordinates query, but I'm not able to read it.\n");
Dmitry Torokhov83ba9ea82010-05-10 23:06:52 -0700395 } else {
Dmitry Torokhova66413f2011-07-09 12:32:56 -0700396 priv->x_max = (resp[0] << 5) | ((resp[1] & 0x0f) << 1);
397 priv->y_max = (resp[2] << 5) | ((resp[1] & 0xf0) >> 3);
Daniel Martin9aff6592015-03-08 22:28:29 -0700398 psmouse_info(psmouse,
399 "queried max coordinates: x [..%d], y [..%d]\n",
400 priv->x_max, priv->y_max);
Dmitry Torokhova66413f2011-07-09 12:32:56 -0700401 }
402 }
403
Daniel Martinac097932015-03-08 22:28:40 -0700404 if (SYN_CAP_MIN_DIMENSIONS(priv->ext_cap_0c) &&
405 (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 7 ||
406 /*
407 * Firmware v8.1 does not report proper number of extended
408 * capabilities, but has been proven to report correct min
409 * coordinates.
410 */
411 SYN_ID_FULL(priv->identity) == 0x801)) {
Dmitry Torokhova66413f2011-07-09 12:32:56 -0700412 if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_MIN_COORDS, resp)) {
Dmitry Torokhovb5d21702011-10-10 18:27:03 -0700413 psmouse_warn(psmouse,
414 "device claims to have min coordinates query, but I'm not able to read it.\n");
Dmitry Torokhova66413f2011-07-09 12:32:56 -0700415 } else {
416 priv->x_min = (resp[0] << 5) | ((resp[1] & 0x0f) << 1);
417 priv->y_min = (resp[2] << 5) | ((resp[1] & 0xf0) >> 3);
Daniel Martin9aff6592015-03-08 22:28:29 -0700418 psmouse_info(psmouse,
419 "queried min coordinates: x [%d..], y [%d..]\n",
420 priv->x_min, priv->y_min);
Dmitry Torokhov83ba9ea82010-05-10 23:06:52 -0700421 }
Tero Saarniec20a022009-06-10 23:27:24 -0700422 }
423
424 return 0;
425}
426
Daniel Martin8b04bab2015-03-08 22:27:37 -0700427/*
428 * Apply quirk(s) if the hardware matches
429 */
430
431static void synaptics_apply_quirks(struct psmouse *psmouse)
432{
433 struct synaptics_data *priv = psmouse->private;
434 int i;
435
436 for (i = 0; min_max_pnpid_table[i].pnp_ids; i++) {
Daniel Martin5b3089d2015-03-08 22:29:15 -0700437 if (!psmouse_matches_pnp_id(psmouse,
438 min_max_pnpid_table[i].pnp_ids))
439 continue;
440
441 if (min_max_pnpid_table[i].board_id.min != ANY_BOARD_ID &&
442 priv->board_id < min_max_pnpid_table[i].board_id.min)
443 continue;
444
445 if (min_max_pnpid_table[i].board_id.max != ANY_BOARD_ID &&
446 priv->board_id > min_max_pnpid_table[i].board_id.max)
447 continue;
448
449 priv->x_min = min_max_pnpid_table[i].x_min;
450 priv->x_max = min_max_pnpid_table[i].x_max;
451 priv->y_min = min_max_pnpid_table[i].y_min;
452 priv->y_max = min_max_pnpid_table[i].y_max;
453 psmouse_info(psmouse,
454 "quirked min/max coordinates: x [%d..%d], y [%d..%d]\n",
455 priv->x_min, priv->x_max,
456 priv->y_min, priv->y_max);
457 break;
Daniel Martin8b04bab2015-03-08 22:27:37 -0700458 }
459}
460
Linus Torvalds1da177e2005-04-16 15:20:36 -0700461static int synaptics_query_hardware(struct psmouse *psmouse)
462{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700463 if (synaptics_identify(psmouse))
464 return -1;
465 if (synaptics_model_id(psmouse))
466 return -1;
Daniel Kurtzc6bd9d42012-07-07 18:08:51 -0700467 if (synaptics_firmware_id(psmouse))
468 return -1;
Benjamin Tissoires06aa3742015-03-08 22:34:03 -0700469 if (synaptics_query_modes(psmouse))
Daniel Kurtzc6bd9d42012-07-07 18:08:51 -0700470 return -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700471 if (synaptics_capability(psmouse))
472 return -1;
Tero Saarniec20a022009-06-10 23:27:24 -0700473 if (synaptics_resolution(psmouse))
474 return -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700475
Daniel Martin8b04bab2015-03-08 22:27:37 -0700476 synaptics_apply_quirks(psmouse);
477
Linus Torvalds1da177e2005-04-16 15:20:36 -0700478 return 0;
479}
480
Daniel Drake7968a5d2011-11-08 00:00:35 -0800481static int synaptics_set_advanced_gesture_mode(struct psmouse *psmouse)
482{
483 static unsigned char param = 0xc8;
484 struct synaptics_data *priv = psmouse->private;
485
Benjamin Herrenschmidt899c6122012-04-20 22:34:49 -0700486 if (!(SYN_CAP_ADV_GESTURE(priv->ext_cap_0c) ||
487 SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)))
Daniel Drake7968a5d2011-11-08 00:00:35 -0800488 return 0;
489
490 if (psmouse_sliced_command(psmouse, SYN_QUE_MODEL))
491 return -1;
492
493 if (ps2_command(&psmouse->ps2dev, &param, PSMOUSE_CMD_SETRATE))
494 return -1;
495
496 /* Advanced gesture mode also sends multi finger data */
497 priv->capabilities |= BIT(1);
498
499 return 0;
500}
501
502static int synaptics_set_mode(struct psmouse *psmouse)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700503{
504 struct synaptics_data *priv = psmouse->private;
505
Daniel Drake7968a5d2011-11-08 00:00:35 -0800506 priv->mode = 0;
507 if (priv->absolute_mode)
508 priv->mode |= SYN_BIT_ABSOLUTE_MODE;
509 if (priv->disable_gesture)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700510 priv->mode |= SYN_BIT_DISABLE_GESTURE;
Daniel Drake7968a5d2011-11-08 00:00:35 -0800511 if (psmouse->rate >= 80)
512 priv->mode |= SYN_BIT_HIGH_RATE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700513 if (SYN_CAP_EXTENDED(priv->capabilities))
514 priv->mode |= SYN_BIT_W_MODE;
515
516 if (synaptics_mode_cmd(psmouse, priv->mode))
517 return -1;
518
Daniel Drake7968a5d2011-11-08 00:00:35 -0800519 if (priv->absolute_mode &&
520 synaptics_set_advanced_gesture_mode(psmouse)) {
521 psmouse_err(psmouse, "Advanced gesture mode init failed.\n");
522 return -1;
523 }
524
Linus Torvalds1da177e2005-04-16 15:20:36 -0700525 return 0;
526}
527
528static void synaptics_set_rate(struct psmouse *psmouse, unsigned int rate)
529{
530 struct synaptics_data *priv = psmouse->private;
531
532 if (rate >= 80) {
533 priv->mode |= SYN_BIT_HIGH_RATE;
534 psmouse->rate = 80;
535 } else {
536 priv->mode &= ~SYN_BIT_HIGH_RATE;
537 psmouse->rate = 40;
538 }
539
540 synaptics_mode_cmd(psmouse, priv->mode);
541}
542
543/*****************************************************************************
544 * Synaptics pass-through PS/2 port support
545 ****************************************************************************/
546static int synaptics_pt_write(struct serio *serio, unsigned char c)
547{
548 struct psmouse *parent = serio_get_drvdata(serio->parent);
549 char rate_param = SYN_PS_CLIENT_CMD; /* indicates that we want pass-through port */
550
551 if (psmouse_sliced_command(parent, c))
552 return -1;
553 if (ps2_command(&parent->ps2dev, &rate_param, PSMOUSE_CMD_SETRATE))
554 return -1;
555 return 0;
556}
557
Dmitry Torokhova8b3c0f2010-10-04 21:46:10 -0700558static int synaptics_pt_start(struct serio *serio)
559{
560 struct psmouse *parent = serio_get_drvdata(serio->parent);
561 struct synaptics_data *priv = parent->private;
562
563 serio_pause_rx(parent->ps2dev.serio);
564 priv->pt_port = serio;
565 serio_continue_rx(parent->ps2dev.serio);
566
567 return 0;
568}
569
570static void synaptics_pt_stop(struct serio *serio)
571{
572 struct psmouse *parent = serio_get_drvdata(serio->parent);
573 struct synaptics_data *priv = parent->private;
574
575 serio_pause_rx(parent->ps2dev.serio);
576 priv->pt_port = NULL;
577 serio_continue_rx(parent->ps2dev.serio);
578}
579
580static int synaptics_is_pt_packet(unsigned char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581{
582 return (buf[0] & 0xFC) == 0x84 && (buf[3] & 0xCC) == 0xC4;
583}
584
Benjamin Tissoirescdd9dc12015-03-08 22:35:41 -0700585static void synaptics_pass_pt_packet(struct psmouse *psmouse,
586 struct serio *ptport,
587 unsigned char *packet)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700588{
Benjamin Tissoirescdd9dc12015-03-08 22:35:41 -0700589 struct synaptics_data *priv = psmouse->private;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700590 struct psmouse *child = serio_get_drvdata(ptport);
591
592 if (child && child->state == PSMOUSE_ACTIVATED) {
Benjamin Tissoirescdd9dc12015-03-08 22:35:41 -0700593 serio_interrupt(ptport, packet[1] | priv->pt_buttons, 0);
David Howells7d12e782006-10-05 14:55:46 +0100594 serio_interrupt(ptport, packet[4], 0);
595 serio_interrupt(ptport, packet[5], 0);
Sergey Vlasov33fdfa92005-07-24 00:53:32 -0500596 if (child->pktsize == 4)
David Howells7d12e782006-10-05 14:55:46 +0100597 serio_interrupt(ptport, packet[2], 0);
Benjamin Tissoirescdd9dc12015-03-08 22:35:41 -0700598 } else {
David Howells7d12e782006-10-05 14:55:46 +0100599 serio_interrupt(ptport, packet[1], 0);
Benjamin Tissoirescdd9dc12015-03-08 22:35:41 -0700600 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700601}
602
603static void synaptics_pt_activate(struct psmouse *psmouse)
604{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700605 struct synaptics_data *priv = psmouse->private;
Dmitry Torokhova8b3c0f2010-10-04 21:46:10 -0700606 struct psmouse *child = serio_get_drvdata(priv->pt_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700607
608 /* adjust the touchpad to child's choice of protocol */
609 if (child) {
Sergey Vlasov33fdfa92005-07-24 00:53:32 -0500610 if (child->pktsize == 4)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700611 priv->mode |= SYN_BIT_FOUR_BYTE_CLIENT;
612 else
613 priv->mode &= ~SYN_BIT_FOUR_BYTE_CLIENT;
614
615 if (synaptics_mode_cmd(psmouse, priv->mode))
Dmitry Torokhovb5d21702011-10-10 18:27:03 -0700616 psmouse_warn(psmouse,
617 "failed to switch guest protocol\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618 }
619}
620
621static void synaptics_pt_create(struct psmouse *psmouse)
622{
623 struct serio *serio;
624
Eric Sesterhennb39787a2006-03-14 00:09:16 -0500625 serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700626 if (!serio) {
Dmitry Torokhovb5d21702011-10-10 18:27:03 -0700627 psmouse_err(psmouse,
628 "not enough memory for pass-through port\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700629 return;
630 }
631
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632 serio->id.type = SERIO_PS_PSTHRU;
633 strlcpy(serio->name, "Synaptics pass-through", sizeof(serio->name));
634 strlcpy(serio->phys, "synaptics-pt/serio0", sizeof(serio->name));
635 serio->write = synaptics_pt_write;
Dmitry Torokhova8b3c0f2010-10-04 21:46:10 -0700636 serio->start = synaptics_pt_start;
637 serio->stop = synaptics_pt_stop;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700638 serio->parent = psmouse->ps2dev.serio;
639
640 psmouse->pt_activate = synaptics_pt_activate;
641
Dmitry Torokhovb5d21702011-10-10 18:27:03 -0700642 psmouse_info(psmouse, "serio: %s port at %s\n",
643 serio->name, psmouse->phys);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644 serio_register_port(serio);
645}
646
647/*****************************************************************************
648 * Functions to interpret the absolute mode packets
649 ****************************************************************************/
650
Daniel Kurtz7afdb842011-08-23 23:00:33 -0700651static void synaptics_parse_agm(const unsigned char buf[],
Daniel Kurtza6ca40c2011-08-23 23:02:31 -0700652 struct synaptics_data *priv,
653 struct synaptics_hw_state *hw)
Daniel Kurtz7afdb842011-08-23 23:00:33 -0700654{
655 struct synaptics_hw_state *agm = &priv->agm;
Daniel Kurtza6ca40c2011-08-23 23:02:31 -0700656 int agm_packet_type;
Daniel Kurtz7afdb842011-08-23 23:00:33 -0700657
Daniel Kurtza6ca40c2011-08-23 23:02:31 -0700658 agm_packet_type = (buf[5] & 0x30) >> 4;
659 switch (agm_packet_type) {
660 case 1:
661 /* Gesture packet: (x, y, z) half resolution */
662 agm->w = hw->w;
663 agm->x = (((buf[4] & 0x0f) << 8) | buf[1]) << 1;
664 agm->y = (((buf[4] & 0xf0) << 4) | buf[2]) << 1;
665 agm->z = ((buf[3] & 0x30) | (buf[5] & 0x0f)) << 1;
666 break;
667
668 case 2:
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800669 /* AGM-CONTACT packet: we are only interested in the count */
670 priv->agm_count = buf[1];
Daniel Kurtza6ca40c2011-08-23 23:02:31 -0700671 break;
672
673 default:
674 break;
675 }
Daniel Kurtz7afdb842011-08-23 23:00:33 -0700676}
677
Dmitry Torokhovdc5465d2015-03-08 22:30:43 -0700678static void synaptics_parse_ext_buttons(const unsigned char buf[],
679 struct synaptics_data *priv,
680 struct synaptics_hw_state *hw)
681{
682 unsigned int ext_bits =
683 (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) + 1) >> 1;
684 unsigned int ext_mask = GENMASK(ext_bits - 1, 0);
685
686 hw->ext_buttons = buf[4] & ext_mask;
687 hw->ext_buttons |= (buf[5] & ext_mask) << ext_bits;
688}
689
Dmitry Torokhovaa97240992014-09-02 09:49:18 -0700690static bool is_forcepad;
691
Henrik Rydbergfec6e522010-12-21 18:11:25 +0100692static int synaptics_parse_hw_state(const unsigned char buf[],
693 struct synaptics_data *priv,
694 struct synaptics_hw_state *hw)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695{
696 memset(hw, 0, sizeof(struct synaptics_hw_state));
697
698 if (SYN_MODEL_NEWABS(priv->model_id)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700699 hw->w = (((buf[0] & 0x30) >> 2) |
700 ((buf[0] & 0x04) >> 1) |
701 ((buf[3] & 0x04) >> 2));
702
Dmitry Torokhov5715fc72014-08-30 13:51:06 -0700703 if ((SYN_CAP_ADV_GESTURE(priv->ext_cap_0c) ||
704 SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) &&
705 hw->w == 2) {
706 synaptics_parse_agm(buf, priv, hw);
707 return 1;
708 }
709
710 hw->x = (((buf[3] & 0x10) << 8) |
711 ((buf[1] & 0x0f) << 8) |
712 buf[4]);
713 hw->y = (((buf[3] & 0x20) << 7) |
714 ((buf[1] & 0xf0) << 4) |
715 buf[5]);
716 hw->z = buf[2];
717
Linus Torvalds1da177e2005-04-16 15:20:36 -0700718 hw->left = (buf[0] & 0x01) ? 1 : 0;
719 hw->right = (buf[0] & 0x02) ? 1 : 0;
720
Dmitry Torokhovaa97240992014-09-02 09:49:18 -0700721 if (is_forcepad) {
Dmitry Torokhov5715fc72014-08-30 13:51:06 -0700722 /*
723 * ForcePads, like Clickpads, use middle button
724 * bits to report primary button clicks.
725 * Unfortunately they report primary button not
726 * only when user presses on the pad above certain
727 * threshold, but also when there are more than one
728 * finger on the touchpad, which interferes with
729 * out multi-finger gestures.
730 */
731 if (hw->z == 0) {
732 /* No contacts */
733 priv->press = priv->report_press = false;
734 } else if (hw->w >= 4 && ((buf[0] ^ buf[3]) & 0x01)) {
735 /*
736 * Single-finger touch with pressure above
737 * the threshold. If pressure stays long
738 * enough, we'll start reporting primary
739 * button. We rely on the device continuing
740 * sending data even if finger does not
741 * move.
742 */
743 if (!priv->press) {
744 priv->press_start = jiffies;
745 priv->press = true;
746 } else if (time_after(jiffies,
747 priv->press_start +
748 msecs_to_jiffies(50))) {
749 priv->report_press = true;
750 }
751 } else {
752 priv->press = false;
753 }
754
755 hw->left = priv->report_press;
756
757 } else if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
Takashi Iwai5f57d672010-04-19 10:37:21 -0700758 /*
759 * Clickpad's button is transmitted as middle button,
760 * however, since it is primary button, we will report
761 * it as BTN_LEFT.
762 */
763 hw->left = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
764
765 } else if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700766 hw->middle = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
767 if (hw->w == 2)
768 hw->scroll = (signed char)(buf[1]);
769 }
770
771 if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
772 hw->up = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
773 hw->down = ((buf[0] ^ buf[3]) & 0x02) ? 1 : 0;
774 }
775
Dmitry Torokhovdc5465d2015-03-08 22:30:43 -0700776 if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) > 0 &&
Linus Torvalds1da177e2005-04-16 15:20:36 -0700777 ((buf[0] ^ buf[3]) & 0x02)) {
Dmitry Torokhovdc5465d2015-03-08 22:30:43 -0700778 synaptics_parse_ext_buttons(buf, priv, hw);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700779 }
780 } else {
781 hw->x = (((buf[1] & 0x1f) << 8) | buf[2]);
782 hw->y = (((buf[4] & 0x1f) << 8) | buf[5]);
783
784 hw->z = (((buf[0] & 0x30) << 2) | (buf[3] & 0x3F));
785 hw->w = (((buf[1] & 0x80) >> 4) | ((buf[0] & 0x04) >> 1));
786
787 hw->left = (buf[0] & 0x01) ? 1 : 0;
788 hw->right = (buf[0] & 0x02) ? 1 : 0;
789 }
Henrik Rydbergfec6e522010-12-21 18:11:25 +0100790
Seth Forshee824efd32012-09-28 10:29:21 -0700791 /*
792 * Convert wrap-around values to negative. (X|Y)_MAX_POSITIVE
793 * is used by some firmware to indicate a finger at the edge of
794 * the touchpad whose precise position cannot be determined, so
795 * convert these values to the maximum axis value.
796 */
Seth Forsheec03945062012-07-24 23:54:11 -0700797 if (hw->x > X_MAX_POSITIVE)
798 hw->x -= 1 << ABS_POS_BITS;
Seth Forshee824efd32012-09-28 10:29:21 -0700799 else if (hw->x == X_MAX_POSITIVE)
800 hw->x = XMAX;
801
Seth Forsheec03945062012-07-24 23:54:11 -0700802 if (hw->y > Y_MAX_POSITIVE)
803 hw->y -= 1 << ABS_POS_BITS;
Seth Forshee824efd32012-09-28 10:29:21 -0700804 else if (hw->y == Y_MAX_POSITIVE)
805 hw->y = YMAX;
Seth Forsheec03945062012-07-24 23:54:11 -0700806
Henrik Rydbergfec6e522010-12-21 18:11:25 +0100807 return 0;
808}
809
Daniel Kurtzbea9f0f2011-07-06 22:42:52 -0700810static void synaptics_report_semi_mt_slot(struct input_dev *dev, int slot,
811 bool active, int x, int y)
Henrik Rydbergfec6e522010-12-21 18:11:25 +0100812{
813 input_mt_slot(dev, slot);
814 input_mt_report_slot_state(dev, MT_TOOL_FINGER, active);
815 if (active) {
816 input_report_abs(dev, ABS_MT_POSITION_X, x);
Daniel Kurtz6de58dd2011-08-23 23:00:24 -0700817 input_report_abs(dev, ABS_MT_POSITION_Y, synaptics_invert_y(y));
Henrik Rydbergfec6e522010-12-21 18:11:25 +0100818 }
819}
820
821static void synaptics_report_semi_mt_data(struct input_dev *dev,
822 const struct synaptics_hw_state *a,
823 const struct synaptics_hw_state *b,
824 int num_fingers)
825{
826 if (num_fingers >= 2) {
Daniel Kurtzbea9f0f2011-07-06 22:42:52 -0700827 synaptics_report_semi_mt_slot(dev, 0, true, min(a->x, b->x),
828 min(a->y, b->y));
829 synaptics_report_semi_mt_slot(dev, 1, true, max(a->x, b->x),
830 max(a->y, b->y));
Henrik Rydbergfec6e522010-12-21 18:11:25 +0100831 } else if (num_fingers == 1) {
Daniel Kurtzbea9f0f2011-07-06 22:42:52 -0700832 synaptics_report_semi_mt_slot(dev, 0, true, a->x, a->y);
833 synaptics_report_semi_mt_slot(dev, 1, false, 0, 0);
Henrik Rydbergfec6e522010-12-21 18:11:25 +0100834 } else {
Daniel Kurtzbea9f0f2011-07-06 22:42:52 -0700835 synaptics_report_semi_mt_slot(dev, 0, false, 0, 0);
836 synaptics_report_semi_mt_slot(dev, 1, false, 0, 0);
Henrik Rydbergfec6e522010-12-21 18:11:25 +0100837 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700838}
839
Benjamin Tissoiresebc80842015-03-08 22:32:43 -0700840static void synaptics_report_ext_buttons(struct psmouse *psmouse,
841 const struct synaptics_hw_state *hw)
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700842{
843 struct input_dev *dev = psmouse->dev;
844 struct synaptics_data *priv = psmouse->private;
Dmitry Torokhovdc5465d2015-03-08 22:30:43 -0700845 int ext_bits = (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) + 1) >> 1;
Benjamin Tissoirescdd9dc12015-03-08 22:35:41 -0700846 char buf[6] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700847 int i;
848
Benjamin Tissoiresebc80842015-03-08 22:32:43 -0700849 if (!SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap))
850 return;
851
852 /* Bug in FW 8.1, buttons are reported only when ExtBit is 1 */
853 if (SYN_ID_FULL(priv->identity) == 0x801 &&
854 !((psmouse->packet[0] ^ psmouse->packet[3]) & 0x02))
855 return;
856
Benjamin Tissoirescdd9dc12015-03-08 22:35:41 -0700857 if (!SYN_CAP_EXT_BUTTONS_STICK(priv->ext_cap_10)) {
858 for (i = 0; i < ext_bits; i++) {
859 input_report_key(dev, BTN_0 + 2 * i,
860 hw->ext_buttons & (1 << i));
861 input_report_key(dev, BTN_1 + 2 * i,
862 hw->ext_buttons & (1 << (i + ext_bits)));
863 }
864 return;
Benjamin Tissoiresebc80842015-03-08 22:32:43 -0700865 }
Benjamin Tissoirescdd9dc12015-03-08 22:35:41 -0700866
867 /*
868 * This generation of touchpads has the trackstick buttons
869 * physically wired to the touchpad. Re-route them through
870 * the pass-through interface.
871 */
872 if (!priv->pt_port)
873 return;
874
875 /* The trackstick expects at most 3 buttons */
876 priv->pt_buttons = SYN_CAP_EXT_BUTTON_STICK_L(hw->ext_buttons) |
877 SYN_CAP_EXT_BUTTON_STICK_R(hw->ext_buttons) << 1 |
878 SYN_CAP_EXT_BUTTON_STICK_M(hw->ext_buttons) << 2;
879
880 synaptics_pass_pt_packet(psmouse, priv->pt_port, buf);
Benjamin Tissoiresebc80842015-03-08 22:32:43 -0700881}
882
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700883static void synaptics_report_buttons(struct psmouse *psmouse,
884 const struct synaptics_hw_state *hw)
885{
886 struct input_dev *dev = psmouse->dev;
887 struct synaptics_data *priv = psmouse->private;
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700888
889 input_report_key(dev, BTN_LEFT, hw->left);
890 input_report_key(dev, BTN_RIGHT, hw->right);
891
892 if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
893 input_report_key(dev, BTN_MIDDLE, hw->middle);
894
895 if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
896 input_report_key(dev, BTN_FORWARD, hw->up);
897 input_report_key(dev, BTN_BACK, hw->down);
898 }
899
Benjamin Tissoiresebc80842015-03-08 22:32:43 -0700900 synaptics_report_ext_buttons(psmouse, hw);
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700901}
902
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700903static void synaptics_report_mt_data(struct psmouse *psmouse,
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800904 const struct synaptics_hw_state *sgm,
905 int num_fingers)
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700906{
907 struct input_dev *dev = psmouse->dev;
908 struct synaptics_data *priv = psmouse->private;
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800909 const struct synaptics_hw_state *hw[2] = { sgm, &priv->agm };
910 struct input_mt_pos pos[2];
911 int slot[2], nsemi, i;
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700912
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800913 nsemi = clamp_val(num_fingers, 0, 2);
Daniel Kurtz4dc772d2011-08-23 23:02:40 -0700914
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800915 for (i = 0; i < nsemi; i++) {
916 pos[i].x = hw[i]->x;
917 pos[i].y = synaptics_invert_y(hw[i]->y);
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700918 }
919
Dmitry Torokhov09d042a2015-03-16 09:17:16 -0700920 input_mt_assign_slots(dev, slot, pos, nsemi, 0);
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800921
922 for (i = 0; i < nsemi; i++) {
923 input_mt_slot(dev, slot[i]);
924 input_mt_report_slot_state(dev, MT_TOOL_FINGER, true);
925 input_report_abs(dev, ABS_MT_POSITION_X, pos[i].x);
926 input_report_abs(dev, ABS_MT_POSITION_Y, pos[i].y);
927 input_report_abs(dev, ABS_MT_PRESSURE, hw[i]->z);
928 }
929
930 input_mt_drop_unused(dev);
931
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700932 /* Don't use active slot count to generate BTN_TOOL events. */
933 input_mt_report_pointer_emulation(dev, false);
934
935 /* Send the number of fingers reported by touchpad itself. */
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800936 input_mt_report_finger_count(dev, num_fingers);
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700937
938 synaptics_report_buttons(psmouse, sgm);
939
940 input_sync(dev);
941}
942
943static void synaptics_image_sensor_process(struct psmouse *psmouse,
944 struct synaptics_hw_state *sgm)
945{
Daniel Kurtz4dc772d2011-08-23 23:02:40 -0700946 struct synaptics_data *priv = psmouse->private;
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800947 int num_fingers;
Daniel Kurtz4dc772d2011-08-23 23:02:40 -0700948
949 /*
950 * Update mt_state using the new finger count and current mt_state.
951 */
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700952 if (sgm->z == 0)
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800953 num_fingers = 0;
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700954 else if (sgm->w >= 4)
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800955 num_fingers = 1;
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700956 else if (sgm->w == 0)
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800957 num_fingers = 2;
958 else if (sgm->w == 1)
959 num_fingers = priv->agm_count ? priv->agm_count : 3;
Daniel Kurtz6b4b49f2011-08-23 23:02:56 -0700960 else
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800961 num_fingers = 4;
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700962
963 /* Send resulting input events to user space */
Benjamin Tissoirese9e85202014-12-29 14:15:24 -0800964 synaptics_report_mt_data(psmouse, sgm, num_fingers);
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700965}
966
Linus Torvalds1da177e2005-04-16 15:20:36 -0700967/*
968 * called for each full received packet from the touchpad
969 */
970static void synaptics_process_packet(struct psmouse *psmouse)
971{
Dmitry Torokhov2e5b6362005-09-15 02:01:44 -0500972 struct input_dev *dev = psmouse->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700973 struct synaptics_data *priv = psmouse->private;
974 struct synaptics_hw_state hw;
975 int num_fingers;
976 int finger_width;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700977
Henrik Rydbergfec6e522010-12-21 18:11:25 +0100978 if (synaptics_parse_hw_state(psmouse->packet, priv, &hw))
979 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700980
Daniel Kurtz3cdfee92011-08-23 23:02:25 -0700981 if (SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) {
982 synaptics_image_sensor_process(psmouse, &hw);
983 return;
984 }
985
Linus Torvalds1da177e2005-04-16 15:20:36 -0700986 if (hw.scroll) {
987 priv->scroll += hw.scroll;
988
989 while (priv->scroll >= 4) {
990 input_report_key(dev, BTN_BACK, !hw.down);
991 input_sync(dev);
992 input_report_key(dev, BTN_BACK, hw.down);
993 input_sync(dev);
994 priv->scroll -= 4;
995 }
996 while (priv->scroll <= -4) {
997 input_report_key(dev, BTN_FORWARD, !hw.up);
998 input_sync(dev);
999 input_report_key(dev, BTN_FORWARD, hw.up);
1000 input_sync(dev);
1001 priv->scroll += 4;
1002 }
1003 return;
1004 }
1005
Henrik Rydberg4f56ce92010-12-18 15:42:30 +01001006 if (hw.z > 0 && hw.x > 1) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001007 num_fingers = 1;
1008 finger_width = 5;
1009 if (SYN_CAP_EXTENDED(priv->capabilities)) {
1010 switch (hw.w) {
1011 case 0 ... 1:
1012 if (SYN_CAP_MULTIFINGER(priv->capabilities))
1013 num_fingers = hw.w + 2;
1014 break;
1015 case 2:
1016 if (SYN_MODEL_PEN(priv->model_id))
1017 ; /* Nothing, treat a pen as a single finger */
1018 break;
1019 case 4 ... 15:
1020 if (SYN_CAP_PALMDETECT(priv->capabilities))
1021 finger_width = hw.w;
1022 break;
1023 }
1024 }
1025 } else {
1026 num_fingers = 0;
1027 finger_width = 0;
1028 }
1029
Henrik Rydberge08d9af2014-07-14 10:26:56 -07001030 if (cr48_profile_sensor) {
Benjamin Tissoiresaa104b12014-12-29 14:17:44 -08001031 synaptics_report_mt_data(psmouse, &hw, num_fingers);
Henrik Rydberge08d9af2014-07-14 10:26:56 -07001032 return;
1033 }
1034
Henrik Rydbergfec6e522010-12-21 18:11:25 +01001035 if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c))
Daniel Kurtz7afdb842011-08-23 23:00:33 -07001036 synaptics_report_semi_mt_data(dev, &hw, &priv->agm,
1037 num_fingers);
Henrik Rydbergfec6e522010-12-21 18:11:25 +01001038
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039 /* Post events
1040 * BTN_TOUCH has to be first as mousedev relies on it when doing
1041 * absolute -> relative conversion
1042 */
1043 if (hw.z > 30) input_report_key(dev, BTN_TOUCH, 1);
1044 if (hw.z < 25) input_report_key(dev, BTN_TOUCH, 0);
1045
Henrik Rydberg4f56ce92010-12-18 15:42:30 +01001046 if (num_fingers > 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001047 input_report_abs(dev, ABS_X, hw.x);
Daniel Kurtz6de58dd2011-08-23 23:00:24 -07001048 input_report_abs(dev, ABS_Y, synaptics_invert_y(hw.y));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001049 }
1050 input_report_abs(dev, ABS_PRESSURE, hw.z);
1051
Chris Bagwell2a8e7712010-07-19 09:06:15 -07001052 if (SYN_CAP_PALMDETECT(priv->capabilities))
1053 input_report_abs(dev, ABS_TOOL_WIDTH, finger_width);
1054
Linus Torvalds1da177e2005-04-16 15:20:36 -07001055 input_report_key(dev, BTN_TOOL_FINGER, num_fingers == 1);
Peter Hutterere42b6642008-11-20 15:24:42 -05001056 if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
1057 input_report_key(dev, BTN_TOOL_DOUBLETAP, num_fingers == 2);
1058 input_report_key(dev, BTN_TOOL_TRIPLETAP, num_fingers == 3);
1059 }
1060
Daniel Kurtz3cdfee92011-08-23 23:02:25 -07001061 synaptics_report_buttons(psmouse, &hw);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001062
1063 input_sync(dev);
1064}
1065
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001066static int synaptics_validate_byte(struct psmouse *psmouse,
1067 int idx, unsigned char pkt_type)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001068{
Helge Dellere38de672006-09-10 21:54:39 -04001069 static const unsigned char newabs_mask[] = { 0xC8, 0x00, 0x00, 0xC8, 0x00 };
1070 static const unsigned char newabs_rel_mask[] = { 0xC0, 0x00, 0x00, 0xC0, 0x00 };
1071 static const unsigned char newabs_rslt[] = { 0x80, 0x00, 0x00, 0xC0, 0x00 };
1072 static const unsigned char oldabs_mask[] = { 0xC0, 0x60, 0x00, 0xC0, 0x60 };
1073 static const unsigned char oldabs_rslt[] = { 0xC0, 0x00, 0x00, 0x80, 0x00 };
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001074 const char *packet = psmouse->packet;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001075
1076 if (idx < 0 || idx > 4)
1077 return 0;
1078
1079 switch (pkt_type) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001080
Dmitry Torokhova62f0d22010-05-19 10:39:17 -07001081 case SYN_NEWABS:
1082 case SYN_NEWABS_RELAXED:
1083 return (packet[idx] & newabs_rel_mask[idx]) == newabs_rslt[idx];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001084
Dmitry Torokhova62f0d22010-05-19 10:39:17 -07001085 case SYN_NEWABS_STRICT:
1086 return (packet[idx] & newabs_mask[idx]) == newabs_rslt[idx];
Linus Torvalds1da177e2005-04-16 15:20:36 -07001087
Dmitry Torokhova62f0d22010-05-19 10:39:17 -07001088 case SYN_OLDABS:
1089 return (packet[idx] & oldabs_mask[idx]) == oldabs_rslt[idx];
1090
1091 default:
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001092 psmouse_err(psmouse, "unknown packet type %d\n", pkt_type);
Dmitry Torokhova62f0d22010-05-19 10:39:17 -07001093 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001094 }
1095}
1096
1097static unsigned char synaptics_detect_pkt_type(struct psmouse *psmouse)
1098{
1099 int i;
1100
1101 for (i = 0; i < 5; i++)
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001102 if (!synaptics_validate_byte(psmouse, i, SYN_NEWABS_STRICT)) {
1103 psmouse_info(psmouse, "using relaxed packet validation\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001104 return SYN_NEWABS_RELAXED;
1105 }
1106
1107 return SYN_NEWABS_STRICT;
1108}
1109
David Howells7d12e782006-10-05 14:55:46 +01001110static psmouse_ret_t synaptics_process_byte(struct psmouse *psmouse)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001111{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001112 struct synaptics_data *priv = psmouse->private;
1113
Linus Torvalds1da177e2005-04-16 15:20:36 -07001114 if (psmouse->pktcnt >= 6) { /* Full packet received */
1115 if (unlikely(priv->pkt_type == SYN_NEWABS))
1116 priv->pkt_type = synaptics_detect_pkt_type(psmouse);
1117
Dmitry Torokhova8b3c0f2010-10-04 21:46:10 -07001118 if (SYN_CAP_PASS_THROUGH(priv->capabilities) &&
1119 synaptics_is_pt_packet(psmouse->packet)) {
1120 if (priv->pt_port)
Benjamin Tissoirescdd9dc12015-03-08 22:35:41 -07001121 synaptics_pass_pt_packet(psmouse, priv->pt_port,
1122 psmouse->packet);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001123 } else
1124 synaptics_process_packet(psmouse);
1125
1126 return PSMOUSE_FULL_PACKET;
1127 }
1128
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001129 return synaptics_validate_byte(psmouse, psmouse->pktcnt - 1, priv->pkt_type) ?
Linus Torvalds1da177e2005-04-16 15:20:36 -07001130 PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
1131}
1132
1133/*****************************************************************************
1134 * Driver initialization/cleanup functions
1135 ****************************************************************************/
Daniel Kurtz85615472011-08-23 23:00:41 -07001136static void set_abs_position_params(struct input_dev *dev,
1137 struct synaptics_data *priv, int x_code,
1138 int y_code)
1139{
1140 int x_min = priv->x_min ?: XMIN_NOMINAL;
1141 int x_max = priv->x_max ?: XMAX_NOMINAL;
1142 int y_min = priv->y_min ?: YMIN_NOMINAL;
1143 int y_max = priv->y_max ?: YMAX_NOMINAL;
1144 int fuzz = SYN_CAP_REDUCED_FILTERING(priv->ext_cap_0c) ?
1145 SYN_REDUCED_FILTER_FUZZ : 0;
1146
1147 input_set_abs_params(dev, x_code, x_min, x_max, fuzz, 0);
1148 input_set_abs_params(dev, y_code, y_min, y_max, fuzz, 0);
1149 input_abs_set_res(dev, x_code, priv->x_res);
1150 input_abs_set_res(dev, y_code, priv->y_res);
1151}
1152
Hans de Goede43e19882014-04-19 22:26:41 -07001153static void set_input_params(struct psmouse *psmouse,
1154 struct synaptics_data *priv)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001155{
Hans de Goede43e19882014-04-19 22:26:41 -07001156 struct input_dev *dev = psmouse->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001157 int i;
1158
Daniel Drake7968a5d2011-11-08 00:00:35 -08001159 /* Things that apply to both modes */
Henrik Rydbergc14890a2010-12-16 09:52:23 +01001160 __set_bit(INPUT_PROP_POINTER, dev->propbit);
Daniel Drake7968a5d2011-11-08 00:00:35 -08001161 __set_bit(EV_KEY, dev->evbit);
1162 __set_bit(BTN_LEFT, dev->keybit);
1163 __set_bit(BTN_RIGHT, dev->keybit);
Henrik Rydbergc14890a2010-12-16 09:52:23 +01001164
Daniel Drake7968a5d2011-11-08 00:00:35 -08001165 if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
1166 __set_bit(BTN_MIDDLE, dev->keybit);
1167
1168 if (!priv->absolute_mode) {
1169 /* Relative mode */
1170 __set_bit(EV_REL, dev->evbit);
1171 __set_bit(REL_X, dev->relbit);
1172 __set_bit(REL_Y, dev->relbit);
1173 return;
1174 }
1175
1176 /* Absolute mode */
Dmitry Torokhovb7802c52009-09-09 19:13:20 -07001177 __set_bit(EV_ABS, dev->evbit);
Daniel Kurtz85615472011-08-23 23:00:41 -07001178 set_abs_position_params(dev, priv, ABS_X, ABS_Y);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001179 input_set_abs_params(dev, ABS_PRESSURE, 0, 255, 0, 0);
Chris Bagwell2a8e7712010-07-19 09:06:15 -07001180
Henrik Rydberge08d9af2014-07-14 10:26:56 -07001181 if (cr48_profile_sensor)
1182 input_set_abs_params(dev, ABS_MT_PRESSURE, 0, 255, 0, 0);
1183
Daniel Kurtz3cdfee92011-08-23 23:02:25 -07001184 if (SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) {
Daniel Kurtz3cdfee92011-08-23 23:02:25 -07001185 set_abs_position_params(dev, priv, ABS_MT_POSITION_X,
1186 ABS_MT_POSITION_Y);
1187 /* Image sensors can report per-contact pressure */
1188 input_set_abs_params(dev, ABS_MT_PRESSURE, 0, 255, 0, 0);
Benjamin Tissoirese9e85202014-12-29 14:15:24 -08001189 input_mt_init_slots(dev, 2, INPUT_MT_POINTER | INPUT_MT_TRACK);
Daniel Kurtz6b4b49f2011-08-23 23:02:56 -07001190
1191 /* Image sensors can signal 4 and 5 finger clicks */
1192 __set_bit(BTN_TOOL_QUADTAP, dev->keybit);
1193 __set_bit(BTN_TOOL_QUINTTAP, dev->keybit);
Daniel Kurtz3cdfee92011-08-23 23:02:25 -07001194 } else if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c)) {
Daniel Kurtz85615472011-08-23 23:00:41 -07001195 set_abs_position_params(dev, priv, ABS_MT_POSITION_X,
1196 ABS_MT_POSITION_Y);
Henrik Rydberge08d9af2014-07-14 10:26:56 -07001197 /*
1198 * Profile sensor in CR-48 tracks contacts reasonably well,
1199 * other non-image sensors with AGM use semi-mt.
1200 */
Dmitry Torokhovae841972014-07-25 17:12:12 -07001201 input_mt_init_slots(dev, 2,
Henrik Rydberge08d9af2014-07-14 10:26:56 -07001202 INPUT_MT_POINTER |
1203 (cr48_profile_sensor ?
1204 INPUT_MT_TRACK : INPUT_MT_SEMI_MT));
Henrik Rydbergfec6e522010-12-21 18:11:25 +01001205 }
1206
Chris Bagwell2a8e7712010-07-19 09:06:15 -07001207 if (SYN_CAP_PALMDETECT(priv->capabilities))
Chris Bagwell58fb0212010-07-19 09:06:15 -07001208 input_set_abs_params(dev, ABS_TOOL_WIDTH, 0, 15, 0, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001209
Dmitry Torokhovb7802c52009-09-09 19:13:20 -07001210 __set_bit(BTN_TOUCH, dev->keybit);
1211 __set_bit(BTN_TOOL_FINGER, dev->keybit);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001212
Peter Hutterere42b6642008-11-20 15:24:42 -05001213 if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
Dmitry Torokhovb7802c52009-09-09 19:13:20 -07001214 __set_bit(BTN_TOOL_DOUBLETAP, dev->keybit);
1215 __set_bit(BTN_TOOL_TRIPLETAP, dev->keybit);
Peter Hutterere42b6642008-11-20 15:24:42 -05001216 }
1217
Linus Torvalds1da177e2005-04-16 15:20:36 -07001218 if (SYN_CAP_FOUR_BUTTON(priv->capabilities) ||
1219 SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
Dmitry Torokhovb7802c52009-09-09 19:13:20 -07001220 __set_bit(BTN_FORWARD, dev->keybit);
1221 __set_bit(BTN_BACK, dev->keybit);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001222 }
1223
Benjamin Tissoirescdd9dc12015-03-08 22:35:41 -07001224 if (!SYN_CAP_EXT_BUTTONS_STICK(priv->ext_cap_10))
1225 for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
1226 __set_bit(BTN_0 + i, dev->keybit);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001227
Dmitry Torokhovb7802c52009-09-09 19:13:20 -07001228 __clear_bit(EV_REL, dev->evbit);
1229 __clear_bit(REL_X, dev->relbit);
1230 __clear_bit(REL_Y, dev->relbit);
Tero Saarniec20a022009-06-10 23:27:24 -07001231
Takashi Iwai5f57d672010-04-19 10:37:21 -07001232 if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
Henrik Rydbergc14890a2010-12-16 09:52:23 +01001233 __set_bit(INPUT_PROP_BUTTONPAD, dev->propbit);
Benjamin Tissoires3adde1f2015-03-08 22:34:50 -07001234 if (psmouse_matches_pnp_id(psmouse, topbuttonpad_pnp_ids) &&
1235 !SYN_CAP_EXT_BUTTONS_STICK(priv->ext_cap_10))
Hans de Goedee2f61102014-05-19 22:53:23 -07001236 __set_bit(INPUT_PROP_TOPBUTTONPAD, dev->propbit);
Takashi Iwai5f57d672010-04-19 10:37:21 -07001237 /* Clickpads report only left button */
1238 __clear_bit(BTN_RIGHT, dev->keybit);
1239 __clear_bit(BTN_MIDDLE, dev->keybit);
1240 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001241}
1242
Daniel Drake7968a5d2011-11-08 00:00:35 -08001243static ssize_t synaptics_show_disable_gesture(struct psmouse *psmouse,
1244 void *data, char *buf)
1245{
1246 struct synaptics_data *priv = psmouse->private;
1247
1248 return sprintf(buf, "%c\n", priv->disable_gesture ? '1' : '0');
1249}
1250
1251static ssize_t synaptics_set_disable_gesture(struct psmouse *psmouse,
1252 void *data, const char *buf,
1253 size_t len)
1254{
1255 struct synaptics_data *priv = psmouse->private;
1256 unsigned int value;
1257 int err;
1258
1259 err = kstrtouint(buf, 10, &value);
1260 if (err)
1261 return err;
1262
1263 if (value > 1)
1264 return -EINVAL;
1265
1266 if (value == priv->disable_gesture)
1267 return len;
1268
1269 priv->disable_gesture = value;
1270 if (value)
1271 priv->mode |= SYN_BIT_DISABLE_GESTURE;
1272 else
1273 priv->mode &= ~SYN_BIT_DISABLE_GESTURE;
1274
1275 if (synaptics_mode_cmd(psmouse, priv->mode))
1276 return -EIO;
1277
1278 return len;
1279}
1280
1281PSMOUSE_DEFINE_ATTR(disable_gesture, S_IWUSR | S_IRUGO, NULL,
1282 synaptics_show_disable_gesture,
1283 synaptics_set_disable_gesture);
1284
Linus Torvalds1da177e2005-04-16 15:20:36 -07001285static void synaptics_disconnect(struct psmouse *psmouse)
1286{
Daniel Drake7968a5d2011-11-08 00:00:35 -08001287 struct synaptics_data *priv = psmouse->private;
1288
1289 if (!priv->absolute_mode && SYN_ID_DISGEST_SUPPORTED(priv->identity))
1290 device_remove_file(&psmouse->ps2dev.serio->dev,
1291 &psmouse_attr_disable_gesture.dattr);
1292
Linus Torvalds1da177e2005-04-16 15:20:36 -07001293 synaptics_reset(psmouse);
Daniel Drake7968a5d2011-11-08 00:00:35 -08001294 kfree(priv);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001295 psmouse->private = NULL;
1296}
1297
1298static int synaptics_reconnect(struct psmouse *psmouse)
1299{
1300 struct synaptics_data *priv = psmouse->private;
1301 struct synaptics_data old_priv = *priv;
Eric Miaoeeb06552013-06-04 09:30:55 -07001302 unsigned char param[2];
Alexandre Peixoto Ferreirac63fe0a2011-01-28 22:05:14 -08001303 int retry = 0;
1304 int error;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001305
Alexandre Peixoto Ferreirac63fe0a2011-01-28 22:05:14 -08001306 do {
1307 psmouse_reset(psmouse);
Dmitry Torokhov85214782011-12-12 00:05:53 -08001308 if (retry) {
1309 /*
1310 * On some boxes, right after resuming, the touchpad
1311 * needs some time to finish initializing (I assume
1312 * it needs time to calibrate) and start responding
1313 * to Synaptics-specific queries, so let's wait a
1314 * bit.
1315 */
1316 ssleep(1);
1317 }
Eric Miaoeeb06552013-06-04 09:30:55 -07001318 ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETID);
Alexandre Peixoto Ferreirac63fe0a2011-01-28 22:05:14 -08001319 error = synaptics_detect(psmouse, 0);
1320 } while (error && ++retry < 3);
Andy Whitcroft4d368452009-02-28 12:51:01 -08001321
Alexandre Peixoto Ferreirac63fe0a2011-01-28 22:05:14 -08001322 if (error)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001323 return -1;
1324
Alexandre Peixoto Ferreirac63fe0a2011-01-28 22:05:14 -08001325 if (retry > 1)
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001326 psmouse_dbg(psmouse, "reconnected after %d tries\n", retry);
Alexandre Peixoto Ferreirac63fe0a2011-01-28 22:05:14 -08001327
Linus Torvalds1da177e2005-04-16 15:20:36 -07001328 if (synaptics_query_hardware(psmouse)) {
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001329 psmouse_err(psmouse, "Unable to query device.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001330 return -1;
1331 }
1332
Daniel Drake7968a5d2011-11-08 00:00:35 -08001333 if (synaptics_set_mode(psmouse)) {
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001334 psmouse_err(psmouse, "Unable to initialize device.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001335 return -1;
1336 }
1337
Alexandre Peixoto Ferreirabaddf582011-01-28 22:05:14 -08001338 if (old_priv.identity != priv->identity ||
1339 old_priv.model_id != priv->model_id ||
1340 old_priv.capabilities != priv->capabilities ||
1341 old_priv.ext_cap != priv->ext_cap) {
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001342 psmouse_err(psmouse,
1343 "hardware appears to be different: id(%ld-%ld), model(%ld-%ld), caps(%lx-%lx), ext(%lx-%lx).\n",
1344 old_priv.identity, priv->identity,
1345 old_priv.model_id, priv->model_id,
1346 old_priv.capabilities, priv->capabilities,
1347 old_priv.ext_cap, priv->ext_cap);
Alexandre Peixoto Ferreirabaddf582011-01-28 22:05:14 -08001348 return -1;
1349 }
1350
Linus Torvalds1da177e2005-04-16 15:20:36 -07001351 return 0;
1352}
1353
Dmitry Torokhov7705d542009-12-03 23:21:14 -08001354static bool impaired_toshiba_kbc;
1355
Sachin Kamatc9631562013-08-12 11:05:58 -07001356static const struct dmi_system_id toshiba_dmi_table[] __initconst = {
Dmitry Torokhov7705d542009-12-03 23:21:14 -08001357#if defined(CONFIG_DMI) && defined(CONFIG_X86)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001358 {
Dmitry Torokhov9961e252009-12-04 10:24:20 -08001359 /* Toshiba Satellite */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001360 .matches = {
1361 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
Richard Thrippleton53a26702006-04-02 00:10:18 -05001362 DMI_MATCH(DMI_PRODUCT_NAME, "Satellite"),
Linus Torvalds1da177e2005-04-16 15:20:36 -07001363 },
1364 },
Simon Horman9ba5eaa2005-07-11 01:07:20 -05001365 {
Dmitry Torokhov9961e252009-12-04 10:24:20 -08001366 /* Toshiba Dynabook */
Simon Horman9ba5eaa2005-07-11 01:07:20 -05001367 .matches = {
1368 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
Richard Thrippleton53a26702006-04-02 00:10:18 -05001369 DMI_MATCH(DMI_PRODUCT_NAME, "dynabook"),
1370 },
1371 },
1372 {
Dmitry Torokhov9961e252009-12-04 10:24:20 -08001373 /* Toshiba Portege M300 */
Richard Thrippleton53a26702006-04-02 00:10:18 -05001374 .matches = {
1375 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1376 DMI_MATCH(DMI_PRODUCT_NAME, "PORTEGE M300"),
Simon Horman9ba5eaa2005-07-11 01:07:20 -05001377 },
Dmitry Torokhov5f5eeff2009-10-12 21:35:00 -07001378
1379 },
1380 {
Dmitry Torokhov9961e252009-12-04 10:24:20 -08001381 /* Toshiba Portege M300 */
Dmitry Torokhov5f5eeff2009-10-12 21:35:00 -07001382 .matches = {
1383 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1384 DMI_MATCH(DMI_PRODUCT_NAME, "Portable PC"),
1385 DMI_MATCH(DMI_PRODUCT_VERSION, "Version 1.0"),
1386 },
1387
Simon Horman9ba5eaa2005-07-11 01:07:20 -05001388 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07001389#endif
Jan Beulich70874862011-03-31 00:01:58 -07001390 { }
Dmitry Torokhov7705d542009-12-03 23:21:14 -08001391};
1392
Andres Salomonef8313b2010-12-23 01:19:38 -08001393static bool broken_olpc_ec;
1394
Sachin Kamatc9631562013-08-12 11:05:58 -07001395static const struct dmi_system_id olpc_dmi_table[] __initconst = {
Andres Salomonef8313b2010-12-23 01:19:38 -08001396#if defined(CONFIG_DMI) && defined(CONFIG_OLPC)
1397 {
1398 /* OLPC XO-1 or XO-1.5 */
1399 .matches = {
1400 DMI_MATCH(DMI_SYS_VENDOR, "OLPC"),
1401 DMI_MATCH(DMI_PRODUCT_NAME, "XO"),
1402 },
1403 },
Andres Salomonef8313b2010-12-23 01:19:38 -08001404#endif
Jan Beulich70874862011-03-31 00:01:58 -07001405 { }
Andres Salomonef8313b2010-12-23 01:19:38 -08001406};
1407
Henrik Rydberge08d9af2014-07-14 10:26:56 -07001408static const struct dmi_system_id __initconst cr48_dmi_table[] = {
1409#if defined(CONFIG_DMI) && defined(CONFIG_X86)
1410 {
1411 /* Cr-48 Chromebook (Codename Mario) */
1412 .matches = {
1413 DMI_MATCH(DMI_SYS_VENDOR, "IEC"),
1414 DMI_MATCH(DMI_PRODUCT_NAME, "Mario"),
1415 },
1416 },
1417#endif
1418 { }
1419};
1420
Dmitry Torokhovaa97240992014-09-02 09:49:18 -07001421static const struct dmi_system_id forcepad_dmi_table[] __initconst = {
1422#if defined(CONFIG_DMI) && defined(CONFIG_X86)
1423 {
1424 .matches = {
1425 DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
1426 DMI_MATCH(DMI_PRODUCT_NAME, "HP EliteBook Folio 1040 G1"),
1427 },
1428 },
1429#endif
1430 { }
1431};
1432
Dmitry Torokhov7705d542009-12-03 23:21:14 -08001433void __init synaptics_module_init(void)
1434{
1435 impaired_toshiba_kbc = dmi_check_system(toshiba_dmi_table);
Andres Salomonef8313b2010-12-23 01:19:38 -08001436 broken_olpc_ec = dmi_check_system(olpc_dmi_table);
Henrik Rydberge08d9af2014-07-14 10:26:56 -07001437 cr48_profile_sensor = dmi_check_system(cr48_dmi_table);
Dmitry Torokhovaa97240992014-09-02 09:49:18 -07001438
1439 /*
1440 * Unfortunately ForcePad capability is not exported over PS/2,
1441 * so we have to resort to checking DMI.
1442 */
1443 is_forcepad = dmi_check_system(forcepad_dmi_table);
Dmitry Torokhov7705d542009-12-03 23:21:14 -08001444}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001445
Daniel Drake7968a5d2011-11-08 00:00:35 -08001446static int __synaptics_init(struct psmouse *psmouse, bool absolute_mode)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001447{
1448 struct synaptics_data *priv;
Daniel Drake7968a5d2011-11-08 00:00:35 -08001449 int err = -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001450
Andres Salomonef8313b2010-12-23 01:19:38 -08001451 /*
Daniel Drake83551c02011-11-11 16:05:04 -08001452 * The OLPC XO has issues with Synaptics' absolute mode; the constant
1453 * packet spew overloads the EC such that key presses on the keyboard
1454 * are missed. Given that, don't even attempt to use Absolute mode.
1455 * Relative mode seems to work just fine.
Andres Salomonef8313b2010-12-23 01:19:38 -08001456 */
Daniel Drake83551c02011-11-11 16:05:04 -08001457 if (absolute_mode && broken_olpc_ec) {
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001458 psmouse_info(psmouse,
1459 "OLPC XO detected, not enabling Synaptics protocol.\n");
Andres Salomonef8313b2010-12-23 01:19:38 -08001460 return -ENODEV;
1461 }
1462
Eric Sesterhennb39787a2006-03-14 00:09:16 -05001463 psmouse->private = priv = kzalloc(sizeof(struct synaptics_data), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001464 if (!priv)
Davidlohr Bueso6792cbb2010-09-29 18:53:35 -07001465 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001466
Andy Whitcroft4d368452009-02-28 12:51:01 -08001467 psmouse_reset(psmouse);
1468
Linus Torvalds1da177e2005-04-16 15:20:36 -07001469 if (synaptics_query_hardware(psmouse)) {
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001470 psmouse_err(psmouse, "Unable to query device.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001471 goto init_fail;
1472 }
1473
Daniel Drake7968a5d2011-11-08 00:00:35 -08001474 priv->absolute_mode = absolute_mode;
1475 if (SYN_ID_DISGEST_SUPPORTED(priv->identity))
1476 priv->disable_gesture = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001477
Daniel Drake7968a5d2011-11-08 00:00:35 -08001478 if (synaptics_set_mode(psmouse)) {
1479 psmouse_err(psmouse, "Unable to initialize device.\n");
Henrik Rydbergfec6e522010-12-21 18:11:25 +01001480 goto init_fail;
1481 }
1482
Linus Torvalds1da177e2005-04-16 15:20:36 -07001483 priv->pkt_type = SYN_MODEL_NEWABS(priv->model_id) ? SYN_NEWABS : SYN_OLDABS;
1484
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001485 psmouse_info(psmouse,
Daniel Kurtzc6bd9d42012-07-07 18:08:51 -07001486 "Touchpad model: %ld, fw: %ld.%ld, id: %#lx, caps: %#lx/%#lx/%#lx, board id: %lu, fw id: %lu\n",
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001487 SYN_ID_MODEL(priv->identity),
1488 SYN_ID_MAJOR(priv->identity), SYN_ID_MINOR(priv->identity),
1489 priv->model_id,
Daniel Kurtzc6bd9d42012-07-07 18:08:51 -07001490 priv->capabilities, priv->ext_cap, priv->ext_cap_0c,
1491 priv->board_id, priv->firmware_id);
Dmitry Torokhov409b7502005-05-28 02:12:18 -05001492
Hans de Goede43e19882014-04-19 22:26:41 -07001493 set_input_params(psmouse, priv);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001494
Dmitry Torokhov887cc122007-04-12 01:30:41 -04001495 /*
1496 * Encode touchpad model so that it can be used to set
1497 * input device->id.version and be visible to userspace.
1498 * Because version is __u16 we have to drop something.
1499 * Hardware info bits seem to be good candidates as they
1500 * are documented to be for Synaptics corp. internal use.
1501 */
1502 psmouse->model = ((priv->model_id & 0x00ff0000) >> 8) |
1503 (priv->model_id & 0x000000ff);
1504
Daniel Drake7968a5d2011-11-08 00:00:35 -08001505 if (absolute_mode) {
1506 psmouse->protocol_handler = synaptics_process_byte;
1507 psmouse->pktsize = 6;
1508 } else {
1509 /* Relative mode follows standard PS/2 mouse protocol */
1510 psmouse->protocol_handler = psmouse_process_byte;
1511 psmouse->pktsize = 3;
1512 }
1513
Linus Torvalds1da177e2005-04-16 15:20:36 -07001514 psmouse->set_rate = synaptics_set_rate;
1515 psmouse->disconnect = synaptics_disconnect;
1516 psmouse->reconnect = synaptics_reconnect;
Dmitry Torokhova1cec062007-02-18 01:40:24 -05001517 psmouse->cleanup = synaptics_reset;
Dmitry Torokhovf0d5c6f42006-01-14 00:27:37 -05001518 /* Synaptics can usually stay in sync without extra help */
1519 psmouse->resync_time = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001520
1521 if (SYN_CAP_PASS_THROUGH(priv->capabilities))
1522 synaptics_pt_create(psmouse);
1523
Linus Torvalds1da177e2005-04-16 15:20:36 -07001524 /*
1525 * Toshiba's KBC seems to have trouble handling data from
Andres Salomon7ee99162010-12-23 01:18:28 -08001526 * Synaptics at full rate. Switch to a lower rate (roughly
1527 * the same rate as a standard PS/2 mouse).
Linus Torvalds1da177e2005-04-16 15:20:36 -07001528 */
Dmitry Torokhov7705d542009-12-03 23:21:14 -08001529 if (psmouse->rate >= 80 && impaired_toshiba_kbc) {
Dmitry Torokhovb5d21702011-10-10 18:27:03 -07001530 psmouse_info(psmouse,
1531 "Toshiba %s detected, limiting rate to 40pps.\n",
1532 dmi_get_system_info(DMI_PRODUCT_NAME));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001533 psmouse->rate = 40;
1534 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001535
Daniel Drake7968a5d2011-11-08 00:00:35 -08001536 if (!priv->absolute_mode && SYN_ID_DISGEST_SUPPORTED(priv->identity)) {
1537 err = device_create_file(&psmouse->ps2dev.serio->dev,
1538 &psmouse_attr_disable_gesture.dattr);
1539 if (err) {
1540 psmouse_err(psmouse,
1541 "Failed to create disable_gesture attribute (%d)",
1542 err);
1543 goto init_fail;
1544 }
1545 }
1546
Linus Torvalds1da177e2005-04-16 15:20:36 -07001547 return 0;
1548
1549 init_fail:
1550 kfree(priv);
Daniel Drake7968a5d2011-11-08 00:00:35 -08001551 return err;
1552}
1553
1554int synaptics_init(struct psmouse *psmouse)
1555{
1556 return __synaptics_init(psmouse, true);
1557}
1558
1559int synaptics_init_relative(struct psmouse *psmouse)
1560{
1561 return __synaptics_init(psmouse, false);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001562}
1563
Andres Salomon55e3d922007-03-10 01:39:54 -05001564#else /* CONFIG_MOUSE_PS2_SYNAPTICS */
1565
Dmitry Torokhov7705d542009-12-03 23:21:14 -08001566void __init synaptics_module_init(void)
1567{
1568}
1569
Andres Salomon55e3d922007-03-10 01:39:54 -05001570int synaptics_init(struct psmouse *psmouse)
1571{
1572 return -ENOSYS;
1573}
1574
1575#endif /* CONFIG_MOUSE_PS2_SYNAPTICS */