synaptics.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739
  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/input.h>
  27. #include <linux/serio.h>
  28. #include <linux/libps2.h>
  29. #include "psmouse.h"
  30. #include "synaptics.h"
  31. /*
  32. * The x/y limits are taken from the Synaptics TouchPad interfacing Guide,
  33. * section 2.3.2, which says that they should be valid regardless of the
  34. * actual size of the sensor.
  35. */
  36. #define XMIN_NOMINAL 1472
  37. #define XMAX_NOMINAL 5472
  38. #define YMIN_NOMINAL 1408
  39. #define YMAX_NOMINAL 4448
  40. /*****************************************************************************
  41. * Stuff we need even when we do not want native Synaptics support
  42. ****************************************************************************/
  43. /*
  44. * Set the synaptics touchpad mode byte by special commands
  45. */
  46. static int synaptics_mode_cmd(struct psmouse *psmouse, unsigned char mode)
  47. {
  48. unsigned char param[1];
  49. if (psmouse_sliced_command(psmouse, mode))
  50. return -1;
  51. param[0] = SYN_PS_SET_MODE2;
  52. if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_SETRATE))
  53. return -1;
  54. return 0;
  55. }
  56. int synaptics_detect(struct psmouse *psmouse, int set_properties)
  57. {
  58. struct ps2dev *ps2dev = &psmouse->ps2dev;
  59. unsigned char param[4];
  60. param[0] = 0;
  61. ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
  62. ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
  63. ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
  64. ps2_command(ps2dev, param, PSMOUSE_CMD_SETRES);
  65. ps2_command(ps2dev, param, PSMOUSE_CMD_GETINFO);
  66. if (param[1] != 0x47)
  67. return -ENODEV;
  68. if (set_properties) {
  69. psmouse->vendor = "Synaptics";
  70. psmouse->name = "TouchPad";
  71. }
  72. return 0;
  73. }
  74. void synaptics_reset(struct psmouse *psmouse)
  75. {
  76. /* reset touchpad back to relative mode, gestures enabled */
  77. synaptics_mode_cmd(psmouse, 0);
  78. }
  79. #ifdef CONFIG_MOUSE_PS2_SYNAPTICS
  80. /*****************************************************************************
  81. * Synaptics communications functions
  82. ****************************************************************************/
  83. /*
  84. * Send a command to the synpatics touchpad by special commands
  85. */
  86. static int synaptics_send_cmd(struct psmouse *psmouse, unsigned char c, unsigned char *param)
  87. {
  88. if (psmouse_sliced_command(psmouse, c))
  89. return -1;
  90. if (ps2_command(&psmouse->ps2dev, param, PSMOUSE_CMD_GETINFO))
  91. return -1;
  92. return 0;
  93. }
  94. /*
  95. * Read the model-id bytes from the touchpad
  96. * see also SYN_MODEL_* macros
  97. */
  98. static int synaptics_model_id(struct psmouse *psmouse)
  99. {
  100. struct synaptics_data *priv = psmouse->private;
  101. unsigned char mi[3];
  102. if (synaptics_send_cmd(psmouse, SYN_QUE_MODEL, mi))
  103. return -1;
  104. priv->model_id = (mi[0]<<16) | (mi[1]<<8) | mi[2];
  105. return 0;
  106. }
  107. /*
  108. * Read the capability-bits from the touchpad
  109. * see also the SYN_CAP_* macros
  110. */
  111. static int synaptics_capability(struct psmouse *psmouse)
  112. {
  113. struct synaptics_data *priv = psmouse->private;
  114. unsigned char cap[3];
  115. if (synaptics_send_cmd(psmouse, SYN_QUE_CAPABILITIES, cap))
  116. return -1;
  117. priv->capabilities = (cap[0] << 16) | (cap[1] << 8) | cap[2];
  118. priv->ext_cap = 0;
  119. if (!SYN_CAP_VALID(priv->capabilities))
  120. return -1;
  121. /*
  122. * Unless capExtended is set the rest of the flags should be ignored
  123. */
  124. if (!SYN_CAP_EXTENDED(priv->capabilities))
  125. priv->capabilities = 0;
  126. if (SYN_EXT_CAP_REQUESTS(priv->capabilities) >= 1) {
  127. if (synaptics_send_cmd(psmouse, SYN_QUE_EXT_CAPAB, cap)) {
  128. printk(KERN_ERR "Synaptics claims to have extended capabilities,"
  129. " but I'm not able to read them.");
  130. } else {
  131. priv->ext_cap = (cap[0] << 16) | (cap[1] << 8) | cap[2];
  132. /*
  133. * if nExtBtn is greater than 8 it should be considered
  134. * invalid and treated as 0
  135. */
  136. if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) > 8)
  137. priv->ext_cap &= 0xff0fff;
  138. }
  139. }
  140. return 0;
  141. }
  142. /*
  143. * Identify Touchpad
  144. * See also the SYN_ID_* macros
  145. */
  146. static int synaptics_identify(struct psmouse *psmouse)
  147. {
  148. struct synaptics_data *priv = psmouse->private;
  149. unsigned char id[3];
  150. if (synaptics_send_cmd(psmouse, SYN_QUE_IDENTIFY, id))
  151. return -1;
  152. priv->identity = (id[0]<<16) | (id[1]<<8) | id[2];
  153. if (SYN_ID_IS_SYNAPTICS(priv->identity))
  154. return 0;
  155. return -1;
  156. }
  157. /*
  158. * Read touchpad resolution
  159. * Resolution is left zero if touchpad does not support the query
  160. */
  161. static int synaptics_resolution(struct psmouse *psmouse)
  162. {
  163. struct synaptics_data *priv = psmouse->private;
  164. unsigned char res[3];
  165. if (SYN_ID_MAJOR(priv->identity) < 4)
  166. return 0;
  167. if (synaptics_send_cmd(psmouse, SYN_QUE_RESOLUTION, res))
  168. return 0;
  169. if ((res[0] != 0) && (res[1] & 0x80) && (res[2] != 0)) {
  170. priv->x_res = res[0]; /* x resolution in units/mm */
  171. priv->y_res = res[2]; /* y resolution in units/mm */
  172. }
  173. return 0;
  174. }
  175. static int synaptics_query_hardware(struct psmouse *psmouse)
  176. {
  177. if (synaptics_identify(psmouse))
  178. return -1;
  179. if (synaptics_model_id(psmouse))
  180. return -1;
  181. if (synaptics_capability(psmouse))
  182. return -1;
  183. if (synaptics_resolution(psmouse))
  184. return -1;
  185. return 0;
  186. }
  187. static int synaptics_set_absolute_mode(struct psmouse *psmouse)
  188. {
  189. struct synaptics_data *priv = psmouse->private;
  190. priv->mode = SYN_BIT_ABSOLUTE_MODE;
  191. if (SYN_ID_MAJOR(priv->identity) >= 4)
  192. priv->mode |= SYN_BIT_DISABLE_GESTURE;
  193. if (SYN_CAP_EXTENDED(priv->capabilities))
  194. priv->mode |= SYN_BIT_W_MODE;
  195. if (synaptics_mode_cmd(psmouse, priv->mode))
  196. return -1;
  197. return 0;
  198. }
  199. static void synaptics_set_rate(struct psmouse *psmouse, unsigned int rate)
  200. {
  201. struct synaptics_data *priv = psmouse->private;
  202. if (rate >= 80) {
  203. priv->mode |= SYN_BIT_HIGH_RATE;
  204. psmouse->rate = 80;
  205. } else {
  206. priv->mode &= ~SYN_BIT_HIGH_RATE;
  207. psmouse->rate = 40;
  208. }
  209. synaptics_mode_cmd(psmouse, priv->mode);
  210. }
  211. /*****************************************************************************
  212. * Synaptics pass-through PS/2 port support
  213. ****************************************************************************/
  214. static int synaptics_pt_write(struct serio *serio, unsigned char c)
  215. {
  216. struct psmouse *parent = serio_get_drvdata(serio->parent);
  217. char rate_param = SYN_PS_CLIENT_CMD; /* indicates that we want pass-through port */
  218. if (psmouse_sliced_command(parent, c))
  219. return -1;
  220. if (ps2_command(&parent->ps2dev, &rate_param, PSMOUSE_CMD_SETRATE))
  221. return -1;
  222. return 0;
  223. }
  224. static inline int synaptics_is_pt_packet(unsigned char *buf)
  225. {
  226. return (buf[0] & 0xFC) == 0x84 && (buf[3] & 0xCC) == 0xC4;
  227. }
  228. static void synaptics_pass_pt_packet(struct serio *ptport, unsigned char *packet)
  229. {
  230. struct psmouse *child = serio_get_drvdata(ptport);
  231. if (child && child->state == PSMOUSE_ACTIVATED) {
  232. serio_interrupt(ptport, packet[1], 0);
  233. serio_interrupt(ptport, packet[4], 0);
  234. serio_interrupt(ptport, packet[5], 0);
  235. if (child->pktsize == 4)
  236. serio_interrupt(ptport, packet[2], 0);
  237. } else
  238. serio_interrupt(ptport, packet[1], 0);
  239. }
  240. static void synaptics_pt_activate(struct psmouse *psmouse)
  241. {
  242. struct serio *ptport = psmouse->ps2dev.serio->child;
  243. struct psmouse *child = serio_get_drvdata(ptport);
  244. struct synaptics_data *priv = psmouse->private;
  245. /* adjust the touchpad to child's choice of protocol */
  246. if (child) {
  247. if (child->pktsize == 4)
  248. priv->mode |= SYN_BIT_FOUR_BYTE_CLIENT;
  249. else
  250. priv->mode &= ~SYN_BIT_FOUR_BYTE_CLIENT;
  251. if (synaptics_mode_cmd(psmouse, priv->mode))
  252. printk(KERN_INFO "synaptics: failed to switch guest protocol\n");
  253. }
  254. }
  255. static void synaptics_pt_create(struct psmouse *psmouse)
  256. {
  257. struct serio *serio;
  258. serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
  259. if (!serio) {
  260. printk(KERN_ERR "synaptics: not enough memory to allocate pass-through port\n");
  261. return;
  262. }
  263. serio->id.type = SERIO_PS_PSTHRU;
  264. strlcpy(serio->name, "Synaptics pass-through", sizeof(serio->name));
  265. strlcpy(serio->phys, "synaptics-pt/serio0", sizeof(serio->name));
  266. serio->write = synaptics_pt_write;
  267. serio->parent = psmouse->ps2dev.serio;
  268. psmouse->pt_activate = synaptics_pt_activate;
  269. printk(KERN_INFO "serio: %s port at %s\n", serio->name, psmouse->phys);
  270. serio_register_port(serio);
  271. }
  272. /*****************************************************************************
  273. * Functions to interpret the absolute mode packets
  274. ****************************************************************************/
  275. static void synaptics_parse_hw_state(unsigned char buf[], struct synaptics_data *priv, struct synaptics_hw_state *hw)
  276. {
  277. memset(hw, 0, sizeof(struct synaptics_hw_state));
  278. if (SYN_MODEL_NEWABS(priv->model_id)) {
  279. hw->x = (((buf[3] & 0x10) << 8) |
  280. ((buf[1] & 0x0f) << 8) |
  281. buf[4]);
  282. hw->y = (((buf[3] & 0x20) << 7) |
  283. ((buf[1] & 0xf0) << 4) |
  284. buf[5]);
  285. hw->z = buf[2];
  286. hw->w = (((buf[0] & 0x30) >> 2) |
  287. ((buf[0] & 0x04) >> 1) |
  288. ((buf[3] & 0x04) >> 2));
  289. hw->left = (buf[0] & 0x01) ? 1 : 0;
  290. hw->right = (buf[0] & 0x02) ? 1 : 0;
  291. if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
  292. hw->middle = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
  293. if (hw->w == 2)
  294. hw->scroll = (signed char)(buf[1]);
  295. }
  296. if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
  297. hw->up = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
  298. hw->down = ((buf[0] ^ buf[3]) & 0x02) ? 1 : 0;
  299. }
  300. if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) &&
  301. ((buf[0] ^ buf[3]) & 0x02)) {
  302. switch (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) & ~0x01) {
  303. default:
  304. /*
  305. * if nExtBtn is greater than 8 it should be
  306. * considered invalid and treated as 0
  307. */
  308. break;
  309. case 8:
  310. hw->ext_buttons |= ((buf[5] & 0x08)) ? 0x80 : 0;
  311. hw->ext_buttons |= ((buf[4] & 0x08)) ? 0x40 : 0;
  312. case 6:
  313. hw->ext_buttons |= ((buf[5] & 0x04)) ? 0x20 : 0;
  314. hw->ext_buttons |= ((buf[4] & 0x04)) ? 0x10 : 0;
  315. case 4:
  316. hw->ext_buttons |= ((buf[5] & 0x02)) ? 0x08 : 0;
  317. hw->ext_buttons |= ((buf[4] & 0x02)) ? 0x04 : 0;
  318. case 2:
  319. hw->ext_buttons |= ((buf[5] & 0x01)) ? 0x02 : 0;
  320. hw->ext_buttons |= ((buf[4] & 0x01)) ? 0x01 : 0;
  321. }
  322. }
  323. } else {
  324. hw->x = (((buf[1] & 0x1f) << 8) | buf[2]);
  325. hw->y = (((buf[4] & 0x1f) << 8) | buf[5]);
  326. hw->z = (((buf[0] & 0x30) << 2) | (buf[3] & 0x3F));
  327. hw->w = (((buf[1] & 0x80) >> 4) | ((buf[0] & 0x04) >> 1));
  328. hw->left = (buf[0] & 0x01) ? 1 : 0;
  329. hw->right = (buf[0] & 0x02) ? 1 : 0;
  330. }
  331. }
  332. /*
  333. * called for each full received packet from the touchpad
  334. */
  335. static void synaptics_process_packet(struct psmouse *psmouse)
  336. {
  337. struct input_dev *dev = psmouse->dev;
  338. struct synaptics_data *priv = psmouse->private;
  339. struct synaptics_hw_state hw;
  340. int num_fingers;
  341. int finger_width;
  342. int i;
  343. synaptics_parse_hw_state(psmouse->packet, priv, &hw);
  344. if (hw.scroll) {
  345. priv->scroll += hw.scroll;
  346. while (priv->scroll >= 4) {
  347. input_report_key(dev, BTN_BACK, !hw.down);
  348. input_sync(dev);
  349. input_report_key(dev, BTN_BACK, hw.down);
  350. input_sync(dev);
  351. priv->scroll -= 4;
  352. }
  353. while (priv->scroll <= -4) {
  354. input_report_key(dev, BTN_FORWARD, !hw.up);
  355. input_sync(dev);
  356. input_report_key(dev, BTN_FORWARD, hw.up);
  357. input_sync(dev);
  358. priv->scroll += 4;
  359. }
  360. return;
  361. }
  362. if (hw.z > 0) {
  363. num_fingers = 1;
  364. finger_width = 5;
  365. if (SYN_CAP_EXTENDED(priv->capabilities)) {
  366. switch (hw.w) {
  367. case 0 ... 1:
  368. if (SYN_CAP_MULTIFINGER(priv->capabilities))
  369. num_fingers = hw.w + 2;
  370. break;
  371. case 2:
  372. if (SYN_MODEL_PEN(priv->model_id))
  373. ; /* Nothing, treat a pen as a single finger */
  374. break;
  375. case 4 ... 15:
  376. if (SYN_CAP_PALMDETECT(priv->capabilities))
  377. finger_width = hw.w;
  378. break;
  379. }
  380. }
  381. } else {
  382. num_fingers = 0;
  383. finger_width = 0;
  384. }
  385. /* Post events
  386. * BTN_TOUCH has to be first as mousedev relies on it when doing
  387. * absolute -> relative conversion
  388. */
  389. if (hw.z > 30) input_report_key(dev, BTN_TOUCH, 1);
  390. if (hw.z < 25) input_report_key(dev, BTN_TOUCH, 0);
  391. if (hw.z > 0) {
  392. input_report_abs(dev, ABS_X, hw.x);
  393. input_report_abs(dev, ABS_Y, YMAX_NOMINAL + YMIN_NOMINAL - hw.y);
  394. }
  395. input_report_abs(dev, ABS_PRESSURE, hw.z);
  396. input_report_abs(dev, ABS_TOOL_WIDTH, finger_width);
  397. input_report_key(dev, BTN_TOOL_FINGER, num_fingers == 1);
  398. input_report_key(dev, BTN_LEFT, hw.left);
  399. input_report_key(dev, BTN_RIGHT, hw.right);
  400. if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
  401. input_report_key(dev, BTN_TOOL_DOUBLETAP, num_fingers == 2);
  402. input_report_key(dev, BTN_TOOL_TRIPLETAP, num_fingers == 3);
  403. }
  404. if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
  405. input_report_key(dev, BTN_MIDDLE, hw.middle);
  406. if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
  407. input_report_key(dev, BTN_FORWARD, hw.up);
  408. input_report_key(dev, BTN_BACK, hw.down);
  409. }
  410. for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
  411. input_report_key(dev, BTN_0 + i, hw.ext_buttons & (1 << i));
  412. input_sync(dev);
  413. }
  414. static int synaptics_validate_byte(unsigned char packet[], int idx, unsigned char pkt_type)
  415. {
  416. static const unsigned char newabs_mask[] = { 0xC8, 0x00, 0x00, 0xC8, 0x00 };
  417. static const unsigned char newabs_rel_mask[] = { 0xC0, 0x00, 0x00, 0xC0, 0x00 };
  418. static const unsigned char newabs_rslt[] = { 0x80, 0x00, 0x00, 0xC0, 0x00 };
  419. static const unsigned char oldabs_mask[] = { 0xC0, 0x60, 0x00, 0xC0, 0x60 };
  420. static const unsigned char oldabs_rslt[] = { 0xC0, 0x00, 0x00, 0x80, 0x00 };
  421. if (idx < 0 || idx > 4)
  422. return 0;
  423. switch (pkt_type) {
  424. case SYN_NEWABS:
  425. case SYN_NEWABS_RELAXED:
  426. return (packet[idx] & newabs_rel_mask[idx]) == newabs_rslt[idx];
  427. case SYN_NEWABS_STRICT:
  428. return (packet[idx] & newabs_mask[idx]) == newabs_rslt[idx];
  429. case SYN_OLDABS:
  430. return (packet[idx] & oldabs_mask[idx]) == oldabs_rslt[idx];
  431. default:
  432. printk(KERN_ERR "synaptics: unknown packet type %d\n", pkt_type);
  433. return 0;
  434. }
  435. }
  436. static unsigned char synaptics_detect_pkt_type(struct psmouse *psmouse)
  437. {
  438. int i;
  439. for (i = 0; i < 5; i++)
  440. if (!synaptics_validate_byte(psmouse->packet, i, SYN_NEWABS_STRICT)) {
  441. printk(KERN_INFO "synaptics: using relaxed packet validation\n");
  442. return SYN_NEWABS_RELAXED;
  443. }
  444. return SYN_NEWABS_STRICT;
  445. }
  446. static psmouse_ret_t synaptics_process_byte(struct psmouse *psmouse)
  447. {
  448. struct synaptics_data *priv = psmouse->private;
  449. if (psmouse->pktcnt >= 6) { /* Full packet received */
  450. if (unlikely(priv->pkt_type == SYN_NEWABS))
  451. priv->pkt_type = synaptics_detect_pkt_type(psmouse);
  452. if (SYN_CAP_PASS_THROUGH(priv->capabilities) && synaptics_is_pt_packet(psmouse->packet)) {
  453. if (psmouse->ps2dev.serio->child)
  454. synaptics_pass_pt_packet(psmouse->ps2dev.serio->child, psmouse->packet);
  455. } else
  456. synaptics_process_packet(psmouse);
  457. return PSMOUSE_FULL_PACKET;
  458. }
  459. return synaptics_validate_byte(psmouse->packet, psmouse->pktcnt - 1, priv->pkt_type) ?
  460. PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
  461. }
  462. /*****************************************************************************
  463. * Driver initialization/cleanup functions
  464. ****************************************************************************/
  465. static void set_input_params(struct input_dev *dev, struct synaptics_data *priv)
  466. {
  467. int i;
  468. set_bit(EV_ABS, dev->evbit);
  469. input_set_abs_params(dev, ABS_X, XMIN_NOMINAL, XMAX_NOMINAL, 0, 0);
  470. input_set_abs_params(dev, ABS_Y, YMIN_NOMINAL, YMAX_NOMINAL, 0, 0);
  471. input_set_abs_params(dev, ABS_PRESSURE, 0, 255, 0, 0);
  472. set_bit(ABS_TOOL_WIDTH, dev->absbit);
  473. set_bit(EV_KEY, dev->evbit);
  474. set_bit(BTN_TOUCH, dev->keybit);
  475. set_bit(BTN_TOOL_FINGER, dev->keybit);
  476. set_bit(BTN_LEFT, dev->keybit);
  477. set_bit(BTN_RIGHT, dev->keybit);
  478. if (SYN_CAP_MULTIFINGER(priv->capabilities)) {
  479. set_bit(BTN_TOOL_DOUBLETAP, dev->keybit);
  480. set_bit(BTN_TOOL_TRIPLETAP, dev->keybit);
  481. }
  482. if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
  483. set_bit(BTN_MIDDLE, dev->keybit);
  484. if (SYN_CAP_FOUR_BUTTON(priv->capabilities) ||
  485. SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
  486. set_bit(BTN_FORWARD, dev->keybit);
  487. set_bit(BTN_BACK, dev->keybit);
  488. }
  489. for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
  490. set_bit(BTN_0 + i, dev->keybit);
  491. clear_bit(EV_REL, dev->evbit);
  492. clear_bit(REL_X, dev->relbit);
  493. clear_bit(REL_Y, dev->relbit);
  494. dev->absres[ABS_X] = priv->x_res;
  495. dev->absres[ABS_Y] = priv->y_res;
  496. }
  497. static void synaptics_disconnect(struct psmouse *psmouse)
  498. {
  499. synaptics_reset(psmouse);
  500. kfree(psmouse->private);
  501. psmouse->private = NULL;
  502. }
  503. static int synaptics_reconnect(struct psmouse *psmouse)
  504. {
  505. struct synaptics_data *priv = psmouse->private;
  506. struct synaptics_data old_priv = *priv;
  507. psmouse_reset(psmouse);
  508. if (synaptics_detect(psmouse, 0))
  509. return -1;
  510. if (synaptics_query_hardware(psmouse)) {
  511. printk(KERN_ERR "Unable to query Synaptics hardware.\n");
  512. return -1;
  513. }
  514. if (old_priv.identity != priv->identity ||
  515. old_priv.model_id != priv->model_id ||
  516. old_priv.capabilities != priv->capabilities ||
  517. old_priv.ext_cap != priv->ext_cap)
  518. return -1;
  519. if (synaptics_set_absolute_mode(psmouse)) {
  520. printk(KERN_ERR "Unable to initialize Synaptics hardware.\n");
  521. return -1;
  522. }
  523. return 0;
  524. }
  525. #if defined(__i386__)
  526. #include <linux/dmi.h>
  527. static const struct dmi_system_id toshiba_dmi_table[] = {
  528. {
  529. .ident = "Toshiba Satellite",
  530. .matches = {
  531. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  532. DMI_MATCH(DMI_PRODUCT_NAME, "Satellite"),
  533. },
  534. },
  535. {
  536. .ident = "Toshiba Dynabook",
  537. .matches = {
  538. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  539. DMI_MATCH(DMI_PRODUCT_NAME, "dynabook"),
  540. },
  541. },
  542. {
  543. .ident = "Toshiba Portege M300",
  544. .matches = {
  545. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  546. DMI_MATCH(DMI_PRODUCT_NAME, "PORTEGE M300"),
  547. },
  548. },
  549. { }
  550. };
  551. #endif
  552. int synaptics_init(struct psmouse *psmouse)
  553. {
  554. struct synaptics_data *priv;
  555. psmouse->private = priv = kzalloc(sizeof(struct synaptics_data), GFP_KERNEL);
  556. if (!priv)
  557. return -1;
  558. psmouse_reset(psmouse);
  559. if (synaptics_query_hardware(psmouse)) {
  560. printk(KERN_ERR "Unable to query Synaptics hardware.\n");
  561. goto init_fail;
  562. }
  563. if (synaptics_set_absolute_mode(psmouse)) {
  564. printk(KERN_ERR "Unable to initialize Synaptics hardware.\n");
  565. goto init_fail;
  566. }
  567. priv->pkt_type = SYN_MODEL_NEWABS(priv->model_id) ? SYN_NEWABS : SYN_OLDABS;
  568. printk(KERN_INFO "Synaptics Touchpad, model: %ld, fw: %ld.%ld, id: %#lx, caps: %#lx/%#lx\n",
  569. SYN_ID_MODEL(priv->identity),
  570. SYN_ID_MAJOR(priv->identity), SYN_ID_MINOR(priv->identity),
  571. priv->model_id, priv->capabilities, priv->ext_cap);
  572. set_input_params(psmouse->dev, priv);
  573. /*
  574. * Encode touchpad model so that it can be used to set
  575. * input device->id.version and be visible to userspace.
  576. * Because version is __u16 we have to drop something.
  577. * Hardware info bits seem to be good candidates as they
  578. * are documented to be for Synaptics corp. internal use.
  579. */
  580. psmouse->model = ((priv->model_id & 0x00ff0000) >> 8) |
  581. (priv->model_id & 0x000000ff);
  582. psmouse->protocol_handler = synaptics_process_byte;
  583. psmouse->set_rate = synaptics_set_rate;
  584. psmouse->disconnect = synaptics_disconnect;
  585. psmouse->reconnect = synaptics_reconnect;
  586. psmouse->cleanup = synaptics_reset;
  587. psmouse->pktsize = 6;
  588. /* Synaptics can usually stay in sync without extra help */
  589. psmouse->resync_time = 0;
  590. if (SYN_CAP_PASS_THROUGH(priv->capabilities))
  591. synaptics_pt_create(psmouse);
  592. #if defined(__i386__)
  593. /*
  594. * Toshiba's KBC seems to have trouble handling data from
  595. * Synaptics as full rate, switch to lower rate which is roughly
  596. * thye same as rate of standard PS/2 mouse.
  597. */
  598. if (psmouse->rate >= 80 && dmi_check_system(toshiba_dmi_table)) {
  599. printk(KERN_INFO "synaptics: Toshiba %s detected, limiting rate to 40pps.\n",
  600. dmi_get_system_info(DMI_PRODUCT_NAME));
  601. psmouse->rate = 40;
  602. }
  603. #endif
  604. return 0;
  605. init_fail:
  606. kfree(priv);
  607. return -1;
  608. }
  609. #else /* CONFIG_MOUSE_PS2_SYNAPTICS */
  610. int synaptics_init(struct psmouse *psmouse)
  611. {
  612. return -ENOSYS;
  613. }
  614. #endif /* CONFIG_MOUSE_PS2_SYNAPTICS */