lifebook.c 7.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Fujitsu B-series Lifebook PS/2 TouchScreen driver
  4. *
  5. * Copyright (c) 2005 Vojtech Pavlik <vojtech@suse.cz>
  6. * Copyright (c) 2005 Kenan Esau <kenan.esau@conan.de>
  7. *
  8. * TouchScreen detection, absolute mode setting and packet layout is taken from
  9. * Harald Hoyer's description of the device.
  10. */
  11. #include <linux/input.h>
  12. #include <linux/serio.h>
  13. #include <linux/libps2.h>
  14. #include <linux/dmi.h>
  15. #include <linux/slab.h>
  16. #include <linux/types.h>
  17. #include "psmouse.h"
  18. #include "lifebook.h"
  19. struct lifebook_data {
  20. struct input_dev *dev2; /* Relative device */
  21. char phys[32];
  22. };
  23. static bool lifebook_present;
  24. static const char *desired_serio_phys;
  25. static int lifebook_limit_serio3(const struct dmi_system_id *d)
  26. {
  27. desired_serio_phys = "isa0060/serio3";
  28. return 1;
  29. }
  30. static bool lifebook_use_6byte_proto;
  31. static int lifebook_set_6byte_proto(const struct dmi_system_id *d)
  32. {
  33. lifebook_use_6byte_proto = true;
  34. return 1;
  35. }
  36. static const struct dmi_system_id lifebook_dmi_table[] __initconst = {
  37. {
  38. /* FLORA-ie 55mi */
  39. .matches = {
  40. DMI_MATCH(DMI_PRODUCT_NAME, "FLORA-ie 55mi"),
  41. },
  42. },
  43. {
  44. /* LifeBook B */
  45. .matches = {
  46. DMI_MATCH(DMI_PRODUCT_NAME, "Lifebook B Series"),
  47. },
  48. },
  49. {
  50. /* LifeBook B */
  51. .matches = {
  52. DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook B Series"),
  53. },
  54. },
  55. {
  56. /* Lifebook B */
  57. .matches = {
  58. DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK B Series"),
  59. },
  60. },
  61. {
  62. /* Lifebook B-2130 */
  63. .matches = {
  64. DMI_MATCH(DMI_BOARD_NAME, "ZEPHYR"),
  65. },
  66. },
  67. {
  68. /* Lifebook B213x/B2150 */
  69. .matches = {
  70. DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook B2131/B2133/B2150"),
  71. },
  72. },
  73. {
  74. /* Zephyr */
  75. .matches = {
  76. DMI_MATCH(DMI_PRODUCT_NAME, "ZEPHYR"),
  77. },
  78. },
  79. {
  80. /* Panasonic CF-18 */
  81. .matches = {
  82. DMI_MATCH(DMI_PRODUCT_NAME, "CF-18"),
  83. },
  84. .callback = lifebook_limit_serio3,
  85. },
  86. {
  87. /* Panasonic CF-28 */
  88. .matches = {
  89. DMI_MATCH(DMI_SYS_VENDOR, "Matsushita"),
  90. DMI_MATCH(DMI_PRODUCT_NAME, "CF-28"),
  91. },
  92. .callback = lifebook_set_6byte_proto,
  93. },
  94. {
  95. /* Panasonic CF-29 */
  96. .matches = {
  97. DMI_MATCH(DMI_SYS_VENDOR, "Matsushita"),
  98. DMI_MATCH(DMI_PRODUCT_NAME, "CF-29"),
  99. },
  100. .callback = lifebook_set_6byte_proto,
  101. },
  102. {
  103. /* Panasonic CF-72 */
  104. .matches = {
  105. DMI_MATCH(DMI_PRODUCT_NAME, "CF-72"),
  106. },
  107. .callback = lifebook_set_6byte_proto,
  108. },
  109. {
  110. /* Lifebook B142 */
  111. .matches = {
  112. DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook B142"),
  113. },
  114. },
  115. { }
  116. };
  117. void __init lifebook_module_init(void)
  118. {
  119. lifebook_present = dmi_check_system(lifebook_dmi_table);
  120. }
  121. static psmouse_ret_t lifebook_process_byte(struct psmouse *psmouse)
  122. {
  123. struct lifebook_data *priv = psmouse->private;
  124. struct input_dev *dev1 = psmouse->dev;
  125. struct input_dev *dev2 = priv ? priv->dev2 : NULL;
  126. u8 *packet = psmouse->packet;
  127. bool relative_packet = packet[0] & 0x08;
  128. if (relative_packet || !lifebook_use_6byte_proto) {
  129. if (psmouse->pktcnt != 3)
  130. return PSMOUSE_GOOD_DATA;
  131. } else {
  132. switch (psmouse->pktcnt) {
  133. case 1:
  134. return (packet[0] & 0xf8) == 0x00 ?
  135. PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
  136. case 2:
  137. return PSMOUSE_GOOD_DATA;
  138. case 3:
  139. return ((packet[2] & 0x30) << 2) == (packet[2] & 0xc0) ?
  140. PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
  141. case 4:
  142. return (packet[3] & 0xf8) == 0xc0 ?
  143. PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
  144. case 5:
  145. return (packet[4] & 0xc0) == (packet[2] & 0xc0) ?
  146. PSMOUSE_GOOD_DATA : PSMOUSE_BAD_DATA;
  147. case 6:
  148. if (((packet[5] & 0x30) << 2) != (packet[5] & 0xc0))
  149. return PSMOUSE_BAD_DATA;
  150. if ((packet[5] & 0xc0) != (packet[1] & 0xc0))
  151. return PSMOUSE_BAD_DATA;
  152. break; /* report data */
  153. }
  154. }
  155. if (relative_packet) {
  156. if (!dev2)
  157. psmouse_warn(psmouse,
  158. "got relative packet but no relative device set up\n");
  159. } else {
  160. if (lifebook_use_6byte_proto) {
  161. input_report_abs(dev1, ABS_X,
  162. ((packet[1] & 0x3f) << 6) | (packet[2] & 0x3f));
  163. input_report_abs(dev1, ABS_Y,
  164. 4096 - (((packet[4] & 0x3f) << 6) | (packet[5] & 0x3f)));
  165. } else {
  166. input_report_abs(dev1, ABS_X,
  167. (packet[1] | ((packet[0] & 0x30) << 4)));
  168. input_report_abs(dev1, ABS_Y,
  169. 1024 - (packet[2] | ((packet[0] & 0xC0) << 2)));
  170. }
  171. input_report_key(dev1, BTN_TOUCH, packet[0] & 0x04);
  172. input_sync(dev1);
  173. }
  174. if (dev2) {
  175. if (relative_packet)
  176. psmouse_report_standard_motion(dev2, packet);
  177. psmouse_report_standard_buttons(dev2, packet[0]);
  178. input_sync(dev2);
  179. }
  180. return PSMOUSE_FULL_PACKET;
  181. }
  182. static int lifebook_absolute_mode(struct psmouse *psmouse)
  183. {
  184. struct ps2dev *ps2dev = &psmouse->ps2dev;
  185. u8 param;
  186. int error;
  187. error = psmouse_reset(psmouse);
  188. if (error)
  189. return error;
  190. /*
  191. * Enable absolute output -- ps2_command fails always but if
  192. * you leave this call out the touchscreen will never send
  193. * absolute coordinates
  194. */
  195. param = lifebook_use_6byte_proto ? 0x08 : 0x07;
  196. ps2_command(ps2dev, &param, PSMOUSE_CMD_SETRES);
  197. return 0;
  198. }
  199. static void lifebook_relative_mode(struct psmouse *psmouse)
  200. {
  201. struct ps2dev *ps2dev = &psmouse->ps2dev;
  202. u8 param = 0x06;
  203. ps2_command(ps2dev, &param, PSMOUSE_CMD_SETRES);
  204. }
  205. static void lifebook_set_resolution(struct psmouse *psmouse, unsigned int resolution)
  206. {
  207. static const u8 params[] = { 0, 1, 2, 2, 3 };
  208. u8 p;
  209. if (resolution == 0 || resolution > 400)
  210. resolution = 400;
  211. p = params[resolution / 100];
  212. ps2_command(&psmouse->ps2dev, &p, PSMOUSE_CMD_SETRES);
  213. psmouse->resolution = 50 << p;
  214. }
  215. static void lifebook_disconnect(struct psmouse *psmouse)
  216. {
  217. struct lifebook_data *priv = psmouse->private;
  218. psmouse_reset(psmouse);
  219. if (priv) {
  220. input_unregister_device(priv->dev2);
  221. kfree(priv);
  222. }
  223. psmouse->private = NULL;
  224. }
  225. int lifebook_detect(struct psmouse *psmouse, bool set_properties)
  226. {
  227. if (!lifebook_present)
  228. return -ENXIO;
  229. if (desired_serio_phys &&
  230. strcmp(psmouse->ps2dev.serio->phys, desired_serio_phys))
  231. return -ENXIO;
  232. if (set_properties) {
  233. psmouse->vendor = "Fujitsu";
  234. psmouse->name = "Lifebook TouchScreen";
  235. }
  236. return 0;
  237. }
  238. static int lifebook_create_relative_device(struct psmouse *psmouse)
  239. {
  240. struct input_dev *dev2;
  241. struct lifebook_data *priv;
  242. int error = -ENOMEM;
  243. priv = kzalloc(sizeof(struct lifebook_data), GFP_KERNEL);
  244. dev2 = input_allocate_device();
  245. if (!priv || !dev2)
  246. goto err_out;
  247. priv->dev2 = dev2;
  248. snprintf(priv->phys, sizeof(priv->phys),
  249. "%s/input1", psmouse->ps2dev.serio->phys);
  250. dev2->phys = priv->phys;
  251. dev2->name = "LBPS/2 Fujitsu Lifebook Touchpad";
  252. dev2->id.bustype = BUS_I8042;
  253. dev2->id.vendor = 0x0002;
  254. dev2->id.product = PSMOUSE_LIFEBOOK;
  255. dev2->id.version = 0x0000;
  256. dev2->dev.parent = &psmouse->ps2dev.serio->dev;
  257. input_set_capability(dev2, EV_REL, REL_X);
  258. input_set_capability(dev2, EV_REL, REL_Y);
  259. input_set_capability(dev2, EV_KEY, BTN_LEFT);
  260. input_set_capability(dev2, EV_KEY, BTN_RIGHT);
  261. error = input_register_device(priv->dev2);
  262. if (error)
  263. goto err_out;
  264. psmouse->private = priv;
  265. return 0;
  266. err_out:
  267. input_free_device(dev2);
  268. kfree(priv);
  269. return error;
  270. }
  271. int lifebook_init(struct psmouse *psmouse)
  272. {
  273. struct input_dev *dev1 = psmouse->dev;
  274. int max_coord = lifebook_use_6byte_proto ? 4096 : 1024;
  275. int error;
  276. error = lifebook_absolute_mode(psmouse);
  277. if (error)
  278. return error;
  279. /* Clear default capabilities */
  280. bitmap_zero(dev1->evbit, EV_CNT);
  281. bitmap_zero(dev1->relbit, REL_CNT);
  282. bitmap_zero(dev1->keybit, KEY_CNT);
  283. input_set_capability(dev1, EV_KEY, BTN_TOUCH);
  284. input_set_abs_params(dev1, ABS_X, 0, max_coord, 0, 0);
  285. input_set_abs_params(dev1, ABS_Y, 0, max_coord, 0, 0);
  286. if (!desired_serio_phys) {
  287. error = lifebook_create_relative_device(psmouse);
  288. if (error) {
  289. lifebook_relative_mode(psmouse);
  290. return error;
  291. }
  292. }
  293. psmouse->protocol_handler = lifebook_process_byte;
  294. psmouse->set_resolution = lifebook_set_resolution;
  295. psmouse->disconnect = lifebook_disconnect;
  296. psmouse->reconnect = lifebook_absolute_mode;
  297. psmouse->model = lifebook_use_6byte_proto ? 6 : 3;
  298. /*
  299. * Use packet size = 3 even when using 6-byte protocol because
  300. * that's what POLL will return on Lifebooks (according to spec).
  301. */
  302. psmouse->pktsize = 3;
  303. return 0;
  304. }