synaptics.c 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958
  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. #include <linux/module.h>
  26. #include <linux/dmi.h>
  27. #include <linux/input/mt.h>
  28. #include <linux/serio.h>
  29. #include <linux/libps2.h>
  30. #include <linux/slab.h>
  31. #include "psmouse.h"
  32. #include "synaptics.h"
  33. /*
  34. * The x/y limits are taken from the Synaptics TouchPad interfacing Guide,
  35. * section 2.3.2, which says that they should be valid regardless of the
  36. * actual size of the sensor.
  37. * Note that newer firmware allows querying device for maximum useable
  38. * coordinates.
  39. */
  40. #define XMIN_NOMINAL 1472
  41. #define XMAX_NOMINAL 5472
  42. #define YMIN_NOMINAL 1408
  43. #define YMAX_NOMINAL 4448
  44. /*****************************************************************************
  45. * Stuff we need even when we do not want native Synaptics support
  46. ****************************************************************************/
  47. /*
  48. * Set the synaptics touchpad mode byte by special commands
  49. */
  50. static int synaptics_mode_cmd(struct psmouse *psmouse, unsigned char mode)
  51. {
  52. unsigned char param[1];
  53. if (psmouse_sliced_command(psmouse, mode))
  54. return -1;
  55. param[0] = SYN_PS_SET_MODE2;
  56. if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_SETRATE))
  57. return -1;
  58. return 0;
  59. }
  60. int synaptics_detect(struct psmouse *psmouse, bool set_properties)
  61. {
  62. struct ps2dev *ps2dev = &psmouse->ps2dev;
  63. unsigned char param[4];
  64. param[0] = 0;
  65. ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
  66. ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
  67. ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
  68. ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
  69. ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO);
  70. if (param[1] != 0x47)
  71. return -ENODEV;
  72. if (set_properties) {
  73. psmouse->vendor = "Synaptics";
  74. psmouse->name = "TouchPad";
  75. }
  76. return 0;
  77. }
  78. void synaptics_reset(struct psmouse *psmouse)
  79. {
  80. /* reset touchpad back to relative mode, gestures enabled */
  81. synaptics_mode_cmd(psmouse, 0);
  82. }
  83. #ifdef CONFIG_MOUSE_PS2_SYNAPTICS
  84. /*****************************************************************************
  85. * Synaptics communications functions
  86. ****************************************************************************/
  87. /*
  88. * Send a command to the synpatics touchpad by special commands
  89. */
  90. static int synaptics_send_cmd(struct psmouse *psmouse, unsigned char c, unsigned char *param)
  91. {
  92. if (psmouse_sliced_command(psmouse, c))
  93. return -1;
  94. if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETINFO))
  95. return -1;
  96. return 0;
  97. }
  98. /*
  99. * Read the model-id bytes from the touchpad
  100. * see also SYN_MODEL_* macros
  101. */
  102. static int synaptics_model_id(struct psmouse *psmouse)
  103. {
  104. struct synaptics_data *priv = psmouse->private;
  105. unsigned char mi[3];
  106. if (synaptics_send_cmd(psmouse, SYN_QUE_MODEL, mi))
  107. return -1;
  108. priv->model_id = (mi[0]<<16) | (mi[1]<<8) | mi[2];
  109. return 0;
  110. }
  111. /*
  112. * Read the capability-bits from the touchpad
  113. * see also the SYN_CAP_* macros
  114. */
  115. static int synaptics_capability(struct psmouse *psmouse)
  116. {
  117. struct synaptics_data *priv = psmouse->private;
  118. unsigned char cap[3];
  119. if (synaptics_send_cmd(psmouse, SYN_QUE_CAPABILITIES, cap))
  120. return -1;
  121. priv->capabilities = (cap[0] << 16) | (cap[1] << 8) | cap[2];
  122. priv->ext_cap = priv->ext_cap_0c = 0;
  123. /*
  124. * Older firmwares had submodel ID fixed to 0x47
  125. */
  126. if (SYN_ID_FULL(priv->identity) < 0x705 &&
  127. SYN_CAP_SUBMODEL_ID(priv->capabilities) != 0x47) {
  128. return -1;
  129. }
  130. /*
  131. * Unless capExtended is set the rest of the flags should be ignored
  132. */
  133. if (!SYN_CAP_EXTENDED(priv->capabilities))
  134. priv->capabilities = 0;
  135. if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 1) {
  136. if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB, cap)) {
  137. printk(KERN_ERR "Synaptics claims to have extended capabilities,"
  138. " but I'm not able to read them.\n");
  139. } else {
  140. priv->ext_cap = (cap[0] << 16) | (cap[1] << 8) | cap[2];
  141. /*
  142. * if nExtBtn is greater than 8 it should be considered
  143. * invalid and treated as 0
  144. */
  145. if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) > 8)
  146. priv->ext_cap &= 0xff0fff;
  147. }
  148. }
  149. if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 4) {
  150. if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB_0C, cap)) {
  151. printk(KERN_ERR "Synaptics claims to have extended capability 0x0c,"
  152. " but I'm not able to read it.\n");
  153. } else {
  154. priv->ext_cap_0c = (cap[0] << 16) | (cap[1] << 8) | cap[2];
  155. }
  156. }
  157. return 0;
  158. }
  159. /*
  160. * Identify Touchpad
  161. * See also the SYN_ID_* macros
  162. */
  163. static int synaptics_identify(struct psmouse *psmouse)
  164. {
  165. struct synaptics_data *priv = psmouse->private;
  166. unsigned char id[3];
  167. if (synaptics_send_cmd(psmouse, SYN_QUE_IDENTIFY, id))
  168. return -1;
  169. priv->identity = (id[0]<<16) | (id[1]<<8) | id[2];
  170. if (SYN_ID_IS_SYNAPTICS(priv->identity))
  171. return 0;
  172. return -1;
  173. }
  174. /*
  175. * Read touchpad resolution and maximum reported coordinates
  176. * Resolution is left zero if touchpad does not support the query
  177. */
  178. static int synaptics_resolution(struct psmouse *psmouse)
  179. {
  180. struct synaptics_data *priv = psmouse->private;
  181. unsigned char res[3];
  182. unsigned char max[3];
  183. if (SYN_ID_MAJOR(priv->identity) < 4)
  184. return 0;
  185. if (synaptics_send_cmd(psmouse, SYN_QUE_RESOLUTION, res) == 0) {
  186. if (res[0] != 0 && (res[1] & 0x80) && res[2] != 0) {
  187. priv->x_res = res[0]; /* x resolution in units/mm */
  188. priv->y_res = res[2]; /* y resolution in units/mm */
  189. }
  190. }
  191. if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 5 &&
  192. SYN_CAP_MAX_DIMENSIONS(priv->ext_cap_0c)) {
  193. if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_DIMENSIONS, max)) {
  194. printk(KERN_ERR "Synaptics claims to have dimensions query,"
  195. " but I'm not able to read it.\n");
  196. } else {
  197. priv->x_max = (max[0] << 5) | ((max[1] & 0x0f) << 1);
  198. priv->y_max = (max[2] << 5) | ((max[1] & 0xf0) >> 3);
  199. }
  200. }
  201. return 0;
  202. }
  203. static int synaptics_query_hardware(struct psmouse *psmouse)
  204. {
  205. if (synaptics_identify(psmouse))
  206. return -1;
  207. if (synaptics_model_id(psmouse))
  208. return -1;
  209. if (synaptics_capability(psmouse))
  210. return -1;
  211. if (synaptics_resolution(psmouse))
  212. return -1;
  213. return 0;
  214. }
  215. static int synaptics_set_absolute_mode(struct psmouse *psmouse)
  216. {
  217. struct synaptics_data *priv = psmouse->private;
  218. priv->mode = SYN_BIT_ABSOLUTE_MODE;
  219. if (SYN_ID_MAJOR(priv->identity) >= 4)
  220. priv->mode |= SYN_BIT_DISABLE_GESTURE;
  221. if (SYN_CAP_EXTENDED(priv->capabilities))
  222. priv->mode |= SYN_BIT_W_MODE;
  223. if (synaptics_mode_cmd(psmouse, priv->mode))
  224. return -1;
  225. return 0;
  226. }
  227. static void synaptics_set_rate(struct psmouse *psmouse, unsigned int rate)
  228. {
  229. struct synaptics_data *priv = psmouse->private;
  230. if (rate >= 80) {
  231. priv->mode |= SYN_BIT_HIGH_RATE;
  232. psmouse->rate = 80;
  233. } else {
  234. priv->mode &= ~SYN_BIT_HIGH_RATE;
  235. psmouse->rate = 40;
  236. }
  237. synaptics_mode_cmd(psmouse, priv->mode);
  238. }
  239. static int synaptics_set_advanced_gesture_mode(struct psmouse *psmouse)
  240. {
  241. static unsigned char param = 0xc8;
  242. struct synaptics_data *priv = psmouse->private;
  243. if (!SYN_CAP_ADV_GESTURE(priv->ext_cap_0c))
  244. return 0;
  245. if (psmouse_sliced_command(psmouse, SYN_QUE_MODEL))
  246. return -1;
  247. if (ps2_command(&psmouse->ps2dev, &param, PSMOUSE_CMD_SETRATE))
  248. return -1;
  249. /* Advanced gesture mode also sends multi finger data */
  250. priv->capabilities |= BIT(1);
  251. return 0;
  252. }
  253. /*****************************************************************************
  254. * Synaptics pass-through PS/2 port support
  255. ****************************************************************************/
  256. static int synaptics_pt_write(struct serio *serio, unsigned char c)
  257. {
  258. struct psmouse *parent = serio_get_drvdata(serio->parent);
  259. char rate_param = SYN_PS_CLIENT_CMD; /* indicates that we want pass-through port */
  260. if (psmouse_sliced_command(parent, c))
  261. return -1;
  262. if (ps2_command(&parent->ps2dev, &rate_param, PSMOUSE_CMD_SETRATE))
  263. return -1;
  264. return 0;
  265. }
  266. static int synaptics_pt_start(struct serio *serio)
  267. {
  268. struct psmouse *parent = serio_get_drvdata(serio->parent);
  269. struct synaptics_data *priv = parent->private;
  270. serio_pause_rx(parent->ps2dev.serio);
  271. priv->pt_port = serio;
  272. serio_continue_rx(parent->ps2dev.serio);
  273. return 0;
  274. }
  275. static void synaptics_pt_stop(struct serio *serio)
  276. {
  277. struct psmouse *parent = serio_get_drvdata(serio->parent);
  278. struct synaptics_data *priv = parent->private;
  279. serio_pause_rx(parent->ps2dev.serio);
  280. priv->pt_port = NULL;
  281. serio_continue_rx(parent->ps2dev.serio);
  282. }
  283. static int synaptics_is_pt_packet(unsigned char *buf)
  284. {
  285. return (buf[0] & 0xFC) == 0x84 && (buf[3] & 0xCC) == 0xC4;
  286. }
  287. static void synaptics_pass_pt_packet(struct serio *ptport, unsigned char *packet)
  288. {
  289. struct psmouse *child = serio_get_drvdata(ptport);
  290. if (child && child->state == PSMOUSE_ACTIVATED) {
  291. serio_interrupt(ptport, packet[1], 0);
  292. serio_interrupt(ptport, packet[4], 0);
  293. serio_interrupt(ptport, packet[5], 0);
  294. if (child->pktsize == 4)
  295. serio_interrupt(ptport, packet[2], 0);
  296. } else
  297. serio_interrupt(ptport, packet[1], 0);
  298. }
  299. static void synaptics_pt_activate(struct psmouse *psmouse)
  300. {
  301. struct synaptics_data *priv = psmouse->private;
  302. struct psmouse *child = serio_get_drvdata(priv->pt_port);
  303. /* adjust the touchpad to child's choice of protocol */
  304. if (child) {
  305. if (child->pktsize == 4)
  306. priv->mode |= SYN_BIT_FOUR_BYTE_CLIENT;
  307. else
  308. priv->mode &= ~SYN_BIT_FOUR_BYTE_CLIENT;
  309. if (synaptics_mode_cmd(psmouse, priv->mode))
  310. printk(KERN_INFO "synaptics: failed to switch guest protocol\n");
  311. }
  312. }
  313. static void synaptics_pt_create(struct psmouse *psmouse)
  314. {
  315. struct serio *serio;
  316. serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
  317. if (!serio) {
  318. printk(KERN_ERR "synaptics: not enough memory to allocate pass-through port\n");
  319. return;
  320. }
  321. serio->id.type = SERIO_PS_PSTHRU;
  322. strlcpy(serio->name, "Synaptics pass-through", sizeof(serio->name));
  323. strlcpy(serio->phys, "synaptics-pt/serio0", sizeof(serio->name));
  324. serio->write = synaptics_pt_write;
  325. serio->start = synaptics_pt_start;
  326. serio->stop = synaptics_pt_stop;
  327. serio->parent = psmouse->ps2dev.serio;
  328. psmouse->pt_activate = synaptics_pt_activate;
  329. printk(KERN_INFO "serio: %s port at %s\n", serio->name, psmouse->phys);
  330. serio_register_port(serio);
  331. }
  332. /*****************************************************************************
  333. * Functions to interpret the absolute mode packets
  334. ****************************************************************************/
  335. static int synaptics_parse_hw_state(const unsigned char buf[],
  336. struct synaptics_data *priv,
  337. struct synaptics_hw_state *hw)
  338. {
  339. memset(hw, 0, sizeof(struct synaptics_hw_state));
  340. if (SYN_MODEL_NEWABS(priv->model_id)) {
  341. hw->x = (((buf[3] & 0x10) << 8) |
  342. ((buf[1] & 0x0f) << 8) |
  343. buf[4]);
  344. hw->y = (((buf[3] & 0x20) << 7) |
  345. ((buf[1] & 0xf0) << 4) |
  346. buf[5]);
  347. hw->z = buf[2];
  348. hw->w = (((buf[0] & 0x30) >> 2) |
  349. ((buf[0] & 0x04) >> 1) |
  350. ((buf[3] & 0x04) >> 2));
  351. if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c) && hw->w == 2) {
  352. /* Gesture packet: (x, y, z) at half resolution */
  353. priv->mt.x = (((buf[4] & 0x0f) << 8) | buf[1]) << 1;
  354. priv->mt.y = (((buf[4] & 0xf0) << 4) | buf[2]) << 1;
  355. priv->mt.z = ((buf[3] & 0x30) | (buf[5] & 0x0f)) << 1;
  356. return 1;
  357. }
  358. hw->left = (buf[0] & 0x01) ? 1 : 0;
  359. hw->right = (buf[0] & 0x02) ? 1 : 0;
  360. if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
  361. /*
  362. * Clickpad's button is transmitted as middle button,
  363. * however, since it is primary button, we will report
  364. * it as BTN_LEFT.
  365. */
  366. hw->left = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
  367. } else if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
  368. hw->middle = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
  369. if (hw->w == 2)
  370. hw->scroll = (signed char)(buf[1]);
  371. }
  372. if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
  373. hw->up = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
  374. hw->down = ((buf[0] ^ buf[3]) & 0x02) ? 1 : 0;
  375. }
  376. if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) &&
  377. ((buf[0] ^ buf[3]) & 0x02)) {
  378. switch (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) & ~0x01) {
  379. default:
  380. /*
  381. * if nExtBtn is greater than 8 it should be
  382. * considered invalid and treated as 0
  383. */
  384. break;
  385. case 8:
  386. hw->ext_buttons |= ((buf[5] & 0x08)) ? 0x80 : 0;
  387. hw->ext_buttons |= ((buf[4] & 0x08)) ? 0x40 : 0;
  388. case 6:
  389. hw->ext_buttons |= ((buf[5] & 0x04)) ? 0x20 : 0;
  390. hw->ext_buttons |= ((buf[4] & 0x04)) ? 0x10 : 0;
  391. case 4:
  392. hw->ext_buttons |= ((buf[5] & 0x02)) ? 0x08 : 0;
  393. hw->ext_buttons |= ((buf[4] & 0x02)) ? 0x04 : 0;
  394. case 2:
  395. hw->ext_buttons |= ((buf[5] & 0x01)) ? 0x02 : 0;
  396. hw->ext_buttons |= ((buf[4] & 0x01)) ? 0x01 : 0;
  397. }
  398. }
  399. } else {
  400. hw->x = (((buf[1] & 0x1f) << 8) | buf[2]);
  401. hw->y = (((buf[4] & 0x1f) << 8) | buf[5]);
  402. hw->z = (((buf[0] & 0x30) << 2) | (buf[3] & 0x3F));
  403. hw->w = (((buf[1] & 0x80) >> 4) | ((buf[0] & 0x04) >> 1));
  404. hw->left = (buf[0] & 0x01) ? 1 : 0;
  405. hw->right = (buf[0] & 0x02) ? 1 : 0;
  406. }
  407. return 0;
  408. }
  409. static void set_slot(struct input_dev *dev, int slot, bool active, int x, int y)
  410. {
  411. input_mt_slot(dev, slot);
  412. input_mt_report_slot_state(dev, MT_TOOL_FINGER, active);
  413. if (active) {
  414. input_report_abs(dev, ABS_MT_POSITION_X, x);
  415. input_report_abs(dev, ABS_MT_POSITION_Y,
  416. YMAX_NOMINAL + YMIN_NOMINAL - y);
  417. }
  418. }
  419. static void synaptics_report_semi_mt_data(struct input_dev *dev,
  420. const struct synaptics_hw_state *a,
  421. const struct synaptics_hw_state *b,
  422. int num_fingers)
  423. {
  424. if (num_fingers >= 2) {
  425. set_slot(dev, 0, true, min(a->x, b->x), min(a->y, b->y));
  426. set_slot(dev, 1, true, max(a->x, b->x), max(a->y, b->y));
  427. } else if (num_fingers == 1) {
  428. set_slot(dev, 0, true, a->x, a->y);
  429. set_slot(dev, 1, false, 0, 0);
  430. } else {
  431. set_slot(dev, 0, false, 0, 0);
  432. set_slot(dev, 1, false, 0, 0);
  433. }
  434. }
  435. /*
  436. * called for each full received packet from the touchpad
  437. */
  438. static void synaptics_process_packet(struct psmouse *psmouse)
  439. {
  440. struct input_dev *dev = psmouse->dev;
  441. struct synaptics_data *priv = psmouse->private;
  442. struct synaptics_hw_state hw;
  443. int num_fingers;
  444. int finger_width;
  445. int i;
  446. if (synaptics_parse_hw_state(psmouse->packet, priv, &hw))
  447. return;
  448. if (hw.scroll) {
  449. priv->scroll += hw.scroll;
  450. while (priv->scroll >= 4) {
  451. input_report_key(dev, BTN_BACK, !hw.down);
  452. input_sync(dev);
  453. input_report_key(dev, BTN_BACK, hw.down);
  454. input_sync(dev);
  455. priv->scroll -= 4;
  456. }
  457. while (priv->scroll <= -4) {
  458. input_report_key(dev, BTN_FORWARD, !hw.up);
  459. input_sync(dev);
  460. input_report_key(dev, BTN_FORWARD, hw.up);
  461. input_sync(dev);
  462. priv->scroll += 4;
  463. }
  464. return;
  465. }
  466. if (hw.z > 0 && hw.x > 1) {
  467. num_fingers = 1;
  468. finger_width = 5;
  469. if (SYN_CAP_EXTENDED(priv->capabilities)) {
  470. switch (hw.w) {
  471. case 0 ... 1:
  472. if (SYN_CAP_MULTIFINGER(priv->capabilities))
  473. num_fingers = hw.w + 2;
  474. break;
  475. case 2:
  476. if (SYN_MODEL_PEN(priv->model_id))
  477. ; /* Nothing, treat a pen as a single finger */
  478. break;
  479. case 4 ... 15:
  480. if (SYN_CAP_PALMDETECT(priv->capabilities))
  481. finger_width = hw.w;
  482. break;
  483. }
  484. }
  485. } else {
  486. num_fingers = 0;
  487. finger_width = 0;
  488. }
  489. if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c))
  490. synaptics_report_semi_mt_data(dev, &hw, &priv->mt, num_fingers);
  491. /* Post events
  492. * BTN_TOUCH has to be first as mousedev relies on it when doing
  493. * absolute -> relative conversion
  494. */
  495. if (hw.z > 30) input_report_key(dev, BTN_TOUCH, 1);
  496. if (hw.z < 25) input_report_key(dev, BTN_TOUCH, 0);
  497. if (num_fingers > 0) {
  498. input_report_abs(dev, ABS_X, hw.x);
  499. input_report_abs(dev, ABS_Y, YMAX_NOMINAL + YMIN_NOMINAL - hw.y);
  500. }
  501. input_report_abs(dev, ABS_PRESSURE, hw.z);
  502. if (SYN_CAP_PALMDETECT(priv->capabilities))
  503. input_report_abs(dev, ABS_TOOL_WIDTH, finger_width);
  504. input_report_key(dev, BTN_TOOL_FINGER, num_fingers == 1);
  505. input_report_key(dev, BTN_LEFT, hw.left);
  506. input_report_key(dev, BTN_RIGHT, hw.right);
  507. if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
  508. input_report_key(dev, BTN_TOOL_DOUBLETAP, num_fingers == 2);
  509. input_report_key(dev, BTN_TOOL_TRIPLETAP, num_fingers == 3);
  510. }
  511. if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
  512. input_report_key(dev, BTN_MIDDLE, hw.middle);
  513. if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
  514. input_report_key(dev, BTN_FORWARD, hw.up);
  515. input_report_key(dev, BTN_BACK, hw.down);
  516. }
  517. for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
  518. input_report_key(dev, BTN_0 + i, hw.ext_buttons & (1 << i));
  519. input_sync(dev);
  520. }
  521. static int synaptics_validate_byte(unsigned char packet[], int idx, unsigned char pkt_type)
  522. {
  523. static const unsigned char newabs_mask[] = { 0xC8, 0x00, 0x00, 0xC8, 0x00 };
  524. static const unsigned char newabs_rel_mask[] = { 0xC0, 0x00, 0x00, 0xC0, 0x00 };
  525. static const unsigned char newabs_rslt[] = { 0x80, 0x00, 0x00, 0xC0, 0x00 };
  526. static const unsigned char oldabs_mask[] = { 0xC0, 0x60, 0x00, 0xC0, 0x60 };
  527. static const unsigned char oldabs_rslt[] = { 0xC0, 0x00, 0x00, 0x80, 0x00 };
  528. if (idx < 0 || idx > 4)
  529. return 0;
  530. switch (pkt_type) {
  531. case SYN_NEWABS:
  532. case SYN_NEWABS_RELAXED:
  533. return (packet[idx] & newabs_rel_mask[idx]) == newabs_rslt[idx];
  534. case SYN_NEWABS_STRICT:
  535. return (packet[idx] & newabs_mask[idx]) == newabs_rslt[idx];
  536. case SYN_OLDABS:
  537. return (packet[idx] & oldabs_mask[idx]) == oldabs_rslt[idx];
  538. default:
  539. printk(KERN_ERR "synaptics: unknown packet type %d\n", pkt_type);
  540. return 0;
  541. }
  542. }
  543. static unsigned char synaptics_detect_pkt_type(struct psmouse *psmouse)
  544. {
  545. int i;
  546. for (i = 0; i < 5; i++)
  547. if (!synaptics_validate_byte(psmouse->packet, i, SYN_NEWABS_STRICT)) {
  548. printk(KERN_INFO "synaptics: using relaxed packet validation\n");
  549. return SYN_NEWABS_RELAXED;
  550. }
  551. return SYN_NEWABS_STRICT;
  552. }
  553. static psmouse_ret_t synaptics_process_byte(struct psmouse *psmouse)
  554. {
  555. struct synaptics_data *priv = psmouse->private;
  556. if (psmouse->pktcnt >= 6) { /* Full packet received */
  557. if (unlikely(priv->pkt_type == SYN_NEWABS))
  558. priv->pkt_type = synaptics_detect_pkt_type(psmouse);
  559. if (SYN_CAP_PASS_THROUGH(priv->capabilities) &&
  560. synaptics_is_pt_packet(psmouse->packet)) {
  561. if (priv->pt_port)
  562. synaptics_pass_pt_packet(priv->pt_port, psmouse->packet);
  563. } else
  564. synaptics_process_packet(psmouse);
  565. return PSMOUSE_FULL_PACKET;
  566. }
  567. return synaptics_validate_byte(psmouse->packet, psmouse->pktcnt - 1, priv->pkt_type) ?
  568. PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
  569. }
  570. /*****************************************************************************
  571. * Driver initialization/cleanup functions
  572. ****************************************************************************/
  573. static void set_input_params(struct input_dev *dev, struct synaptics_data *priv)
  574. {
  575. int i;
  576. __set_bit(INPUT_PROP_POINTER, dev->propbit);
  577. __set_bit(EV_ABS, dev->evbit);
  578. input_set_abs_params(dev, ABS_X,
  579. XMIN_NOMINAL, priv->x_max ?: XMAX_NOMINAL, 0, 0);
  580. input_set_abs_params(dev, ABS_Y,
  581. YMIN_NOMINAL, priv->y_max ?: YMAX_NOMINAL, 0, 0);
  582. input_set_abs_params(dev, ABS_PRESSURE, 0, 255, 0, 0);
  583. if (SYN_CAP_ADV_GESTURE(priv->ext_cap_0c)) {
  584. __set_bit(INPUT_PROP_SEMI_MT, dev->propbit);
  585. input_mt_init_slots(dev, 2);
  586. input_set_abs_params(dev, ABS_MT_POSITION_X, XMIN_NOMINAL,
  587. priv->x_max ?: XMAX_NOMINAL, 0, 0);
  588. input_set_abs_params(dev, ABS_MT_POSITION_Y, YMIN_NOMINAL,
  589. priv->y_max ?: YMAX_NOMINAL, 0, 0);
  590. }
  591. if (SYN_CAP_PALMDETECT(priv->capabilities))
  592. input_set_abs_params(dev, ABS_TOOL_WIDTH, 0, 15, 0, 0);
  593. __set_bit(EV_KEY, dev->evbit);
  594. __set_bit(BTN_TOUCH, dev->keybit);
  595. __set_bit(BTN_TOOL_FINGER, dev->keybit);
  596. __set_bit(BTN_LEFT, dev->keybit);
  597. __set_bit(BTN_RIGHT, dev->keybit);
  598. if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
  599. __set_bit(BTN_TOOL_DOUBLETAP, dev->keybit);
  600. __set_bit(BTN_TOOL_TRIPLETAP, dev->keybit);
  601. }
  602. if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
  603. __set_bit(BTN_MIDDLE, dev->keybit);
  604. if (SYN_CAP_FOUR_BUTTON(priv->capabilities) ||
  605. SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
  606. __set_bit(BTN_FORWARD, dev->keybit);
  607. __set_bit(BTN_BACK, dev->keybit);
  608. }
  609. for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
  610. __set_bit(BTN_0 + i, dev->keybit);
  611. __clear_bit(EV_REL, dev->evbit);
  612. __clear_bit(REL_X, dev->relbit);
  613. __clear_bit(REL_Y, dev->relbit);
  614. input_abs_set_res(dev, ABS_X, priv->x_res);
  615. input_abs_set_res(dev, ABS_Y, priv->y_res);
  616. if (SYN_CAP_CLICKPAD(priv->ext_cap_0c)) {
  617. __set_bit(INPUT_PROP_BUTTONPAD, dev->propbit);
  618. /* Clickpads report only left button */
  619. __clear_bit(BTN_RIGHT, dev->keybit);
  620. __clear_bit(BTN_MIDDLE, dev->keybit);
  621. }
  622. }
  623. static void synaptics_disconnect(struct psmouse *psmouse)
  624. {
  625. synaptics_reset(psmouse);
  626. kfree(psmouse->private);
  627. psmouse->private = NULL;
  628. }
  629. static int synaptics_reconnect(struct psmouse *psmouse)
  630. {
  631. struct synaptics_data *priv = psmouse->private;
  632. struct synaptics_data old_priv = *priv;
  633. psmouse_reset(psmouse);
  634. if (synaptics_detect(psmouse, 0))
  635. return -1;
  636. if (synaptics_query_hardware(psmouse)) {
  637. printk(KERN_ERR "Unable to query Synaptics hardware.\n");
  638. return -1;
  639. }
  640. if (old_priv.identity != priv->identity ||
  641. old_priv.model_id != priv->model_id ||
  642. old_priv.capabilities != priv->capabilities ||
  643. old_priv.ext_cap != priv->ext_cap)
  644. return -1;
  645. if (synaptics_set_absolute_mode(psmouse)) {
  646. printk(KERN_ERR "Unable to initialize Synaptics hardware.\n");
  647. return -1;
  648. }
  649. if (synaptics_set_advanced_gesture_mode(psmouse)) {
  650. printk(KERN_ERR "Advanced gesture mode reconnect failed.\n");
  651. return -1;
  652. }
  653. return 0;
  654. }
  655. static bool impaired_toshiba_kbc;
  656. static const struct dmi_system_id __initconst toshiba_dmi_table[] = {
  657. #if defined(CONFIG_DMI) && defined(CONFIG_X86)
  658. {
  659. /* Toshiba Satellite */
  660. .matches = {
  661. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  662. DMI_MATCH(DMI_PRODUCT_NAME, "Satellite"),
  663. },
  664. },
  665. {
  666. /* Toshiba Dynabook */
  667. .matches = {
  668. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  669. DMI_MATCH(DMI_PRODUCT_NAME, "dynabook"),
  670. },
  671. },
  672. {
  673. /* Toshiba Portege M300 */
  674. .matches = {
  675. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  676. DMI_MATCH(DMI_PRODUCT_NAME, "PORTEGE M300"),
  677. },
  678. },
  679. {
  680. /* Toshiba Portege M300 */
  681. .matches = {
  682. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  683. DMI_MATCH(DMI_PRODUCT_NAME, "Portable PC"),
  684. DMI_MATCH(DMI_PRODUCT_VERSION, "Version 1.0"),
  685. },
  686. },
  687. { }
  688. #endif
  689. };
  690. static bool broken_olpc_ec;
  691. static const struct dmi_system_id __initconst olpc_dmi_table[] = {
  692. #if defined(CONFIG_DMI) && defined(CONFIG_OLPC)
  693. {
  694. /* OLPC XO-1 or XO-1.5 */
  695. .matches = {
  696. DMI_MATCH(DMI_SYS_VENDOR, "OLPC"),
  697. DMI_MATCH(DMI_PRODUCT_NAME, "XO"),
  698. },
  699. },
  700. { }
  701. #endif
  702. };
  703. void __init synaptics_module_init(void)
  704. {
  705. impaired_toshiba_kbc = dmi_check_system(toshiba_dmi_table);
  706. broken_olpc_ec = dmi_check_system(olpc_dmi_table);
  707. }
  708. int synaptics_init(struct psmouse *psmouse)
  709. {
  710. struct synaptics_data *priv;
  711. /*
  712. * The OLPC XO has issues with Synaptics' absolute mode; similarly to
  713. * the HGPK, it quickly degrades and the hardware becomes jumpy and
  714. * overly sensitive. Not only that, but the constant packet spew
  715. * (even at a lowered 40pps rate) overloads the EC such that key
  716. * presses on the keyboard are missed. Given all of that, don't
  717. * even attempt to use Synaptics mode. Relative mode seems to work
  718. * just fine.
  719. */
  720. if (broken_olpc_ec) {
  721. printk(KERN_INFO "synaptics: OLPC XO detected, not enabling Synaptics protocol.\n");
  722. return -ENODEV;
  723. }
  724. psmouse->private = priv = kzalloc(sizeof(struct synaptics_data), GFP_KERNEL);
  725. if (!priv)
  726. return -ENOMEM;
  727. psmouse_reset(psmouse);
  728. if (synaptics_query_hardware(psmouse)) {
  729. printk(KERN_ERR "Unable to query Synaptics hardware.\n");
  730. goto init_fail;
  731. }
  732. if (synaptics_set_absolute_mode(psmouse)) {
  733. printk(KERN_ERR "Unable to initialize Synaptics hardware.\n");
  734. goto init_fail;
  735. }
  736. if (synaptics_set_advanced_gesture_mode(psmouse)) {
  737. printk(KERN_ERR "Advanced gesture mode init failed.\n");
  738. goto init_fail;
  739. }
  740. priv->pkt_type = SYN_MODEL_NEWABS(priv->model_id) ? SYN_NEWABS : SYN_OLDABS;
  741. printk(KERN_INFO "Synaptics Touchpad, model: %ld, fw: %ld.%ld, id: %#lx, caps: %#lx/%#lx/%#lx\n",
  742. SYN_ID_MODEL(priv->identity),
  743. SYN_ID_MAJOR(priv->identity), SYN_ID_MINOR(priv->identity),
  744. priv->model_id, priv->capabilities, priv->ext_cap, priv->ext_cap_0c);
  745. set_input_params(psmouse->dev, priv);
  746. /*
  747. * Encode touchpad model so that it can be used to set
  748. * input device->id.version and be visible to userspace.
  749. * Because version is __u16 we have to drop something.
  750. * Hardware info bits seem to be good candidates as they
  751. * are documented to be for Synaptics corp. internal use.
  752. */
  753. psmouse->model = ((priv->model_id & 0x00ff0000) >> 8) |
  754. (priv->model_id & 0x000000ff);
  755. psmouse->protocol_handler = synaptics_process_byte;
  756. psmouse->set_rate = synaptics_set_rate;
  757. psmouse->disconnect = synaptics_disconnect;
  758. psmouse->reconnect = synaptics_reconnect;
  759. psmouse->cleanup = synaptics_reset;
  760. psmouse->pktsize = 6;
  761. /* Synaptics can usually stay in sync without extra help */
  762. psmouse->resync_time = 0;
  763. if (SYN_CAP_PASS_THROUGH(priv->capabilities))
  764. synaptics_pt_create(psmouse);
  765. /*
  766. * Toshiba's KBC seems to have trouble handling data from
  767. * Synaptics at full rate. Switch to a lower rate (roughly
  768. * the same rate as a standard PS/2 mouse).
  769. */
  770. if (psmouse->rate >= 80 && impaired_toshiba_kbc) {
  771. printk(KERN_INFO "synaptics: Toshiba %s detected, limiting rate to 40pps.\n",
  772. dmi_get_system_info(DMI_PRODUCT_NAME));
  773. psmouse->rate = 40;
  774. }
  775. return 0;
  776. init_fail:
  777. kfree(priv);
  778. return -1;
  779. }
  780. bool synaptics_supported(void)
  781. {
  782. return true;
  783. }
  784. #else /* CONFIG_MOUSE_PS2_SYNAPTICS */
  785. void __init synaptics_module_init(void)
  786. {
  787. }
  788. int synaptics_init(struct psmouse *psmouse)
  789. {
  790. return -ENOSYS;
  791. }
  792. bool synaptics_supported(void)
  793. {
  794. return false;
  795. }
  796. #endif /* CONFIG_MOUSE_PS2_SYNAPTICS */