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