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