aaed2000_kbd.c 5.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203
  1. /*
  2. * Keyboard driver for the AAED-2000 dev board
  3. *
  4. * Copyright (c) 2006 Nicolas Bellido Y Ortega
  5. *
  6. * Based on corgikbd.c
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License version 2 as
  10. * published by the Free Software Foundation.
  11. *
  12. */
  13. #include <linux/delay.h>
  14. #include <linux/platform_device.h>
  15. #include <linux/init.h>
  16. #include <linux/input.h>
  17. #include <linux/interrupt.h>
  18. #include <linux/jiffies.h>
  19. #include <linux/module.h>
  20. #include <linux/slab.h>
  21. #include <linux/workqueue.h>
  22. #include <asm/arch/hardware.h>
  23. #include <asm/arch/aaed2000.h>
  24. #define KB_ROWS 12
  25. #define KB_COLS 8
  26. #define KB_ROWMASK(r) (1 << (r))
  27. #define SCANCODE(r,c) (((c) * KB_ROWS) + (r))
  28. #define NR_SCANCODES (KB_COLS * KB_ROWS)
  29. #define SCAN_INTERVAL (50) /* ms */
  30. #define KB_ACTIVATE_DELAY (20) /* us */
  31. static unsigned char aaedkbd_keycode[NR_SCANCODES] = {
  32. KEY_9, KEY_0, KEY_MINUS, KEY_EQUAL, KEY_BACKSPACE, 0, KEY_SPACE, KEY_KP6, 0, KEY_KPDOT, 0, 0,
  33. KEY_K, KEY_M, KEY_O, KEY_DOT, KEY_SLASH, 0, KEY_F, 0, 0, 0, KEY_LEFTSHIFT, 0,
  34. KEY_I, KEY_P, KEY_LEFTBRACE, KEY_RIGHTBRACE, KEY_BACKSLASH, 0, 0, 0, 0, 0, KEY_RIGHTSHIFT, 0,
  35. KEY_8, KEY_L, KEY_SEMICOLON, KEY_APOSTROPHE, KEY_ENTER, 0, 0, 0, 0, 0, 0, 0,
  36. KEY_J, KEY_H, KEY_B, KEY_KP8, KEY_KP4, 0, KEY_C, KEY_D, KEY_S, KEY_A, 0, KEY_CAPSLOCK,
  37. KEY_Y, KEY_U, KEY_N, KEY_T, 0, 0, KEY_R, KEY_E, KEY_W, KEY_Q, 0, KEY_TAB,
  38. KEY_7, KEY_6, KEY_G, 0, KEY_5, 0, KEY_4, KEY_3, KEY_2, KEY_1, 0, KEY_GRAVE,
  39. 0, 0, KEY_COMMA, 0, KEY_KP2, 0, KEY_V, KEY_LEFTALT, KEY_X, KEY_Z, 0, KEY_LEFTCTRL
  40. };
  41. struct aaedkbd {
  42. unsigned char keycode[ARRAY_SIZE(aaedkbd_keycode)];
  43. struct input_dev *input;
  44. struct work_struct workq;
  45. int kbdscan_state[KB_COLS];
  46. int kbdscan_count[KB_COLS];
  47. };
  48. #define KBDSCAN_STABLE_COUNT 2
  49. static void aaedkbd_report_col(struct aaedkbd *aaedkbd,
  50. unsigned int col, unsigned int rowd)
  51. {
  52. unsigned int scancode, pressed;
  53. unsigned int row;
  54. for (row = 0; row < KB_ROWS; row++) {
  55. scancode = SCANCODE(row, col);
  56. pressed = rowd & KB_ROWMASK(row);
  57. input_report_key(aaedkbd->input, aaedkbd->keycode[scancode], pressed);
  58. }
  59. }
  60. /* Scan the hardware keyboard and push any changes up through the input layer */
  61. static void aaedkbd_work(void *data)
  62. {
  63. struct aaedkbd *aaedkbd = data;
  64. unsigned int col, rowd;
  65. col = 0;
  66. do {
  67. AAEC_GPIO_KSCAN = col + 8;
  68. udelay(KB_ACTIVATE_DELAY);
  69. rowd = AAED_EXT_GPIO & AAED_EGPIO_KBD_SCAN;
  70. if (rowd != aaedkbd->kbdscan_state[col]) {
  71. aaedkbd->kbdscan_count[col] = 0;
  72. aaedkbd->kbdscan_state[col] = rowd;
  73. } else if (++aaedkbd->kbdscan_count[col] >= KBDSCAN_STABLE_COUNT) {
  74. aaedkbd_report_col(aaedkbd, col, rowd);
  75. col++;
  76. }
  77. } while (col < KB_COLS);
  78. AAEC_GPIO_KSCAN = 0x07;
  79. input_sync(aaedkbd->input);
  80. schedule_delayed_work(&aaedkbd->workq, msecs_to_jiffies(SCAN_INTERVAL));
  81. }
  82. static int aaedkbd_open(struct input_dev *indev)
  83. {
  84. struct aaedkbd *aaedkbd = indev->private;
  85. schedule_delayed_work(&aaedkbd->workq, msecs_to_jiffies(SCAN_INTERVAL));
  86. return 0;
  87. }
  88. static void aaedkbd_close(struct input_dev *indev)
  89. {
  90. struct aaedkbd *aaedkbd = indev->private;
  91. cancel_delayed_work(&aaedkbd->workq);
  92. flush_scheduled_work();
  93. }
  94. static int __devinit aaedkbd_probe(struct platform_device *pdev)
  95. {
  96. struct aaedkbd *aaedkbd;
  97. struct input_dev *input_dev;
  98. int i;
  99. int error;
  100. aaedkbd = kzalloc(sizeof(struct aaedkbd), GFP_KERNEL);
  101. input_dev = input_allocate_device();
  102. if (!aaedkbd || !input_dev) {
  103. error = -ENOMEM;
  104. goto fail;
  105. }
  106. platform_set_drvdata(pdev, aaedkbd);
  107. aaedkbd->input = input_dev;
  108. /* Init keyboard rescan workqueue */
  109. INIT_WORK(&aaedkbd->workq, aaedkbd_work, aaedkbd);
  110. memcpy(aaedkbd->keycode, aaedkbd_keycode, sizeof(aaedkbd->keycode));
  111. input_dev->name = "AAED-2000 Keyboard";
  112. input_dev->phys = "aaedkbd/input0";
  113. input_dev->id.bustype = BUS_HOST;
  114. input_dev->id.vendor = 0x0001;
  115. input_dev->id.product = 0x0001;
  116. input_dev->id.version = 0x0100;
  117. input_dev->cdev.dev = &pdev->dev;
  118. input_dev->private = aaedkbd;
  119. input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP);
  120. input_dev->keycode = aaedkbd->keycode;
  121. input_dev->keycodesize = sizeof(unsigned char);
  122. input_dev->keycodemax = ARRAY_SIZE(aaedkbd_keycode);
  123. for (i = 0; i < ARRAY_SIZE(aaedkbd_keycode); i++)
  124. set_bit(aaedkbd->keycode[i], input_dev->keybit);
  125. clear_bit(0, input_dev->keybit);
  126. input_dev->open = aaedkbd_open;
  127. input_dev->close = aaedkbd_close;
  128. error = input_register_device(aaedkbd->input);
  129. if (error)
  130. goto fail;
  131. return 0;
  132. fail: kfree(aaedkbd);
  133. input_free_device(input_dev);
  134. return error;
  135. }
  136. static int __devexit aaedkbd_remove(struct platform_device *pdev)
  137. {
  138. struct aaedkbd *aaedkbd = platform_get_drvdata(pdev);
  139. input_unregister_device(aaedkbd->input);
  140. kfree(aaedkbd);
  141. return 0;
  142. }
  143. static struct platform_driver aaedkbd_driver = {
  144. .probe = aaedkbd_probe,
  145. .remove = __devexit_p(aaedkbd_remove),
  146. .driver = {
  147. .name = "aaed2000-keyboard",
  148. },
  149. };
  150. static int __init aaedkbd_init(void)
  151. {
  152. return platform_driver_register(&aaedkbd_driver);
  153. }
  154. static void __exit aaedkbd_exit(void)
  155. {
  156. platform_driver_unregister(&aaedkbd_driver);
  157. }
  158. module_init(aaedkbd_init);
  159. module_exit(aaedkbd_exit);
  160. MODULE_AUTHOR("Nicolas Bellido Y Ortega");
  161. MODULE_DESCRIPTION("AAED-2000 Keyboard Driver");
  162. MODULE_LICENSE("GPLv2");