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