jornada680_kbd.c 7.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * drivers/input/keyboard/jornada680_kbd.c
  4. *
  5. * HP Jornada 620/660/680/690 scan keyboard platform driver
  6. * Copyright (C) 2007 Kristoffer Ericson <Kristoffer.Ericson@gmail.com>
  7. *
  8. * Based on hp680_keyb.c
  9. * Copyright (C) 2006 Paul Mundt
  10. * Copyright (C) 2005 Andriy Skulysh
  11. * Split from drivers/input/keyboard/hp600_keyb.c
  12. * Copyright (C) 2000 Yaegashi Takeshi (hp6xx kbd scan routine and translation table)
  13. * Copyright (C) 2000 Niibe Yutaka (HP620 Keyb translation table)
  14. */
  15. #include <linux/device.h>
  16. #include <linux/input.h>
  17. #include <linux/interrupt.h>
  18. #include <linux/jiffies.h>
  19. #include <linux/kernel.h>
  20. #include <linux/module.h>
  21. #include <linux/platform_device.h>
  22. #include <linux/slab.h>
  23. #include <asm/delay.h>
  24. #include <asm/io.h>
  25. #define PCCR 0xa4000104
  26. #define PDCR 0xa4000106
  27. #define PECR 0xa4000108
  28. #define PFCR 0xa400010a
  29. #define PCDR 0xa4000124
  30. #define PDDR 0xa4000126
  31. #define PEDR 0xa4000128
  32. #define PFDR 0xa400012a
  33. #define PGDR 0xa400012c
  34. #define PHDR 0xa400012e
  35. #define PJDR 0xa4000130
  36. #define PKDR 0xa4000132
  37. #define PLDR 0xa4000134
  38. static const unsigned short jornada_scancodes[] = {
  39. /* PTD1 */ KEY_CAPSLOCK, KEY_MACRO, KEY_LEFTCTRL, 0, KEY_ESC, KEY_KP5, 0, 0, /* 1 -> 8 */
  40. KEY_F1, KEY_F2, KEY_F3, KEY_F8, KEY_F7, KEY_F6, KEY_F4, KEY_F5, /* 9 -> 16 */
  41. /* PTD5 */ KEY_SLASH, KEY_APOSTROPHE, KEY_ENTER, 0, KEY_Z, 0, 0, 0, /* 17 -> 24 */
  42. KEY_X, KEY_C, KEY_V, KEY_DOT, KEY_COMMA, KEY_M, KEY_B, KEY_N, /* 25 -> 32 */
  43. /* PTD7 */ KEY_KP2, KEY_KP6, KEY_KP3, 0, 0, 0, 0, 0, /* 33 -> 40 */
  44. KEY_F10, KEY_RO, KEY_F9, KEY_KP4, KEY_NUMLOCK, KEY_SCROLLLOCK, KEY_LEFTALT, KEY_HANJA, /* 41 -> 48 */
  45. /* PTE0 */ KEY_KATAKANA, KEY_KP0, KEY_GRAVE, 0, KEY_FINANCE, 0, 0, 0, /* 49 -> 56 */
  46. KEY_KPMINUS, KEY_HIRAGANA, KEY_SPACE, KEY_KPDOT, KEY_VOLUMEUP, 249, 0, 0, /* 57 -> 64 */
  47. /* PTE1 */ KEY_SEMICOLON, KEY_RIGHTBRACE, KEY_BACKSLASH, 0, KEY_A, 0, 0, 0, /* 65 -> 72 */
  48. KEY_S, KEY_D, KEY_F, KEY_L, KEY_K, KEY_J, KEY_G, KEY_H, /* 73 -> 80 */
  49. /* PTE3 */ KEY_KP8, KEY_LEFTMETA, KEY_RIGHTSHIFT, 0, KEY_TAB, 0, 0, 0, /* 81 -> 88 */
  50. 0, KEY_LEFTSHIFT, KEY_KP7, KEY_KP9, KEY_KP1, KEY_F11, KEY_KPPLUS, KEY_KPASTERISK, /* 89 -> 96 */
  51. /* PTE6 */ KEY_P, KEY_LEFTBRACE, KEY_BACKSPACE, 0, KEY_Q, 0, 0, 0, /* 97 -> 104 */
  52. KEY_W, KEY_E, KEY_R, KEY_O, KEY_I, KEY_U, KEY_T, KEY_Y, /* 105 -> 112 */
  53. /* PTE7 */ KEY_0, KEY_MINUS, KEY_EQUAL, 0, KEY_1, 0, 0, 0, /* 113 -> 120 */
  54. KEY_2, KEY_3, KEY_4, KEY_9, KEY_8, KEY_7, KEY_5, KEY_6, /* 121 -> 128 */
  55. /* **** */ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  56. 0, 0, 0, 0, 0
  57. };
  58. #define JORNADA_SCAN_SIZE 18
  59. struct jornadakbd {
  60. struct input_dev *input;
  61. unsigned short keymap[ARRAY_SIZE(jornada_scancodes)];
  62. unsigned char length;
  63. unsigned char old_scan[JORNADA_SCAN_SIZE];
  64. unsigned char new_scan[JORNADA_SCAN_SIZE];
  65. };
  66. static void jornada_parse_kbd(struct jornadakbd *jornadakbd)
  67. {
  68. struct input_dev *input_dev = jornadakbd->input;
  69. unsigned short *keymap = jornadakbd->keymap;
  70. unsigned int sync_me = 0;
  71. unsigned int i, j;
  72. for (i = 0; i < JORNADA_SCAN_SIZE; i++) {
  73. unsigned char new = jornadakbd->new_scan[i];
  74. unsigned char old = jornadakbd->old_scan[i];
  75. unsigned int xor = new ^ old;
  76. if (xor == 0)
  77. continue;
  78. for (j = 0; j < 8; j++) {
  79. unsigned int bit = 1 << j;
  80. if (xor & bit) {
  81. unsigned int scancode = (i << 3) + j;
  82. input_event(input_dev,
  83. EV_MSC, MSC_SCAN, scancode);
  84. input_report_key(input_dev,
  85. keymap[scancode],
  86. !(new & bit));
  87. sync_me = 1;
  88. }
  89. }
  90. }
  91. if (sync_me)
  92. input_sync(input_dev);
  93. }
  94. static void jornada_scan_keyb(unsigned char *s)
  95. {
  96. int i;
  97. unsigned short ec_static, dc_static; /* = UINT16_t */
  98. unsigned char matrix_switch[] = {
  99. 0xfd, 0xff, /* PTD1 PD(1) */
  100. 0xdf, 0xff, /* PTD5 PD(5) */
  101. 0x7f, 0xff, /* PTD7 PD(7) */
  102. 0xff, 0xfe, /* PTE0 PE(0) */
  103. 0xff, 0xfd, /* PTE1 PE(1) */
  104. 0xff, 0xf7, /* PTE3 PE(3) */
  105. 0xff, 0xbf, /* PTE6 PE(6) */
  106. 0xff, 0x7f, /* PTE7 PE(7) */
  107. }, *t = matrix_switch;
  108. /* PD(x) :
  109. 1. 0xcc0c & (1~(1 << (2*(x)+1)))))
  110. 2. (0xf0cf & 0xfffff) */
  111. /* PE(x) :
  112. 1. 0xcc0c & 0xffff
  113. 2. 0xf0cf & (1~(1 << (2*(x)+1))))) */
  114. unsigned short matrix_PDE[] = {
  115. 0xcc04, 0xf0cf, /* PD(1) */
  116. 0xc40c, 0xf0cf, /* PD(5) */
  117. 0x4c0c, 0xf0cf, /* PD(7) */
  118. 0xcc0c, 0xf0cd, /* PE(0) */
  119. 0xcc0c, 0xf0c7, /* PE(1) */
  120. 0xcc0c, 0xf04f, /* PE(3) */
  121. 0xcc0c, 0xd0cf, /* PE(6) */
  122. 0xcc0c, 0x70cf, /* PE(7) */
  123. }, *y = matrix_PDE;
  124. /* Save these control reg bits */
  125. dc_static = (__raw_readw(PDCR) & (~0xcc0c));
  126. ec_static = (__raw_readw(PECR) & (~0xf0cf));
  127. for (i = 0; i < 8; i++) {
  128. /* disable output for all but the one we want to scan */
  129. __raw_writew((dc_static | *y++), PDCR);
  130. __raw_writew((ec_static | *y++), PECR);
  131. udelay(5);
  132. /* Get scanline row */
  133. __raw_writeb(*t++, PDDR);
  134. __raw_writeb(*t++, PEDR);
  135. udelay(50);
  136. /* Read data */
  137. *s++ = __raw_readb(PCDR);
  138. *s++ = __raw_readb(PFDR);
  139. }
  140. /* Scan no lines */
  141. __raw_writeb(0xff, PDDR);
  142. __raw_writeb(0xff, PEDR);
  143. /* Enable all scanlines */
  144. __raw_writew((dc_static | (0x5555 & 0xcc0c)),PDCR);
  145. __raw_writew((ec_static | (0x5555 & 0xf0cf)),PECR);
  146. /* Ignore extra keys and events */
  147. *s++ = __raw_readb(PGDR);
  148. *s++ = __raw_readb(PHDR);
  149. }
  150. static void jornadakbd680_poll(struct input_dev *input)
  151. {
  152. struct jornadakbd *jornadakbd = input_get_drvdata(input);
  153. jornada_scan_keyb(jornadakbd->new_scan);
  154. jornada_parse_kbd(jornadakbd);
  155. memcpy(jornadakbd->old_scan, jornadakbd->new_scan, JORNADA_SCAN_SIZE);
  156. }
  157. static int jornada680kbd_probe(struct platform_device *pdev)
  158. {
  159. struct jornadakbd *jornadakbd;
  160. struct input_dev *input_dev;
  161. int i, error;
  162. jornadakbd = devm_kzalloc(&pdev->dev, sizeof(struct jornadakbd),
  163. GFP_KERNEL);
  164. if (!jornadakbd)
  165. return -ENOMEM;
  166. input_dev = devm_input_allocate_device(&pdev->dev);
  167. if (!input_dev) {
  168. dev_err(&pdev->dev, "failed to allocate input device\n");
  169. return -ENOMEM;
  170. }
  171. jornadakbd->input = input_dev;
  172. memcpy(jornadakbd->keymap, jornada_scancodes,
  173. sizeof(jornadakbd->keymap));
  174. input_set_drvdata(input_dev, jornadakbd);
  175. input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP);
  176. input_dev->name = "HP Jornada 680 keyboard";
  177. input_dev->phys = "jornadakbd/input0";
  178. input_dev->keycode = jornadakbd->keymap;
  179. input_dev->keycodesize = sizeof(unsigned short);
  180. input_dev->keycodemax = ARRAY_SIZE(jornada_scancodes);
  181. input_dev->id.bustype = BUS_HOST;
  182. for (i = 0; i < 128; i++)
  183. if (jornadakbd->keymap[i])
  184. __set_bit(jornadakbd->keymap[i], input_dev->keybit);
  185. __clear_bit(KEY_RESERVED, input_dev->keybit);
  186. input_set_capability(input_dev, EV_MSC, MSC_SCAN);
  187. error = input_setup_polling(input_dev, jornadakbd680_poll);
  188. if (error) {
  189. dev_err(&pdev->dev, "failed to set up polling\n");
  190. return error;
  191. }
  192. input_set_poll_interval(input_dev, 50 /* msec */);
  193. error = input_register_device(input_dev);
  194. if (error) {
  195. dev_err(&pdev->dev, "failed to register input device\n");
  196. return error;
  197. }
  198. return 0;
  199. }
  200. static struct platform_driver jornada680kbd_driver = {
  201. .driver = {
  202. .name = "jornada680_kbd",
  203. },
  204. .probe = jornada680kbd_probe,
  205. };
  206. module_platform_driver(jornada680kbd_driver);
  207. MODULE_AUTHOR("Kristoffer Ericson <kristoffer.ericson@gmail.com>");
  208. MODULE_DESCRIPTION("HP Jornada 620/660/680/690 Keyboard Driver");
  209. MODULE_LICENSE("GPL v2");
  210. MODULE_ALIAS("platform:jornada680_kbd");