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 bool is_forcepad;
 611
 612 static int synaptics_parse_hw_state(const unsigned char buf[],
 613                                     struct synaptics_data *priv,
 614                                     struct synaptics_hw_state *hw)
 615 {
 616         memset(hw, 0, sizeof(struct synaptics_hw_state));
 617
 618         if (SYN_MODEL_NEWABS(priv->model_id)) {
 619                 hw->w = (((buf[0] & 0x30) >> 2) |
 620                          ((buf[0] & 0x04) >> 1) |
 621                          ((buf[3] & 0x04) >> 2));
 622
 623                 if ((SYN_CAP_ADV_GESTURE(priv->ext_cap_0c) ||
 624                         SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) &&
 625                     hw->w == 2) {
 626                         synaptics_parse_agm(buf, priv, hw);
 627                         return 1;
 628                 }
 629
 630                 hw->x = (((buf[3] & 0x10) << 8) |
 631                          ((buf[1] & 0x0f) << 8) |
 632                          buf[4]);
 633                 hw->y = (((buf[3] & 0x20) << 7) |
 634                          ((buf[1] & 0xf0) << 4) |
 635                          buf[5]);
 636                 hw->z = buf[2];
 637
 638                 hw->left  = (buf[0] & 0x01) ? 1 : 0;
 639                 hw->right = (buf[0] & 0x02) ? 1 : 0;
 640
 641                 if (is_forcepad) {
 642                         /*
 643                          * ForcePads, like Clickpads, use middle button
 644                          * bits to report primary button clicks.
 645                          * Unfortunately they report primary button not
 646                          * only when user presses on the pad above certain
 647                          * threshold, but also when there are more than one
 648                          * finger on the touchpad, which interferes with
 649                          * out multi-finger gestures.
 650                          */
 651                         if (hw->z == 0) {
 652                                 /* No contacts */
 653                                 priv->press = priv->report_press = false;
 654                         } else if (hw->w >= 4 && ((buf[0] ^ buf[3]) & 0x01)) {
 655                                 /*
 656                                  * Single-finger touch with pressure above
 657                                  * the threshold. If pressure stays long
 658                                  * enough, we'll start reporting primary
 659                                  * button. We rely on the device continuing
 660                                  * sending data even if finger does not
 661                                  * move.
 662                                  */
 663                                 if  (!priv->press) {
 664                                         priv->press_start = jiffies;
 665                                         priv->press = true;
 666                                 } else if (time_after(jiffies,
 667                                                 priv->press_start +
 668                                                         msecs_to_jiffies(50))) {
 669                                         priv->report_press = true;
 670                                 }
 671                         } else {
 672                                 priv->press = false;
 673                         }
 674
 675                         hw->left = priv->report_press;
 676
 677                 } else if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
 678                         /*
 679                          * Clickpad's button is transmitted as middle button,
 680                          * however, since it is primary button, we will report
 681                          * it as BTN_LEFT.
 682                          */
 683                         hw->left = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
 684
 685                 } else if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
 686                         hw->middle = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
 687                         if (hw->w == 2)
 688                                 hw->scroll = (signed char)(buf[1]);
 689                 }
 690
 691                 if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
 692                         hw->up   = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
 693                         hw->down = ((buf[0] ^ buf[3]) & 0x02) ? 1 : 0;
 694                 }
 695
 696                 if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) &&
 697                     ((buf[0] ^ buf[3]) & 0x02)) {
 698                         switch (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) & ~0x01) {
 699                         default:
 700                                 /*
 701                                  * if nExtBtn is greater than 8 it should be
 702                                  * considered invalid and treated as 0
 703                                  */
 704                                 break;
 705                         case 8:
 706                                 hw->ext_buttons |= ((buf[5] & 0x08)) ? 0x80 : 0;
 707                                 hw->ext_buttons |= ((buf[4] & 0x08)) ? 0x40 : 0;
 708                         case 6:
 709                                 hw->ext_buttons |= ((buf[5] & 0x04)) ? 0x20 : 0;
 710                                 hw->ext_buttons |= ((buf[4] & 0x04)) ? 0x10 : 0;
 711                         case 4:
 712                                 hw->ext_buttons |= ((buf[5] & 0x02)) ? 0x08 : 0;
 713                                 hw->ext_buttons |= ((buf[4] & 0x02)) ? 0x04 : 0;
 714                         case 2:
 715                                 hw->ext_buttons |= ((buf[5] & 0x01)) ? 0x02 : 0;
 716                                 hw->ext_buttons |= ((buf[4] & 0x01)) ? 0x01 : 0;
 717                         }
 718                 }
 719         } else {
 720                 hw->x = (((buf[1] & 0x1f) << 8) | buf[2]);
 721                 hw->y = (((buf[4] & 0x1f) << 8) | buf[5]);
 722
 723                 hw->z = (((buf[0] & 0x30) << 2) | (buf[3] & 0x3F));
 724                 hw->w = (((buf[1] & 0x80) >> 4) | ((buf[0] & 0x04) >> 1));
 725
 726                 hw->left  = (buf[0] & 0x01) ? 1 : 0;
 727                 hw->right = (buf[0] & 0x02) ? 1 : 0;
 728         }
 729
 730         /*
 731          * Convert wrap-around values to negative. (X|Y)_MAX_POSITIVE
 732          * is used by some firmware to indicate a finger at the edge of
 733          * the touchpad whose precise position cannot be determined, so
 734          * convert these values to the maximum axis value.
 735          */
 736         if (hw->x > X_MAX_POSITIVE)
 737                 hw->x -= 1 << ABS_POS_BITS;
 738         else if (hw->x == X_MAX_POSITIVE)
 739                 hw->x = XMAX;
 740
 741         if (hw->y > Y_MAX_POSITIVE)
 742                 hw->y -= 1 << ABS_POS_BITS;
 743         else if (hw->y == Y_MAX_POSITIVE)
 744                 hw->y = YMAX;
 745
 746         return 0;
 747 }
 748
 749 static void synaptics_report_semi_mt_slot(struct input_dev *dev, int slot,
 750                                           bool active, int x, int y)
 751 {
 752         input_mt_slot(dev, slot);
 753         input_mt_report_slot_state(dev, MT_TOOL_FINGER, active);
 754         if (active) {
 755                 input_report_abs(dev, ABS_MT_POSITION_X, x);
 756                 input_report_abs(dev, ABS_MT_POSITION_Y, synaptics_invert_y(y));
 757         }
 758 }
 759
 760 static void synaptics_report_semi_mt_data(struct input_dev *dev,
 761                                           const struct synaptics_hw_state *a,
 762                                           const struct synaptics_hw_state *b,
 763                                           int num_fingers)
 764 {
 765         if (num_fingers >= 2) {
 766                 synaptics_report_semi_mt_slot(dev, 0, true, min(a->x, b->x),
 767                                               min(a->y, b->y));
 768                 synaptics_report_semi_mt_slot(dev, 1, true, max(a->x, b->x),
 769                                               max(a->y, b->y));
 770         } else if (num_fingers == 1) {
 771                 synaptics_report_semi_mt_slot(dev, 0, true, a->x, a->y);
 772                 synaptics_report_semi_mt_slot(dev, 1, false, 0, 0);
 773         } else {
 774                 synaptics_report_semi_mt_slot(dev, 0, false, 0, 0);
 775                 synaptics_report_semi_mt_slot(dev, 1, false, 0, 0);
 776         }
 777 }
 778
 779 static void synaptics_report_buttons(struct psmouse *psmouse,
 780                                      const struct synaptics_hw_state *hw)
 781 {
 782         struct input_dev *dev = psmouse->dev;
 783         struct synaptics_data *priv = psmouse->private;
 784         int i;
 785
 786         input_report_key(dev, BTN_LEFT, hw->left);
 787         input_report_key(dev, BTN_RIGHT, hw->right);
 788
 789         if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
 790                 input_report_key(dev, BTN_MIDDLE, hw->middle);
 791
 792         if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
 793                 input_report_key(dev, BTN_FORWARD, hw->up);
 794                 input_report_key(dev, BTN_BACK, hw->down);
 795         }
 796
 797         for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
 798                 input_report_key(dev, BTN_0 + i, hw->ext_buttons & (1 << i));
 799 }
 800
 801 static void synaptics_report_slot(struct input_dev *dev, int slot,
 802                                   const struct synaptics_hw_state *hw)
 803 {
 804         input_mt_slot(dev, slot);
 805         input_mt_report_slot_state(dev, MT_TOOL_FINGER, (hw != NULL));
 806         if (!hw)
 807                 return;
 808
 809         input_report_abs(dev, ABS_MT_POSITION_X, hw->x);
 810         input_report_abs(dev, ABS_MT_POSITION_Y, synaptics_invert_y(hw->y));
 811         input_report_abs(dev, ABS_MT_PRESSURE, hw->z);
 812 }
 813
 814 static void synaptics_report_mt_data(struct psmouse *psmouse,
 815                                      struct synaptics_mt_state *mt_state,
 816                                      const struct synaptics_hw_state *sgm)
 817 {
 818         struct input_dev *dev = psmouse->dev;
 819         struct synaptics_data *priv = psmouse->private;
 820         struct synaptics_hw_state *agm = &priv->agm;
 821         struct synaptics_mt_state *old = &priv->mt_state;
 822
 823         switch (mt_state->count) {
 824         case 0:
 825                 synaptics_report_slot(dev, 0, NULL);
 826                 synaptics_report_slot(dev, 1, NULL);
 827                 break;
 828         case 1:
 829                 if (mt_state->sgm == -1) {
 830                         synaptics_report_slot(dev, 0, NULL);
 831                         synaptics_report_slot(dev, 1, NULL);
 832                 } else if (mt_state->sgm == 0) {
 833                         synaptics_report_slot(dev, 0, sgm);
 834                         synaptics_report_slot(dev, 1, NULL);
 835                 } else {
 836                         synaptics_report_slot(dev, 0, NULL);
 837                         synaptics_report_slot(dev, 1, sgm);
 838                 }
 839                 break;
 840         default:
 841                 /*
 842                  * If the finger slot contained in SGM is valid, and either
 843                  * hasn't changed, or is new, or the old SGM has now moved to
 844                  * AGM, then report SGM in MTB slot 0.
 845                  * Otherwise, empty MTB slot 0.
 846                  */
 847                 if (mt_state->sgm != -1 &&
 848                     (mt_state->sgm == old->sgm ||
 849                      old->sgm == -1 || mt_state->agm == old->sgm))
 850                         synaptics_report_slot(dev, 0, sgm);
 851                 else
 852                         synaptics_report_slot(dev, 0, NULL);
 853
 854                 /*
 855                  * If the finger slot contained in AGM is valid, and either
 856                  * hasn't changed, or is new, then report AGM in MTB slot 1.
 857                  * Otherwise, empty MTB slot 1.
 858                  *
 859                  * However, in the case where the AGM is new, make sure that
 860                  * that it is either the same as the old SGM, or there was no
 861                  * SGM.
 862                  *
 863                  * Otherwise, if the SGM was just 1, and the new AGM is 2, then
 864                  * the new AGM will keep the old SGM's tracking ID, which can
 865                  * cause apparent drumroll.  This happens if in the following
 866                  * valid finger sequence:
 867                  *
 868                  *  Action                 SGM  AGM (MTB slot:Contact)
 869                  *  1. Touch contact 0    (0:0)
 870                  *  2. Touch contact 1    (0:0, 1:1)
 871                  *  3. Lift  contact 0    (1:1)
 872                  *  4. Touch contacts 2,3 (0:2, 1:3)
 873                  *
 874                  * In step 4, contact 3, in AGM must not be given the same
 875                  * tracking ID as contact 1 had in step 3.  To avoid this,
 876                  * the first agm with contact 3 is dropped and slot 1 is
 877                  * invalidated (tracking ID = -1).
 878                  */
 879                 if (mt_state->agm != -1 &&
 880                     (mt_state->agm == old->agm ||
 881                      (old->agm == -1 &&
 882                       (old->sgm == -1 || mt_state->agm == old->sgm))))
 883                         synaptics_report_slot(dev, 1, agm);
 884                 else
 885                         synaptics_report_slot(dev, 1, NULL);
 886                 break;
 887         }
 888
 889         /* Don't use active slot count to generate BTN_TOOL events. */
 890         input_mt_report_pointer_emulation(dev, false);
 891
 892         /* Send the number of fingers reported by touchpad itself. */
 893         input_mt_report_finger_count(dev, mt_state->count);
 894
 895         synaptics_report_buttons(psmouse, sgm);
 896
 897         input_sync(dev);
 898 }
 899
 900 /* Handle case where mt_state->count = 0 */
 901 static void synaptics_image_sensor_0f(struct synaptics_data *priv,
 902                                       struct synaptics_mt_state *mt_state)
 903 {
 904         synaptics_mt_state_set(mt_state, 0, -1, -1);
 905         priv->mt_state_lost = false;
 906 }
 907
 908 /* Handle case where mt_state->count = 1 */
 909 static void synaptics_image_sensor_1f(struct synaptics_data *priv,
 910                                       struct synaptics_mt_state *mt_state)
 911 {
 912         struct synaptics_hw_state *agm = &priv->agm;
 913         struct synaptics_mt_state *old = &priv->mt_state;
 914
 915         /*
 916          * If the last AGM was (0,0,0), and there is only one finger left,
 917          * then we absolutely know that SGM contains slot 0, and all other
 918          * fingers have been removed.
 919          */
 920         if (priv->agm_pending && agm->z == 0) {
 921                 synaptics_mt_state_set(mt_state, 1, 0, -1);
 922                 priv->mt_state_lost = false;
 923                 return;
 924         }
 925
 926         switch (old->count) {
 927         case 0:
 928                 synaptics_mt_state_set(mt_state, 1, 0, -1);
 929                 break;
 930         case 1:
 931                 /*
 932                  * If mt_state_lost, then the previous transition was 3->1,
 933                  * and SGM now contains either slot 0 or 1, but we don't know
 934                  * which.  So, we just assume that the SGM now contains slot 1.
 935                  *
 936                  * If pending AGM and either:
 937                  *   (a) the previous SGM slot contains slot 0, or
 938                  *   (b) there was no SGM slot
 939                  * then, the SGM now contains slot 1
 940                  *
 941                  * Case (a) happens with very rapid "drum roll" gestures, where
 942                  * slot 0 finger is lifted and a new slot 1 finger touches
 943                  * within one reporting interval.
 944                  *
 945                  * Case (b) happens if initially two or more fingers tap
 946                  * briefly, and all but one lift before the end of the first
 947                  * reporting interval.
 948                  *
 949                  * (In both these cases, slot 0 will becomes empty, so SGM
 950                  * contains slot 1 with the new finger)
 951                  *
 952                  * Else, if there was no previous SGM, it now contains slot 0.
 953                  *
 954                  * Otherwise, SGM still contains the same slot.
 955                  */
 956                 if (priv->mt_state_lost ||
 957                     (priv->agm_pending && old->sgm <= 0))
 958                         synaptics_mt_state_set(mt_state, 1, 1, -1);
 959                 else if (old->sgm == -1)
 960                         synaptics_mt_state_set(mt_state, 1, 0, -1);
 961                 break;
 962         case 2:
 963                 /*
 964                  * If mt_state_lost, we don't know which finger SGM contains.
 965                  *
 966                  * So, report 1 finger, but with both slots empty.
 967                  * We will use slot 1 on subsequent 1->1
 968                  */
 969                 if (priv->mt_state_lost) {
 970                         synaptics_mt_state_set(mt_state, 1, -1, -1);
 971                         break;
 972                 }
 973                 /*
 974                  * Since the last AGM was NOT (0,0,0), it was the finger in
 975                  * slot 0 that has been removed.
 976                  * So, SGM now contains previous AGM's slot, and AGM is now
 977                  * empty.
 978                  */
 979                 synaptics_mt_state_set(mt_state, 1, old->agm, -1);
 980                 break;
 981         case 3:
 982                 /*
 983                  * Since last AGM was not (0,0,0), we don't know which finger
 984                  * is left.
 985                  *
 986                  * So, report 1 finger, but with both slots empty.
 987                  * We will use slot 1 on subsequent 1->1
 988                  */
 989                 synaptics_mt_state_set(mt_state, 1, -1, -1);
 990                 priv->mt_state_lost = true;
 991                 break;
 992         case 4:
 993         case 5:
 994                 /* mt_state was updated by AGM-CONTACT packet */
 995                 break;
 996         }
 997 }
 998
 999 /* Handle case where mt_state->count = 2 */
1000 static void synaptics_image_sensor_2f(struct synaptics_data *priv,
1001                                       struct synaptics_mt_state *mt_state)
1002 {
1003         struct synaptics_mt_state *old = &priv->mt_state;
1004
1005         switch (old->count) {
1006         case 0:
1007                 synaptics_mt_state_set(mt_state, 2, 0, 1);
1008                 break;
1009         case 1:
1010                 /*
1011                  * If previous SGM contained slot 1 or higher, SGM now contains
1012                  * slot 0 (the newly touching finger) and AGM contains SGM's
1013                  * previous slot.
1014                  *
1015                  * Otherwise, SGM still contains slot 0 and AGM now contains
1016                  * slot 1.
1017                  */
1018                 if (old->sgm >= 1)
1019                         synaptics_mt_state_set(mt_state, 2, 0, old->sgm);
1020                 else
1021                         synaptics_mt_state_set(mt_state, 2, 0, 1);
1022                 break;
1023         case 2:
1024                 /*
1025                  * If mt_state_lost, SGM now contains either finger 1 or 2, but
1026                  * we don't know which.
1027                  * So, we just assume that the SGM contains slot 0 and AGM 1.
1028                  */
1029                 if (priv->mt_state_lost)
1030                         synaptics_mt_state_set(mt_state, 2, 0, 1);
1031                 /*
1032                  * Otherwise, use the same mt_state, since it either hasn't
1033                  * changed, or was updated by a recently received AGM-CONTACT
1034                  * packet.
1035                  */
1036                 break;
1037         case 3:
1038                 /*
1039                  * 3->2 transitions have two unsolvable problems:
1040                  *  1) no indication is given which finger was removed
1041                  *  2) no way to tell if agm packet was for finger 3
1042                  *     before 3->2, or finger 2 after 3->2.
1043                  *
1044                  * So, report 2 fingers, but empty all slots.
1045                  * We will guess slots [0,1] on subsequent 2->2.
1046                  */
1047                 synaptics_mt_state_set(mt_state, 2, -1, -1);
1048                 priv->mt_state_lost = true;
1049                 break;
1050         case 4:
1051         case 5:
1052                 /* mt_state was updated by AGM-CONTACT packet */
1053                 break;
1054         }
1055 }
1056
1057 /* Handle case where mt_state->count = 3 */
1058 static void synaptics_image_sensor_3f(struct synaptics_data *priv,
1059                                       struct synaptics_mt_state *mt_state)
1060 {
1061         struct synaptics_mt_state *old = &priv->mt_state;
1062
1063         switch (old->count) {
1064         case 0:
1065                 synaptics_mt_state_set(mt_state, 3, 0, 2);
1066                 break;
1067         case 1:
1068                 /*
1069                  * If previous SGM contained slot 2 or higher, SGM now contains
1070                  * slot 0 (one of the newly touching fingers) and AGM contains
1071                  * SGM's previous slot.
1072                  *
1073                  * Otherwise, SGM now contains slot 0 and AGM contains slot 2.
1074                  */
1075                 if (old->sgm >= 2)
1076                         synaptics_mt_state_set(mt_state, 3, 0, old->sgm);
1077                 else
1078                         synaptics_mt_state_set(mt_state, 3, 0, 2);
1079                 break;
1080         case 2:
1081                 /*
1082                  * If the AGM previously contained slot 3 or higher, then the
1083                  * newly touching finger is in the lowest available slot.
1084                  *
1085                  * If SGM was previously 1 or higher, then the new SGM is
1086                  * now slot 0 (with a new finger), otherwise, the new finger
1087                  * is now in a hidden slot between 0 and AGM's slot.
1088                  *
1089                  * In all such cases, the SGM now contains slot 0, and the AGM
1090                  * continues to contain the same slot as before.
1091                  */
1092                 if (old->agm >= 3) {
1093                         synaptics_mt_state_set(mt_state, 3, 0, old->agm);
1094                         break;
1095                 }
1096
1097                 /*
1098                  * After some 3->1 and all 3->2 transitions, we lose track
1099                  * of which slot is reported by SGM and AGM.
1100                  *
1101                  * For 2->3 in this state, report 3 fingers, but empty all
1102                  * slots, and we will guess (0,2) on a subsequent 0->3.
1103                  *
1104                  * To userspace, the resulting transition will look like:
1105                  *    2:[0,1] -> 3:[-1,-1] -> 3:[0,2]
1106                  */
1107                 if (priv->mt_state_lost) {
1108                         synaptics_mt_state_set(mt_state, 3, -1, -1);
1109                         break;
1110                 }
1111
1112                 /*
1113                  * If the (SGM,AGM) really previously contained slots (0, 1),
1114                  * then we cannot know what slot was just reported by the AGM,
1115                  * because the 2->3 transition can occur either before or after
1116                  * the AGM packet. Thus, this most recent AGM could contain
1117                  * either the same old slot 1 or the new slot 2.
1118                  * Subsequent AGMs will be reporting slot 2.
1119                  *
1120                  * To userspace, the resulting transition will look like:
1121                  *    2:[0,1] -> 3:[0,-1] -> 3:[0,2]
1122                  */
1123                 synaptics_mt_state_set(mt_state, 3, 0, -1);
1124                 break;
1125         case 3:
1126                 /*
1127                  * If, for whatever reason, the previous agm was invalid,
1128                  * Assume SGM now contains slot 0, AGM now contains slot 2.
1129                  */
1130                 if (old->agm <= 2)
1131                         synaptics_mt_state_set(mt_state, 3, 0, 2);
1132                 /*
1133                  * mt_state either hasn't changed, or was updated by a recently
1134                  * received AGM-CONTACT packet.
1135                  */
1136                 break;
1137
1138         case 4:
1139         case 5:
1140                 /* mt_state was updated by AGM-CONTACT packet */
1141                 break;
1142         }
1143 }
1144
1145 /* Handle case where mt_state->count = 4, or = 5 */
1146 static void synaptics_image_sensor_45f(struct synaptics_data *priv,
1147                                        struct synaptics_mt_state *mt_state)
1148 {
1149         /* mt_state was updated correctly by AGM-CONTACT packet */
1150         priv->mt_state_lost = false;
1151 }
1152
1153 static void synaptics_image_sensor_process(struct psmouse *psmouse,
1154                                            struct synaptics_hw_state *sgm)
1155 {
1156         struct synaptics_data *priv = psmouse->private;
1157         struct synaptics_hw_state *agm = &priv->agm;
1158         struct synaptics_mt_state mt_state;
1159
1160         /* Initialize using current mt_state (as updated by last agm) */
1161         mt_state = agm->mt_state;
1162
1163         /*
1164          * Update mt_state using the new finger count and current mt_state.
1165          */
1166         if (sgm->z == 0)
1167                 synaptics_image_sensor_0f(priv, &mt_state);
1168         else if (sgm->w >= 4)
1169                 synaptics_image_sensor_1f(priv, &mt_state);
1170         else if (sgm->w == 0)
1171                 synaptics_image_sensor_2f(priv, &mt_state);
1172         else if (sgm->w == 1 && mt_state.count <= 3)
1173                 synaptics_image_sensor_3f(priv, &mt_state);
1174         else
1175                 synaptics_image_sensor_45f(priv, &mt_state);
1176
1177         /* Send resulting input events to user space */
1178         synaptics_report_mt_data(psmouse, &mt_state, sgm);
1179
1180         /* Store updated mt_state */
1181         priv->mt_state = agm->mt_state = mt_state;
1182         priv->agm_pending = false;
1183 }
1184
1185 static void synaptics_profile_sensor_process(struct psmouse *psmouse,
1186                                              struct synaptics_hw_state *sgm,
1187                                              int num_fingers)
1188 {
1189         struct input_dev *dev = psmouse->dev;
1190         struct synaptics_data *priv = psmouse->private;
1191         struct synaptics_hw_state *hw[2] = { sgm, &priv->agm };
1192         struct input_mt_pos pos[2];
1193         int slot[2], nsemi, i;
1194
1195         nsemi = clamp_val(num_fingers, 0, 2);
1196
1197         for (i = 0; i < nsemi; i++) {
1198                 pos[i].x = hw[i]->x;
1199                 pos[i].y = synaptics_invert_y(hw[i]->y);
1200         }
1201
1202         input_mt_assign_slots(dev, slot, pos, nsemi);
1203
1204         for (i = 0; i < nsemi; i++) {
1205                 input_mt_slot(dev, slot[i]);
1206                 input_mt_report_slot_state(dev, MT_TOOL_FINGER, true);
1207                 input_report_abs(dev, ABS_MT_POSITION_X, pos[i].x);
1208                 input_report_abs(dev, ABS_MT_POSITION_Y, pos[i].y);
1209                 input_report_abs(dev, ABS_MT_PRESSURE, hw[i]->z);
1210         }
1211
1212         input_mt_drop_unused(dev);
1213         input_mt_report_pointer_emulation(dev, false);
1214         input_mt_report_finger_count(dev, num_fingers);
1215
1216         synaptics_report_buttons(psmouse, sgm);
1217
1218         input_sync(dev);
1219 }
1220
1221 /*
1222  *  called for each full received packet from the touchpad
1223  */
1224 static void synaptics_process_packet(struct psmouse *psmouse)
1225 {
1226         struct input_dev *dev = psmouse->dev;
1227         struct synaptics_data *priv = psmouse->private;
1228         struct synaptics_hw_state hw;
1229         int num_fingers;
1230         int finger_width;
1231
1232         if (synaptics_parse_hw_state(psmouse->packet, priv, &hw))
1233                 return;
1234
1235         if (SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) {
1236                 synaptics_image_sensor_process(psmouse, &hw);
1237                 return;
1238         }
1239
1240         if (hw.scroll) {
1241                 priv->scroll += hw.scroll;
1242
1243                 while (priv->scroll >= 4) {
1244                         input_report_key(dev, BTN_BACK, !hw.down);
1245                         input_sync(dev);
1246                         input_report_key(dev, BTN_BACK, hw.down);
1247                         input_sync(dev);
1248                         priv->scroll -= 4;
1249                 }
1250                 while (priv->scroll <= -4) {
1251                         input_report_key(dev, BTN_FORWARD, !hw.up);
1252                         input_sync(dev);
1253                         input_report_key(dev, BTN_FORWARD, hw.up);
1254                         input_sync(dev);
1255                         priv->scroll += 4;
1256                 }
1257                 return;
1258         }
1259
1260         if (hw.z > 0 && hw.x > 1) {
1261                 num_fingers = 1;
1262                 finger_width = 5;
1263                 if (SYN_CAP_EXTENDED(priv->capabilities)) {
1264                         switch (hw.w) {
1265                         case 0 ... 1:
1266                                 if (SYN_CAP_MULTIFINGER(priv->capabilities))
1267                                         num_fingers = hw.w + 2;
1268                                 break;
1269                         case 2:
1270                                 if (SYN_MODEL_PEN(priv->model_id))
1271                                         ;   /* Nothing, treat a pen as a single finger */
1272                                 break;
1273                         case 4 ... 15:
1274                                 if (SYN_CAP_PALMDETECT(priv->capabilities))
1275                                         finger_width = hw.w;
1276                                 break;
1277                         }
1278                 }
1279         } else {
1280                 num_fingers = 0;
1281                 finger_width = 0;
1282         }
1283
1284         if (cr48_profile_sensor) {
1285                 synaptics_profile_sensor_process(psmouse, &hw, num_fingers);
1286                 return;
1287         }
1288
1289         if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c))
1290                 synaptics_report_semi_mt_data(dev, &hw, &priv->agm,
1291                                               num_fingers);
1292
1293         /* Post events
1294          * BTN_TOUCH has to be first as mousedev relies on it when doing
1295          * absolute -> relative conversion
1296          */
1297         if (hw.z > 30) input_report_key(dev, BTN_TOUCH, 1);
1298         if (hw.z < 25) input_report_key(dev, BTN_TOUCH, 0);
1299
1300         if (num_fingers > 0) {
1301                 input_report_abs(dev, ABS_X, hw.x);
1302                 input_report_abs(dev, ABS_Y, synaptics_invert_y(hw.y));
1303         }
1304         input_report_abs(dev, ABS_PRESSURE, hw.z);
1305
1306         if (SYN_CAP_PALMDETECT(priv->capabilities))
1307                 input_report_abs(dev, ABS_TOOL_WIDTH, finger_width);
1308
1309         input_report_key(dev, BTN_TOOL_FINGER, num_fingers == 1);
1310         if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
1311                 input_report_key(dev, BTN_TOOL_DOUBLETAP, num_fingers == 2);
1312                 input_report_key(dev, BTN_TOOL_TRIPLETAP, num_fingers == 3);
1313         }
1314
1315         synaptics_report_buttons(psmouse, &hw);
1316
1317         input_sync(dev);
1318 }
1319
1320 static int synaptics_validate_byte(struct psmouse *psmouse,
1321                                    int idx, unsigned char pkt_type)
1322 {
1323         static const unsigned char newabs_mask[]        = { 0xC8, 0x00, 0x00, 0xC8, 0x00 };
1324         static const unsigned char newabs_rel_mask[]    = { 0xC0, 0x00, 0x00, 0xC0, 0x00 };
1325         static const unsigned char newabs_rslt[]        = { 0x80, 0x00, 0x00, 0xC0, 0x00 };
1326         static const unsigned char oldabs_mask[]        = { 0xC0, 0x60, 0x00, 0xC0, 0x60 };
1327         static const unsigned char oldabs_rslt[]        = { 0xC0, 0x00, 0x00, 0x80, 0x00 };
1328         const char *packet = psmouse->packet;
1329
1330         if (idx < 0 || idx > 4)
1331                 return 0;
1332
1333         switch (pkt_type) {
1334
1335         case SYN_NEWABS:
1336         case SYN_NEWABS_RELAXED:
1337                 return (packet[idx] & newabs_rel_mask[idx]) == newabs_rslt[idx];
1338
1339         case SYN_NEWABS_STRICT:
1340                 return (packet[idx] & newabs_mask[idx]) == newabs_rslt[idx];
1341
1342         case SYN_OLDABS:
1343                 return (packet[idx] & oldabs_mask[idx]) == oldabs_rslt[idx];
1344
1345         default:
1346                 psmouse_err(psmouse, "unknown packet type %d\n", pkt_type);
1347                 return 0;
1348         }
1349 }
1350
1351 static unsigned char synaptics_detect_pkt_type(struct psmouse *psmouse)
1352 {
1353         int i;
1354
1355         for (i = 0; i < 5; i++)
1356                 if (!synaptics_validate_byte(psmouse, i, SYN_NEWABS_STRICT)) {
1357                         psmouse_info(psmouse, "using relaxed packet validation\n");
1358                         return SYN_NEWABS_RELAXED;
1359                 }
1360
1361         return SYN_NEWABS_STRICT;
1362 }
1363
1364 static psmouse_ret_t synaptics_process_byte(struct psmouse *psmouse)
1365 {
1366         struct synaptics_data *priv = psmouse->private;
1367
1368         if (psmouse->pktcnt >= 6) { /* Full packet received */
1369                 if (unlikely(priv->pkt_type == SYN_NEWABS))
1370                         priv->pkt_type = synaptics_detect_pkt_type(psmouse);
1371
1372                 if (SYN_CAP_PASS_THROUGH(priv->capabilities) &&
1373                     synaptics_is_pt_packet(psmouse->packet)) {
1374                         if (priv->pt_port)
1375                                 synaptics_pass_pt_packet(priv->pt_port, psmouse->packet);
1376                 } else
1377                         synaptics_process_packet(psmouse);
1378
1379                 return PSMOUSE_FULL_PACKET;
1380         }
1381
1382         return synaptics_validate_byte(psmouse, psmouse->pktcnt - 1, priv->pkt_type) ?
1383                 PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
1384 }
1385
1386 /*****************************************************************************
1387  *      Driver initialization/cleanup functions
1388  ****************************************************************************/
1389 static void set_abs_position_params(struct input_dev *dev,
1390                                     struct synaptics_data *priv, int x_code,
1391                                     int y_code)
1392 {
1393         int x_min = priv->x_min ?: XMIN_NOMINAL;
1394         int x_max = priv->x_max ?: XMAX_NOMINAL;
1395         int y_min = priv->y_min ?: YMIN_NOMINAL;
1396         int y_max = priv->y_max ?: YMAX_NOMINAL;
1397         int fuzz = SYN_CAP_REDUCED_FILTERING(priv->ext_cap_0c) ?
1398                         SYN_REDUCED_FILTER_FUZZ : 0;
1399
1400         input_set_abs_params(dev, x_code, x_min, x_max, fuzz, 0);
1401         input_set_abs_params(dev, y_code, y_min, y_max, fuzz, 0);
1402         input_abs_set_res(dev, x_code, priv->x_res);
1403         input_abs_set_res(dev, y_code, priv->y_res);
1404 }
1405
1406 static void set_input_params(struct psmouse *psmouse,
1407                              struct synaptics_data *priv)
1408 {
1409         struct input_dev *dev = psmouse->dev;
1410         int i;
1411
1412         /* Things that apply to both modes */
1413         __set_bit(INPUT_PROP_POINTER, dev->propbit);
1414         __set_bit(EV_KEY, dev->evbit);
1415         __set_bit(BTN_LEFT, dev->keybit);
1416         __set_bit(BTN_RIGHT, dev->keybit);
1417
1418         if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
1419                 __set_bit(BTN_MIDDLE, dev->keybit);
1420
1421         if (!priv->absolute_mode) {
1422                 /* Relative mode */
1423                 __set_bit(EV_REL, dev->evbit);
1424                 __set_bit(REL_X, dev->relbit);
1425                 __set_bit(REL_Y, dev->relbit);
1426                 return;
1427         }
1428
1429         /* Absolute mode */
1430         __set_bit(EV_ABS, dev->evbit);
1431         set_abs_position_params(dev, priv, ABS_X, ABS_Y);
1432         input_set_abs_params(dev, ABS_PRESSURE, 0, 255, 0, 0);
1433
1434         if (cr48_profile_sensor)
1435                 input_set_abs_params(dev, ABS_MT_PRESSURE, 0, 255, 0, 0);
1436
1437         if (SYN_CAP_IMAGE_SENSOR(priv->ext_cap_0c)) {
1438                 set_abs_position_params(dev, priv, ABS_MT_POSITION_X,
1439                                         ABS_MT_POSITION_Y);
1440                 /* Image sensors can report per-contact pressure */
1441                 input_set_abs_params(dev, ABS_MT_PRESSURE, 0, 255, 0, 0);
1442                 input_mt_init_slots(dev, 2, INPUT_MT_POINTER);
1443
1444                 /* Image sensors can signal 4 and 5 finger clicks */
1445                 __set_bit(BTN_TOOL_QUADTAP, dev->keybit);
1446                 __set_bit(BTN_TOOL_QUINTTAP, dev->keybit);
1447         } else if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c)) {
1448                 set_abs_position_params(dev, priv, ABS_MT_POSITION_X,
1449                                         ABS_MT_POSITION_Y);
1450                 /*
1451                  * Profile sensor in CR-48 tracks contacts reasonably well,
1452                  * other non-image sensors with AGM use semi-mt.
1453                  */
1454                 input_mt_init_slots(dev, 2,
1455                                     INPUT_MT_POINTER |
1456                                     (cr48_profile_sensor ?
1457                                         INPUT_MT_TRACK : INPUT_MT_SEMI_MT));
1458         }
1459
1460         if (SYN_CAP_PALMDETECT(priv->capabilities))
1461                 input_set_abs_params(dev, ABS_TOOL_WIDTH, 0, 15, 0, 0);
1462
1463         __set_bit(BTN_TOUCH, dev->keybit);
1464         __set_bit(BTN_TOOL_FINGER, dev->keybit);
1465
1466         if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
1467                 __set_bit(BTN_TOOL_DOUBLETAP, dev->keybit);
1468                 __set_bit(BTN_TOOL_TRIPLETAP, dev->keybit);
1469         }
1470
1471         if (SYN_CAP_FOUR_BUTTON(priv->capabilities) ||
1472             SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
1473                 __set_bit(BTN_FORWARD, dev->keybit);
1474                 __set_bit(BTN_BACK, dev->keybit);
1475         }
1476
1477         for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
1478                 __set_bit(BTN_0 + i, dev->keybit);
1479
1480         __clear_bit(EV_REL, dev->evbit);
1481         __clear_bit(REL_X, dev->relbit);
1482         __clear_bit(REL_Y, dev->relbit);
1483
1484         if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
1485                 __set_bit(INPUT_PROP_BUTTONPAD, dev->propbit);
1486                 if (psmouse_matches_pnp_id(psmouse, topbuttonpad_pnp_ids))
1487                         __set_bit(INPUT_PROP_TOPBUTTONPAD, dev->propbit);
1488                 /* Clickpads report only left button */
1489                 __clear_bit(BTN_RIGHT, dev->keybit);
1490                 __clear_bit(BTN_MIDDLE, dev->keybit);
1491         }
1492 }
1493
1494 static ssize_t synaptics_show_disable_gesture(struct psmouse *psmouse,
1495                                               void *data, char *buf)
1496 {
1497         struct synaptics_data *priv = psmouse->private;
1498
1499         return sprintf(buf, "%c\n", priv->disable_gesture ? '1' : '0');
1500 }
1501
1502 static ssize_t synaptics_set_disable_gesture(struct psmouse *psmouse,
1503                                              void *data, const char *buf,
1504                                              size_t len)
1505 {
1506         struct synaptics_data *priv = psmouse->private;
1507         unsigned int value;
1508         int err;
1509
1510         err = kstrtouint(buf, 10, &value);
1511         if (err)
1512                 return err;
1513
1514         if (value > 1)
1515                 return -EINVAL;
1516
1517         if (value == priv->disable_gesture)
1518                 return len;
1519
1520         priv->disable_gesture = value;
1521         if (value)
1522                 priv->mode |= SYN_BIT_DISABLE_GESTURE;
1523         else
1524                 priv->mode &= ~SYN_BIT_DISABLE_GESTURE;
1525
1526         if (synaptics_mode_cmd(psmouse, priv->mode))
1527                 return -EIO;
1528
1529         return len;
1530 }
1531
1532 PSMOUSE_DEFINE_ATTR(disable_gesture, S_IWUSR | S_IRUGO, NULL,
1533                     synaptics_show_disable_gesture,
1534                     synaptics_set_disable_gesture);
1535
1536 static void synaptics_disconnect(struct psmouse *psmouse)
1537 {
1538         struct synaptics_data *priv = psmouse->private;
1539
1540         if (!priv->absolute_mode && SYN_ID_DISGEST_SUPPORTED(priv->identity))
1541                 device_remove_file(&psmouse->ps2dev.serio->dev,
1542                                    &psmouse_attr_disable_gesture.dattr);
1543
1544         synaptics_reset(psmouse);
1545         kfree(priv);
1546         psmouse->private = NULL;
1547 }
1548
1549 static int synaptics_reconnect(struct psmouse *psmouse)
1550 {
1551         struct synaptics_data *priv = psmouse->private;
1552         struct synaptics_data old_priv = *priv;
1553         unsigned char param[2];
1554         int retry = 0;
1555         int error;
1556
1557         do {
1558                 psmouse_reset(psmouse);
1559                 if (retry) {
1560                         /*
1561                          * On some boxes, right after resuming, the touchpad
1562                          * needs some time to finish initializing (I assume
1563                          * it needs time to calibrate) and start responding
1564                          * to Synaptics-specific queries, so let's wait a
1565                          * bit.
1566                          */
1567                         ssleep(1);
1568                 }
1569                 ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETID);
1570                 error = synaptics_detect(psmouse, 0);
1571         } while (error && ++retry < 3);
1572
1573         if (error)
1574                 return -1;
1575
1576         if (retry > 1)
1577                 psmouse_dbg(psmouse, "reconnected after %d tries\n", retry);
1578
1579         if (synaptics_query_hardware(psmouse)) {
1580                 psmouse_err(psmouse, "Unable to query device.\n");
1581                 return -1;
1582         }
1583
1584         if (synaptics_set_mode(psmouse)) {
1585                 psmouse_err(psmouse, "Unable to initialize device.\n");
1586                 return -1;
1587         }
1588
1589         if (old_priv.identity != priv->identity ||
1590             old_priv.model_id != priv->model_id ||
1591             old_priv.capabilities != priv->capabilities ||
1592             old_priv.ext_cap != priv->ext_cap) {
1593                 psmouse_err(psmouse,
1594                             "hardware appears to be different: id(%ld-%ld), model(%ld-%ld), caps(%lx-%lx), ext(%lx-%lx).\n",
1595                             old_priv.identity, priv->identity,
1596                             old_priv.model_id, priv->model_id,
1597                             old_priv.capabilities, priv->capabilities,
1598                             old_priv.ext_cap, priv->ext_cap);
1599                 return -1;
1600         }
1601
1602         return 0;
1603 }
1604
1605 static bool impaired_toshiba_kbc;
1606
1607 static const struct dmi_system_id toshiba_dmi_table[] __initconst = {
1608 #if defined(CONFIG_DMI) && defined(CONFIG_X86)
1609         {
1610                 /* Toshiba Satellite */
1611                 .matches = {
1612                         DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1613                         DMI_MATCH(DMI_PRODUCT_NAME, "Satellite"),
1614                 },
1615         },
1616         {
1617                 /* Toshiba Dynabook */
1618                 .matches = {
1619                         DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1620                         DMI_MATCH(DMI_PRODUCT_NAME, "dynabook"),
1621                 },
1622         },
1623         {
1624                 /* Toshiba Portege M300 */
1625                 .matches = {
1626                         DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1627                         DMI_MATCH(DMI_PRODUCT_NAME, "PORTEGE M300"),
1628                 },
1629
1630         },
1631         {
1632                 /* Toshiba Portege M300 */
1633                 .matches = {
1634                         DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
1635                         DMI_MATCH(DMI_PRODUCT_NAME, "Portable PC"),
1636                         DMI_MATCH(DMI_PRODUCT_VERSION, "Version 1.0"),
1637                 },
1638
1639         },
1640 #endif
1641         { }
1642 };
1643
1644 static bool broken_olpc_ec;
1645
1646 static const struct dmi_system_id olpc_dmi_table[] __initconst = {
1647 #if defined(CONFIG_DMI) && defined(CONFIG_OLPC)
1648         {
1649                 /* OLPC XO-1 or XO-1.5 */
1650                 .matches = {
1651                         DMI_MATCH(DMI_SYS_VENDOR, "OLPC"),
1652                         DMI_MATCH(DMI_PRODUCT_NAME, "XO"),
1653                 },
1654         },
1655 #endif
1656         { }
1657 };
1658
1659 static const struct dmi_system_id __initconst cr48_dmi_table[] = {
1660 #if defined(CONFIG_DMI) && defined(CONFIG_X86)
1661         {
1662                 /* Cr-48 Chromebook (Codename Mario) */
1663                 .matches = {
1664                         DMI_MATCH(DMI_SYS_VENDOR, "IEC"),
1665                         DMI_MATCH(DMI_PRODUCT_NAME, "Mario"),
1666                 },
1667         },
1668 #endif
1669         { }
1670 };
1671
1672 static const struct dmi_system_id forcepad_dmi_table[] __initconst = {
1673 #if defined(CONFIG_DMI) && defined(CONFIG_X86)
1674         {
1675                 .matches = {
1676                         DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
1677                         DMI_MATCH(DMI_PRODUCT_NAME, "HP EliteBook Folio 1040 G1"),
1678                 },
1679         },
1680 #endif
1681         { }
1682 };
1683
1684 void __init synaptics_module_init(void)
1685 {
1686         impaired_toshiba_kbc = dmi_check_system(toshiba_dmi_table);
1687         broken_olpc_ec = dmi_check_system(olpc_dmi_table);
1688         cr48_profile_sensor = dmi_check_system(cr48_dmi_table);
1689
1690         /*
1691          * Unfortunately ForcePad capability is not exported over PS/2,
1692          * so we have to resort to checking DMI.
1693          */
1694         is_forcepad = dmi_check_system(forcepad_dmi_table);
1695 }
1696
1697 static int __synaptics_init(struct psmouse *psmouse, bool absolute_mode)
1698 {
1699         struct synaptics_data *priv;
1700         int err = -1;
1701
1702         /*
1703          * The OLPC XO has issues with Synaptics' absolute mode; the constant
1704          * packet spew overloads the EC such that key presses on the keyboard
1705          * are missed.  Given that, don't even attempt to use Absolute mode.
1706          * Relative mode seems to work just fine.
1707          */
1708         if (absolute_mode && broken_olpc_ec) {
1709                 psmouse_info(psmouse,
1710                              "OLPC XO detected, not enabling Synaptics protocol.\n");
1711                 return -ENODEV;
1712         }
1713
1714         psmouse->private = priv = kzalloc(sizeof(struct synaptics_data), GFP_KERNEL);
1715         if (!priv)
1716                 return -ENOMEM;
1717
1718         psmouse_reset(psmouse);
1719
1720         if (synaptics_query_hardware(psmouse)) {
1721                 psmouse_err(psmouse, "Unable to query device.\n");
1722                 goto init_fail;
1723         }
1724
1725         priv->absolute_mode = absolute_mode;
1726         if (SYN_ID_DISGEST_SUPPORTED(priv->identity))
1727                 priv->disable_gesture = true;
1728
1729         if (synaptics_set_mode(psmouse)) {
1730                 psmouse_err(psmouse, "Unable to initialize device.\n");
1731                 goto init_fail;
1732         }
1733
1734         priv->pkt_type = SYN_MODEL_NEWABS(priv->model_id) ? SYN_NEWABS : SYN_OLDABS;
1735
1736         psmouse_info(psmouse,
1737                      "Touchpad model: %ld, fw: %ld.%ld, id: %#lx, caps: %#lx/%#lx/%#lx, board id: %lu, fw id: %lu\n",
1738                      SYN_ID_MODEL(priv->identity),
1739                      SYN_ID_MAJOR(priv->identity), SYN_ID_MINOR(priv->identity),
1740                      priv->model_id,
1741                      priv->capabilities, priv->ext_cap, priv->ext_cap_0c,
1742                      priv->board_id, priv->firmware_id);
1743
1744         set_input_params(psmouse, priv);
1745
1746         /*
1747          * Encode touchpad model so that it can be used to set
1748          * input device->id.version and be visible to userspace.
1749          * Because version is __u16 we have to drop something.
1750          * Hardware info bits seem to be good candidates as they
1751          * are documented to be for Synaptics corp. internal use.
1752          */
1753         psmouse->model = ((priv->model_id & 0x00ff0000) >> 8) |
1754                           (priv->model_id & 0x000000ff);
1755
1756         if (absolute_mode) {
1757                 psmouse->protocol_handler = synaptics_process_byte;
1758                 psmouse->pktsize = 6;
1759         } else {
1760                 /* Relative mode follows standard PS/2 mouse protocol */
1761                 psmouse->protocol_handler = psmouse_process_byte;
1762                 psmouse->pktsize = 3;
1763         }
1764
1765         psmouse->set_rate = synaptics_set_rate;
1766         psmouse->disconnect = synaptics_disconnect;
1767         psmouse->reconnect = synaptics_reconnect;
1768         psmouse->cleanup = synaptics_reset;
1769         /* Synaptics can usually stay in sync without extra help */
1770         psmouse->resync_time = 0;
1771
1772         if (SYN_CAP_PASS_THROUGH(priv->capabilities))
1773                 synaptics_pt_create(psmouse);
1774
1775         /*
1776          * Toshiba's KBC seems to have trouble handling data from
1777          * Synaptics at full rate.  Switch to a lower rate (roughly
1778          * the same rate as a standard PS/2 mouse).
1779          */
1780         if (psmouse->rate >= 80 && impaired_toshiba_kbc) {
1781                 psmouse_info(psmouse,
1782                              "Toshiba %s detected, limiting rate to 40pps.\n",
1783                              dmi_get_system_info(DMI_PRODUCT_NAME));
1784                 psmouse->rate = 40;
1785         }
1786
1787         if (!priv->absolute_mode && SYN_ID_DISGEST_SUPPORTED(priv->identity)) {
1788                 err = device_create_file(&psmouse->ps2dev.serio->dev,
1789                                          &psmouse_attr_disable_gesture.dattr);
1790                 if (err) {
1791                         psmouse_err(psmouse,
1792                                     "Failed to create disable_gesture attribute (%d)",
1793                                     err);
1794                         goto init_fail;
1795                 }
1796         }
1797
1798         return 0;
1799
1800  init_fail:
1801         kfree(priv);
1802         return err;
1803 }
1804
1805 int synaptics_init(struct psmouse *psmouse)
1806 {
1807         return __synaptics_init(psmouse, true);
1808 }
1809
1810 int synaptics_init_relative(struct psmouse *psmouse)
1811 {
1812         return __synaptics_init(psmouse, false);
1813 }
1814
1815 bool synaptics_supported(void)
1816 {
1817         return true;
1818 }
1819
1820 #else /* CONFIG_MOUSE_PS2_SYNAPTICS */
1821
1822 void __init synaptics_module_init(void)
1823 {
1824 }
1825
1826 int synaptics_init(struct psmouse *psmouse)
1827 {
1828         return -ENOSYS;
1829 }
1830
1831 bool synaptics_supported(void)
1832 {
1833         return false;
1834 }
1835
1836 #endif /* CONFIG_MOUSE_PS2_SYNAPTICS */