lifebook.c 3.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143
  1. /*
  2. * Fujitsu B-series Lifebook PS/2 TouchScreen driver
  3. *
  4. * Copyright (c) 2005 Vojtech Pavlik <vojtech@suse.cz>
  5. * Copyright (c) 2005 Kenan Esau <kenan.esau@conan.de>
  6. *
  7. * TouchScreen detection, absolute mode setting and packet layout is taken from
  8. * Harald Hoyer's description of the device.
  9. *
  10. * This program is free software; you can redistribute it and/or modify it
  11. * under the terms of the GNU General Public License version 2 as published by
  12. * the Free Software Foundation.
  13. */
  14. #include <linux/input.h>
  15. #include <linux/serio.h>
  16. #include <linux/libps2.h>
  17. #include <linux/dmi.h>
  18. #include "psmouse.h"
  19. #include "lifebook.h"
  20. static struct dmi_system_id lifebook_dmi_table[] = {
  21. {
  22. .ident = "Lifebook B",
  23. .matches = {
  24. DMI_MATCH(DMI_PRODUCT_NAME, "LIFEBOOK B Series"),
  25. },
  26. },
  27. {
  28. .ident = "Lifebook B142",
  29. .matches = {
  30. DMI_MATCH(DMI_PRODUCT_NAME, "LifeBook B142"),
  31. },
  32. },
  33. { }
  34. };
  35. static psmouse_ret_t lifebook_process_byte(struct psmouse *psmouse, struct pt_regs *regs)
  36. {
  37. unsigned char *packet = psmouse->packet;
  38. struct input_dev *dev = psmouse->dev;
  39. if (psmouse->pktcnt != 3)
  40. return PSMOUSE_GOOD_DATA;
  41. input_regs(dev, regs);
  42. /* calculate X and Y */
  43. if ((packet[0] & 0x08) == 0x00) {
  44. input_report_abs(dev, ABS_X,
  45. (packet[1] | ((packet[0] & 0x30) << 4)));
  46. input_report_abs(dev, ABS_Y,
  47. 1024 - (packet[2] | ((packet[0] & 0xC0) << 2)));
  48. } else {
  49. input_report_rel(dev, REL_X,
  50. ((packet[0] & 0x10) ? packet[1] - 256 : packet[1]));
  51. input_report_rel(dev, REL_Y,
  52. -(int)((packet[0] & 0x20) ? packet[2] - 256 : packet[2]));
  53. }
  54. input_report_key(dev, BTN_LEFT, packet[0] & 0x01);
  55. input_report_key(dev, BTN_RIGHT, packet[0] & 0x02);
  56. input_report_key(dev, BTN_TOUCH, packet[0] & 0x04);
  57. input_sync(dev);
  58. return PSMOUSE_FULL_PACKET;
  59. }
  60. static int lifebook_absolute_mode(struct psmouse *psmouse)
  61. {
  62. struct ps2dev *ps2dev = &psmouse->ps2dev;
  63. unsigned char param;
  64. if (psmouse_reset(psmouse))
  65. return -1;
  66. /*
  67. Enable absolute output -- ps2_command fails always but if
  68. you leave this call out the touchsreen will never send
  69. absolute coordinates
  70. */
  71. param = 0x07;
  72. ps2_command(ps2dev, &param, PSMOUSE_CMD_SETRES);
  73. return 0;
  74. }
  75. static void lifebook_set_resolution(struct psmouse *psmouse, unsigned int resolution)
  76. {
  77. unsigned char params[] = { 0, 1, 2, 2, 3 };
  78. if (resolution == 0 || resolution > 400)
  79. resolution = 400;
  80. ps2_command(&psmouse->ps2dev, &params[resolution / 100], PSMOUSE_CMD_SETRES);
  81. psmouse->resolution = 50 << params[resolution / 100];
  82. }
  83. static void lifebook_disconnect(struct psmouse *psmouse)
  84. {
  85. psmouse_reset(psmouse);
  86. }
  87. int lifebook_detect(struct psmouse *psmouse, int set_properties)
  88. {
  89. if (!dmi_check_system(lifebook_dmi_table))
  90. return -1;
  91. if (set_properties) {
  92. psmouse->vendor = "Fujitsu";
  93. psmouse->name = "Lifebook TouchScreen";
  94. }
  95. return 0;
  96. }
  97. int lifebook_init(struct psmouse *psmouse)
  98. {
  99. struct input_dev *input_dev = psmouse->dev;
  100. if (lifebook_absolute_mode(psmouse))
  101. return -1;
  102. input_dev->evbit[0] = BIT(EV_ABS) | BIT(EV_KEY) | BIT(EV_REL);
  103. input_dev->keybit[LONG(BTN_LEFT)] = BIT(BTN_LEFT) | BIT(BTN_MIDDLE) | BIT(BTN_RIGHT);
  104. input_dev->keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH);
  105. input_dev->relbit[0] = BIT(REL_X) | BIT(REL_Y);
  106. input_set_abs_params(input_dev, ABS_X, 0, 1024, 0, 0);
  107. input_set_abs_params(input_dev, ABS_Y, 0, 1024, 0, 0);
  108. psmouse->protocol_handler = lifebook_process_byte;
  109. psmouse->set_resolution = lifebook_set_resolution;
  110. psmouse->disconnect = lifebook_disconnect;
  111. psmouse->reconnect = lifebook_absolute_mode;
  112. psmouse->pktsize = 3;
  113. return 0;
  114. }