drivers/input/mouse/synaptics.c

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