synaptics.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708
  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. static int synaptics_query_hardware(struct psmouse *psmouse)
  158. {
  159. int retries = 0;
  160. while ((retries++ < 3) && psmouse_reset(psmouse))
  161. /* empty */;
  162. if (synaptics_identify(psmouse))
  163. return -1;
  164. if (synaptics_model_id(psmouse))
  165. return -1;
  166. if (synaptics_capability(psmouse))
  167. return -1;
  168. return 0;
  169. }
  170. static int synaptics_set_absolute_mode(struct psmouse *psmouse)
  171. {
  172. struct synaptics_data *priv = psmouse->private;
  173. priv->mode = SYN_BIT_ABSOLUTE_MODE;
  174. if (SYN_ID_MAJOR(priv->identity) >= 4)
  175. priv->mode |= SYN_BIT_DISABLE_GESTURE;
  176. if (SYN_CAP_EXTENDED(priv->capabilities))
  177. priv->mode |= SYN_BIT_W_MODE;
  178. if (synaptics_mode_cmd(psmouse, priv->mode))
  179. return -1;
  180. return 0;
  181. }
  182. static void synaptics_set_rate(struct psmouse *psmouse, unsigned int rate)
  183. {
  184. struct synaptics_data *priv = psmouse->private;
  185. if (rate >= 80) {
  186. priv->mode |= SYN_BIT_HIGH_RATE;
  187. psmouse->rate = 80;
  188. } else {
  189. priv->mode &= ~SYN_BIT_HIGH_RATE;
  190. psmouse->rate = 40;
  191. }
  192. synaptics_mode_cmd(psmouse, priv->mode);
  193. }
  194. /*****************************************************************************
  195. * Synaptics pass-through PS/2 port support
  196. ****************************************************************************/
  197. static int synaptics_pt_write(struct serio *serio, unsigned char c)
  198. {
  199. struct psmouse *parent = serio_get_drvdata(serio->parent);
  200. char rate_param = SYN_PS_CLIENT_CMD; /* indicates that we want pass-through port */
  201. if (psmouse_sliced_command(parent, c))
  202. return -1;
  203. if (ps2_command(&parent->ps2dev, &rate_param, PSMOUSE_CMD_SETRATE))
  204. return -1;
  205. return 0;
  206. }
  207. static inline int synaptics_is_pt_packet(unsigned char *buf)
  208. {
  209. return (buf[0] & 0xFC) == 0x84 && (buf[3] & 0xCC) == 0xC4;
  210. }
  211. static void synaptics_pass_pt_packet(struct serio *ptport, unsigned char *packet)
  212. {
  213. struct psmouse *child = serio_get_drvdata(ptport);
  214. if (child && child->state == PSMOUSE_ACTIVATED) {
  215. serio_interrupt(ptport, packet[1], 0);
  216. serio_interrupt(ptport, packet[4], 0);
  217. serio_interrupt(ptport, packet[5], 0);
  218. if (child->pktsize == 4)
  219. serio_interrupt(ptport, packet[2], 0);
  220. } else
  221. serio_interrupt(ptport, packet[1], 0);
  222. }
  223. static void synaptics_pt_activate(struct psmouse *psmouse)
  224. {
  225. struct serio *ptport = psmouse->ps2dev.serio->child;
  226. struct psmouse *child = serio_get_drvdata(ptport);
  227. struct synaptics_data *priv = psmouse->private;
  228. /* adjust the touchpad to child's choice of protocol */
  229. if (child) {
  230. if (child->pktsize == 4)
  231. priv->mode |= SYN_BIT_FOUR_BYTE_CLIENT;
  232. else
  233. priv->mode &= ~SYN_BIT_FOUR_BYTE_CLIENT;
  234. if (synaptics_mode_cmd(psmouse, priv->mode))
  235. printk(KERN_INFO "synaptics: failed to switch guest protocol\n");
  236. }
  237. }
  238. static void synaptics_pt_create(struct psmouse *psmouse)
  239. {
  240. struct serio *serio;
  241. serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
  242. if (!serio) {
  243. printk(KERN_ERR "synaptics: not enough memory to allocate pass-through port\n");
  244. return;
  245. }
  246. serio->id.type = SERIO_PS_PSTHRU;
  247. strlcpy(serio->name, "Synaptics pass-through", sizeof(serio->name));
  248. strlcpy(serio->phys, "synaptics-pt/serio0", sizeof(serio->name));
  249. serio->write = synaptics_pt_write;
  250. serio->parent = psmouse->ps2dev.serio;
  251. psmouse->pt_activate = synaptics_pt_activate;
  252. printk(KERN_INFO "serio: %s port at %s\n", serio->name, psmouse->phys);
  253. serio_register_port(serio);
  254. }
  255. /*****************************************************************************
  256. * Functions to interpret the absolute mode packets
  257. ****************************************************************************/
  258. static void synaptics_parse_hw_state(unsigned char buf[], struct synaptics_data *priv, struct synaptics_hw_state *hw)
  259. {
  260. memset(hw, 0, sizeof(struct synaptics_hw_state));
  261. if (SYN_MODEL_NEWABS(priv->model_id)) {
  262. hw->x = (((buf[3] & 0x10) << 8) |
  263. ((buf[1] & 0x0f) << 8) |
  264. buf[4]);
  265. hw->y = (((buf[3] & 0x20) << 7) |
  266. ((buf[1] & 0xf0) << 4) |
  267. buf[5]);
  268. hw->z = buf[2];
  269. hw->w = (((buf[0] & 0x30) >> 2) |
  270. ((buf[0] & 0x04) >> 1) |
  271. ((buf[3] & 0x04) >> 2));
  272. hw->left = (buf[0] & 0x01) ? 1 : 0;
  273. hw->right = (buf[0] & 0x02) ? 1 : 0;
  274. if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
  275. hw->middle = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
  276. if (hw->w == 2)
  277. hw->scroll = (signed char)(buf[1]);
  278. }
  279. if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
  280. hw->up = ((buf[0] ^ buf[3]) & 0x01) ? 1 : 0;
  281. hw->down = ((buf[0] ^ buf[3]) & 0x02) ? 1 : 0;
  282. }
  283. if (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) &&
  284. ((buf[0] ^ buf[3]) & 0x02)) {
  285. switch (SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap) & ~0x01) {
  286. default:
  287. /*
  288. * if nExtBtn is greater than 8 it should be
  289. * considered invalid and treated as 0
  290. */
  291. break;
  292. case 8:
  293. hw->ext_buttons |= ((buf[5] & 0x08)) ? 0x80 : 0;
  294. hw->ext_buttons |= ((buf[4] & 0x08)) ? 0x40 : 0;
  295. case 6:
  296. hw->ext_buttons |= ((buf[5] & 0x04)) ? 0x20 : 0;
  297. hw->ext_buttons |= ((buf[4] & 0x04)) ? 0x10 : 0;
  298. case 4:
  299. hw->ext_buttons |= ((buf[5] & 0x02)) ? 0x08 : 0;
  300. hw->ext_buttons |= ((buf[4] & 0x02)) ? 0x04 : 0;
  301. case 2:
  302. hw->ext_buttons |= ((buf[5] & 0x01)) ? 0x02 : 0;
  303. hw->ext_buttons |= ((buf[4] & 0x01)) ? 0x01 : 0;
  304. }
  305. }
  306. } else {
  307. hw->x = (((buf[1] & 0x1f) << 8) | buf[2]);
  308. hw->y = (((buf[4] & 0x1f) << 8) | buf[5]);
  309. hw->z = (((buf[0] & 0x30) << 2) | (buf[3] & 0x3F));
  310. hw->w = (((buf[1] & 0x80) >> 4) | ((buf[0] & 0x04) >> 1));
  311. hw->left = (buf[0] & 0x01) ? 1 : 0;
  312. hw->right = (buf[0] & 0x02) ? 1 : 0;
  313. }
  314. }
  315. /*
  316. * called for each full received packet from the touchpad
  317. */
  318. static void synaptics_process_packet(struct psmouse *psmouse)
  319. {
  320. struct input_dev *dev = psmouse->dev;
  321. struct synaptics_data *priv = psmouse->private;
  322. struct synaptics_hw_state hw;
  323. int num_fingers;
  324. int finger_width;
  325. int i;
  326. synaptics_parse_hw_state(psmouse->packet, priv, &hw);
  327. if (hw.scroll) {
  328. priv->scroll += hw.scroll;
  329. while (priv->scroll >= 4) {
  330. input_report_key(dev, BTN_BACK, !hw.down);
  331. input_sync(dev);
  332. input_report_key(dev, BTN_BACK, hw.down);
  333. input_sync(dev);
  334. priv->scroll -= 4;
  335. }
  336. while (priv->scroll <= -4) {
  337. input_report_key(dev, BTN_FORWARD, !hw.up);
  338. input_sync(dev);
  339. input_report_key(dev, BTN_FORWARD, hw.up);
  340. input_sync(dev);
  341. priv->scroll += 4;
  342. }
  343. return;
  344. }
  345. if (hw.z > 0) {
  346. num_fingers = 1;
  347. finger_width = 5;
  348. if (SYN_CAP_EXTENDED(priv->capabilities)) {
  349. switch (hw.w) {
  350. case 0 ... 1:
  351. if (SYN_CAP_MULTIFINGER(priv->capabilities))
  352. num_fingers = hw.w + 2;
  353. break;
  354. case 2:
  355. if (SYN_MODEL_PEN(priv->model_id))
  356. ; /* Nothing, treat a pen as a single finger */
  357. break;
  358. case 4 ... 15:
  359. if (SYN_CAP_PALMDETECT(priv->capabilities))
  360. finger_width = hw.w;
  361. break;
  362. }
  363. }
  364. } else {
  365. num_fingers = 0;
  366. finger_width = 0;
  367. }
  368. /* Post events
  369. * BTN_TOUCH has to be first as mousedev relies on it when doing
  370. * absolute -> relative conversion
  371. */
  372. if (hw.z > 30) input_report_key(dev, BTN_TOUCH, 1);
  373. if (hw.z < 25) input_report_key(dev, BTN_TOUCH, 0);
  374. if (hw.z > 0) {
  375. input_report_abs(dev, ABS_X, hw.x);
  376. input_report_abs(dev, ABS_Y, YMAX_NOMINAL + YMIN_NOMINAL - hw.y);
  377. }
  378. input_report_abs(dev, ABS_PRESSURE, hw.z);
  379. input_report_abs(dev, ABS_TOOL_WIDTH, finger_width);
  380. input_report_key(dev, BTN_TOOL_FINGER, num_fingers == 1);
  381. input_report_key(dev, BTN_TOOL_DOUBLETAP, num_fingers == 2);
  382. input_report_key(dev, BTN_TOOL_TRIPLETAP, num_fingers == 3);
  383. input_report_key(dev, BTN_LEFT, hw.left);
  384. input_report_key(dev, BTN_RIGHT, hw.right);
  385. if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
  386. input_report_key(dev, BTN_MIDDLE, hw.middle);
  387. if (SYN_CAP_FOUR_BUTTON(priv->capabilities)) {
  388. input_report_key(dev, BTN_FORWARD, hw.up);
  389. input_report_key(dev, BTN_BACK, hw.down);
  390. }
  391. for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
  392. input_report_key(dev, BTN_0 + i, hw.ext_buttons & (1 << i));
  393. input_sync(dev);
  394. }
  395. static int synaptics_validate_byte(unsigned char packet[], int idx, unsigned char pkt_type)
  396. {
  397. static const unsigned char newabs_mask[] = { 0xC8, 0x00, 0x00, 0xC8, 0x00 };
  398. static const unsigned char newabs_rel_mask[] = { 0xC0, 0x00, 0x00, 0xC0, 0x00 };
  399. static const unsigned char newabs_rslt[] = { 0x80, 0x00, 0x00, 0xC0, 0x00 };
  400. static const unsigned char oldabs_mask[] = { 0xC0, 0x60, 0x00, 0xC0, 0x60 };
  401. static const unsigned char oldabs_rslt[] = { 0xC0, 0x00, 0x00, 0x80, 0x00 };
  402. if (idx < 0 || idx > 4)
  403. return 0;
  404. switch (pkt_type) {
  405. case SYN_NEWABS:
  406. case SYN_NEWABS_RELAXED:
  407. return (packet[idx] & newabs_rel_mask[idx]) == newabs_rslt[idx];
  408. case SYN_NEWABS_STRICT:
  409. return (packet[idx] & newabs_mask[idx]) == newabs_rslt[idx];
  410. case SYN_OLDABS:
  411. return (packet[idx] & oldabs_mask[idx]) == oldabs_rslt[idx];
  412. default:
  413. printk(KERN_ERR "synaptics: unknown packet type %d\n", pkt_type);
  414. return 0;
  415. }
  416. }
  417. static unsigned char synaptics_detect_pkt_type(struct psmouse *psmouse)
  418. {
  419. int i;
  420. for (i = 0; i < 5; i++)
  421. if (!synaptics_validate_byte(psmouse->packet, i, SYN_NEWABS_STRICT)) {
  422. printk(KERN_INFO "synaptics: using relaxed packet validation\n");
  423. return SYN_NEWABS_RELAXED;
  424. }
  425. return SYN_NEWABS_STRICT;
  426. }
  427. static psmouse_ret_t synaptics_process_byte(struct psmouse *psmouse)
  428. {
  429. struct synaptics_data *priv = psmouse->private;
  430. if (psmouse->pktcnt >= 6) { /* Full packet received */
  431. if (unlikely(priv->pkt_type == SYN_NEWABS))
  432. priv->pkt_type = synaptics_detect_pkt_type(psmouse);
  433. if (SYN_CAP_PASS_THROUGH(priv->capabilities) && synaptics_is_pt_packet(psmouse->packet)) {
  434. if (psmouse->ps2dev.serio->child)
  435. synaptics_pass_pt_packet(psmouse->ps2dev.serio->child, psmouse->packet);
  436. } else
  437. synaptics_process_packet(psmouse);
  438. return PSMOUSE_FULL_PACKET;
  439. }
  440. return synaptics_validate_byte(psmouse->packet, psmouse->pktcnt - 1, priv->pkt_type) ?
  441. PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
  442. }
  443. /*****************************************************************************
  444. * Driver initialization/cleanup functions
  445. ****************************************************************************/
  446. static void set_input_params(struct input_dev *dev, struct synaptics_data *priv)
  447. {
  448. int i;
  449. set_bit(EV_ABS, dev->evbit);
  450. input_set_abs_params(dev, ABS_X, XMIN_NOMINAL, XMAX_NOMINAL, 0, 0);
  451. input_set_abs_params(dev, ABS_Y, YMIN_NOMINAL, YMAX_NOMINAL, 0, 0);
  452. input_set_abs_params(dev, ABS_PRESSURE, 0, 255, 0, 0);
  453. set_bit(ABS_TOOL_WIDTH, dev->absbit);
  454. set_bit(EV_KEY, dev->evbit);
  455. set_bit(BTN_TOUCH, dev->keybit);
  456. set_bit(BTN_TOOL_FINGER, dev->keybit);
  457. set_bit(BTN_TOOL_DOUBLETAP, dev->keybit);
  458. set_bit(BTN_TOOL_TRIPLETAP, dev->keybit);
  459. set_bit(BTN_LEFT, dev->keybit);
  460. set_bit(BTN_RIGHT, dev->keybit);
  461. if (SYN_CAP_MIDDLE_BUTTON(priv->capabilities))
  462. set_bit(BTN_MIDDLE, dev->keybit);
  463. if (SYN_CAP_FOUR_BUTTON(priv->capabilities) ||
  464. SYN_CAP_MIDDLE_BUTTON(priv->capabilities)) {
  465. set_bit(BTN_FORWARD, dev->keybit);
  466. set_bit(BTN_BACK, dev->keybit);
  467. }
  468. for (i = 0; i < SYN_CAP_MULTI_BUTTON_NO(priv->ext_cap); i++)
  469. set_bit(BTN_0 + i, dev->keybit);
  470. clear_bit(EV_REL, dev->evbit);
  471. clear_bit(REL_X, dev->relbit);
  472. clear_bit(REL_Y, dev->relbit);
  473. }
  474. static void synaptics_disconnect(struct psmouse *psmouse)
  475. {
  476. synaptics_reset(psmouse);
  477. kfree(psmouse->private);
  478. psmouse->private = NULL;
  479. }
  480. static int synaptics_reconnect(struct psmouse *psmouse)
  481. {
  482. struct synaptics_data *priv = psmouse->private;
  483. struct synaptics_data old_priv = *priv;
  484. if (synaptics_detect(psmouse, 0))
  485. return -1;
  486. if (synaptics_query_hardware(psmouse)) {
  487. printk(KERN_ERR "Unable to query Synaptics hardware.\n");
  488. return -1;
  489. }
  490. if (old_priv.identity != priv->identity ||
  491. old_priv.model_id != priv->model_id ||
  492. old_priv.capabilities != priv->capabilities ||
  493. old_priv.ext_cap != priv->ext_cap)
  494. return -1;
  495. if (synaptics_set_absolute_mode(psmouse)) {
  496. printk(KERN_ERR "Unable to initialize Synaptics hardware.\n");
  497. return -1;
  498. }
  499. return 0;
  500. }
  501. #if defined(__i386__)
  502. #include <linux/dmi.h>
  503. static const struct dmi_system_id toshiba_dmi_table[] = {
  504. {
  505. .ident = "Toshiba Satellite",
  506. .matches = {
  507. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  508. DMI_MATCH(DMI_PRODUCT_NAME, "Satellite"),
  509. },
  510. },
  511. {
  512. .ident = "Toshiba Dynabook",
  513. .matches = {
  514. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  515. DMI_MATCH(DMI_PRODUCT_NAME, "dynabook"),
  516. },
  517. },
  518. {
  519. .ident = "Toshiba Portege M300",
  520. .matches = {
  521. DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  522. DMI_MATCH(DMI_PRODUCT_NAME, "PORTEGE M300"),
  523. },
  524. },
  525. { }
  526. };
  527. #endif
  528. int synaptics_init(struct psmouse *psmouse)
  529. {
  530. struct synaptics_data *priv;
  531. psmouse->private = priv = kzalloc(sizeof(struct synaptics_data), GFP_KERNEL);
  532. if (!priv)
  533. return -1;
  534. if (synaptics_query_hardware(psmouse)) {
  535. printk(KERN_ERR "Unable to query Synaptics hardware.\n");
  536. goto init_fail;
  537. }
  538. if (synaptics_set_absolute_mode(psmouse)) {
  539. printk(KERN_ERR "Unable to initialize Synaptics hardware.\n");
  540. goto init_fail;
  541. }
  542. priv->pkt_type = SYN_MODEL_NEWABS(priv->model_id) ? SYN_NEWABS : SYN_OLDABS;
  543. printk(KERN_INFO "Synaptics Touchpad, model: %ld, fw: %ld.%ld, id: %#lx, caps: %#lx/%#lx\n",
  544. SYN_ID_MODEL(priv->identity),
  545. SYN_ID_MAJOR(priv->identity), SYN_ID_MINOR(priv->identity),
  546. priv->model_id, priv->capabilities, priv->ext_cap);
  547. set_input_params(psmouse->dev, priv);
  548. /*
  549. * Encode touchpad model so that it can be used to set
  550. * input device->id.version and be visible to userspace.
  551. * Because version is __u16 we have to drop something.
  552. * Hardware info bits seem to be good candidates as they
  553. * are documented to be for Synaptics corp. internal use.
  554. */
  555. psmouse->model = ((priv->model_id & 0x00ff0000) >> 8) |
  556. (priv->model_id & 0x000000ff);
  557. psmouse->protocol_handler = synaptics_process_byte;
  558. psmouse->set_rate = synaptics_set_rate;
  559. psmouse->disconnect = synaptics_disconnect;
  560. psmouse->reconnect = synaptics_reconnect;
  561. psmouse->cleanup = synaptics_reset;
  562. psmouse->pktsize = 6;
  563. /* Synaptics can usually stay in sync without extra help */
  564. psmouse->resync_time = 0;
  565. if (SYN_CAP_PASS_THROUGH(priv->capabilities))
  566. synaptics_pt_create(psmouse);
  567. #if defined(__i386__)
  568. /*
  569. * Toshiba's KBC seems to have trouble handling data from
  570. * Synaptics as full rate, switch to lower rate which is roughly
  571. * thye same as rate of standard PS/2 mouse.
  572. */
  573. if (psmouse->rate >= 80 && dmi_check_system(toshiba_dmi_table)) {
  574. printk(KERN_INFO "synaptics: Toshiba %s detected, limiting rate to 40pps.\n",
  575. dmi_get_system_info(DMI_PRODUCT_NAME));
  576. psmouse->rate = 40;
  577. }
  578. #endif
  579. return 0;
  580. init_fail:
  581. kfree(priv);
  582. return -1;
  583. }
  584. #else /* CONFIG_MOUSE_PS2_SYNAPTICS */
  585. int synaptics_init(struct psmouse *psmouse)
  586. {
  587. return -ENOSYS;
  588. }
  589. #endif /* CONFIG_MOUSE_PS2_SYNAPTICS */