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