omap-keypad.c 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491
  1. /*
  2. * linux/drivers/input/keyboard/omap-keypad.c
  3. *
  4. * OMAP Keypad Driver
  5. *
  6. * Copyright (C) 2003 Nokia Corporation
  7. * Written by Timo Teräs <ext-timo.teras@nokia.com>
  8. *
  9. * Added support for H2 & H3 Keypad
  10. * Copyright (C) 2004 Texas Instruments
  11. *
  12. * This program is free software; you can redistribute it and/or modify
  13. * it under the terms of the GNU General Public License as published by
  14. * the Free Software Foundation; either version 2 of the License, or
  15. * (at your option) any later version.
  16. *
  17. * This program is distributed in the hope that it will be useful,
  18. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  20. * GNU General Public License for more details.
  21. *
  22. * You should have received a copy of the GNU General Public License
  23. * along with this program; if not, write to the Free Software
  24. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  25. */
  26. #include <linux/module.h>
  27. #include <linux/init.h>
  28. #include <linux/interrupt.h>
  29. #include <linux/types.h>
  30. #include <linux/input.h>
  31. #include <linux/kernel.h>
  32. #include <linux/delay.h>
  33. #include <linux/platform_device.h>
  34. #include <linux/mutex.h>
  35. #include <linux/errno.h>
  36. #include <asm/arch/gpio.h>
  37. #include <asm/arch/keypad.h>
  38. #include <asm/arch/menelaus.h>
  39. #include <asm/irq.h>
  40. #include <asm/hardware.h>
  41. #include <asm/io.h>
  42. #include <asm/mach-types.h>
  43. #include <asm/arch/mux.h>
  44. #undef NEW_BOARD_LEARNING_MODE
  45. static void omap_kp_tasklet(unsigned long);
  46. static void omap_kp_timer(unsigned long);
  47. static unsigned char keypad_state[8];
  48. static DEFINE_MUTEX(kp_enable_mutex);
  49. static int kp_enable = 1;
  50. static int kp_cur_group = -1;
  51. struct omap_kp {
  52. struct input_dev *input;
  53. struct timer_list timer;
  54. int irq;
  55. unsigned int rows;
  56. unsigned int cols;
  57. unsigned long delay;
  58. unsigned int debounce;
  59. };
  60. DECLARE_TASKLET_DISABLED(kp_tasklet, omap_kp_tasklet, 0);
  61. static int *keymap;
  62. static unsigned int *row_gpios;
  63. static unsigned int *col_gpios;
  64. #ifdef CONFIG_ARCH_OMAP2
  65. static void set_col_gpio_val(struct omap_kp *omap_kp, u8 value)
  66. {
  67. int col;
  68. for (col = 0; col < omap_kp->cols; col++) {
  69. if (value & (1 << col))
  70. omap_set_gpio_dataout(col_gpios[col], 1);
  71. else
  72. omap_set_gpio_dataout(col_gpios[col], 0);
  73. }
  74. }
  75. static u8 get_row_gpio_val(struct omap_kp *omap_kp)
  76. {
  77. int row;
  78. u8 value = 0;
  79. for (row = 0; row < omap_kp->rows; row++) {
  80. if (omap_get_gpio_datain(row_gpios[row]))
  81. value |= (1 << row);
  82. }
  83. return value;
  84. }
  85. #else
  86. #define set_col_gpio_val(x, y) do {} while (0)
  87. #define get_row_gpio_val(x) 0
  88. #endif
  89. static irqreturn_t omap_kp_interrupt(int irq, void *dev_id)
  90. {
  91. struct omap_kp *omap_kp = dev_id;
  92. /* disable keyboard interrupt and schedule for handling */
  93. if (cpu_is_omap24xx()) {
  94. int i;
  95. for (i = 0; i < omap_kp->rows; i++)
  96. disable_irq(OMAP_GPIO_IRQ(row_gpios[i]));
  97. } else
  98. /* disable keyboard interrupt and schedule for handling */
  99. omap_writew(1, OMAP_MPUIO_BASE + OMAP_MPUIO_KBD_MASKIT);
  100. tasklet_schedule(&kp_tasklet);
  101. return IRQ_HANDLED;
  102. }
  103. static void omap_kp_timer(unsigned long data)
  104. {
  105. tasklet_schedule(&kp_tasklet);
  106. }
  107. static void omap_kp_scan_keypad(struct omap_kp *omap_kp, unsigned char *state)
  108. {
  109. int col = 0;
  110. /* read the keypad status */
  111. if (cpu_is_omap24xx()) {
  112. int i;
  113. for (i = 0; i < omap_kp->rows; i++)
  114. disable_irq(OMAP_GPIO_IRQ(row_gpios[i]));
  115. /* read the keypad status */
  116. for (col = 0; col < omap_kp->cols; col++) {
  117. set_col_gpio_val(omap_kp, ~(1 << col));
  118. state[col] = ~(get_row_gpio_val(omap_kp)) & 0x3f;
  119. }
  120. set_col_gpio_val(omap_kp, 0);
  121. } else {
  122. /* disable keyboard interrupt and schedule for handling */
  123. omap_writew(1, OMAP_MPUIO_BASE + OMAP_MPUIO_KBD_MASKIT);
  124. /* read the keypad status */
  125. omap_writew(0xff, OMAP_MPUIO_BASE + OMAP_MPUIO_KBC);
  126. for (col = 0; col < omap_kp->cols; col++) {
  127. omap_writew(~(1 << col) & 0xff,
  128. OMAP_MPUIO_BASE + OMAP_MPUIO_KBC);
  129. udelay(omap_kp->delay);
  130. state[col] = ~omap_readw(OMAP_MPUIO_BASE +
  131. OMAP_MPUIO_KBR_LATCH) & 0xff;
  132. }
  133. omap_writew(0x00, OMAP_MPUIO_BASE + OMAP_MPUIO_KBC);
  134. udelay(2);
  135. }
  136. }
  137. static inline int omap_kp_find_key(int col, int row)
  138. {
  139. int i, key;
  140. key = KEY(col, row, 0);
  141. for (i = 0; keymap[i] != 0; i++)
  142. if ((keymap[i] & 0xff000000) == key)
  143. return keymap[i] & 0x00ffffff;
  144. return -1;
  145. }
  146. static void omap_kp_tasklet(unsigned long data)
  147. {
  148. struct omap_kp *omap_kp_data = (struct omap_kp *) data;
  149. unsigned char new_state[8], changed, key_down = 0;
  150. int col, row;
  151. int spurious = 0;
  152. /* check for any changes */
  153. omap_kp_scan_keypad(omap_kp_data, new_state);
  154. /* check for changes and print those */
  155. for (col = 0; col < omap_kp_data->cols; col++) {
  156. changed = new_state[col] ^ keypad_state[col];
  157. key_down |= new_state[col];
  158. if (changed == 0)
  159. continue;
  160. for (row = 0; row < omap_kp_data->rows; row++) {
  161. int key;
  162. if (!(changed & (1 << row)))
  163. continue;
  164. #ifdef NEW_BOARD_LEARNING_MODE
  165. printk(KERN_INFO "omap-keypad: key %d-%d %s\n", col,
  166. row, (new_state[col] & (1 << row)) ?
  167. "pressed" : "released");
  168. #else
  169. key = omap_kp_find_key(col, row);
  170. if (key < 0) {
  171. printk(KERN_WARNING
  172. "omap-keypad: Spurious key event %d-%d\n",
  173. col, row);
  174. /* We scan again after a couple of seconds */
  175. spurious = 1;
  176. continue;
  177. }
  178. if (!(kp_cur_group == (key & GROUP_MASK) ||
  179. kp_cur_group == -1))
  180. continue;
  181. kp_cur_group = key & GROUP_MASK;
  182. input_report_key(omap_kp_data->input, key & ~GROUP_MASK,
  183. new_state[col] & (1 << row));
  184. #endif
  185. }
  186. }
  187. memcpy(keypad_state, new_state, sizeof(keypad_state));
  188. if (key_down) {
  189. int delay = HZ / 20;
  190. /* some key is pressed - keep irq disabled and use timer
  191. * to poll the keypad */
  192. if (spurious)
  193. delay = 2 * HZ;
  194. mod_timer(&omap_kp_data->timer, jiffies + delay);
  195. } else {
  196. /* enable interrupts */
  197. if (cpu_is_omap24xx()) {
  198. int i;
  199. for (i = 0; i < omap_kp_data->rows; i++)
  200. enable_irq(OMAP_GPIO_IRQ(row_gpios[i]));
  201. } else {
  202. omap_writew(0, OMAP_MPUIO_BASE + OMAP_MPUIO_KBD_MASKIT);
  203. kp_cur_group = -1;
  204. }
  205. }
  206. }
  207. static ssize_t omap_kp_enable_show(struct device *dev,
  208. struct device_attribute *attr, char *buf)
  209. {
  210. return sprintf(buf, "%u\n", kp_enable);
  211. }
  212. static ssize_t omap_kp_enable_store(struct device *dev, struct device_attribute *attr,
  213. const char *buf, size_t count)
  214. {
  215. int state;
  216. if (sscanf(buf, "%u", &state) != 1)
  217. return -EINVAL;
  218. if ((state != 1) && (state != 0))
  219. return -EINVAL;
  220. mutex_lock(&kp_enable_mutex);
  221. if (state != kp_enable) {
  222. if (state)
  223. enable_irq(INT_KEYBOARD);
  224. else
  225. disable_irq(INT_KEYBOARD);
  226. kp_enable = state;
  227. }
  228. mutex_unlock(&kp_enable_mutex);
  229. return strnlen(buf, count);
  230. }
  231. static DEVICE_ATTR(enable, S_IRUGO | S_IWUSR, omap_kp_enable_show, omap_kp_enable_store);
  232. #ifdef CONFIG_PM
  233. static int omap_kp_suspend(struct platform_device *dev, pm_message_t state)
  234. {
  235. /* Nothing yet */
  236. return 0;
  237. }
  238. static int omap_kp_resume(struct platform_device *dev)
  239. {
  240. /* Nothing yet */
  241. return 0;
  242. }
  243. #else
  244. #define omap_kp_suspend NULL
  245. #define omap_kp_resume NULL
  246. #endif
  247. static int __init omap_kp_probe(struct platform_device *pdev)
  248. {
  249. struct omap_kp *omap_kp;
  250. struct input_dev *input_dev;
  251. struct omap_kp_platform_data *pdata = pdev->dev.platform_data;
  252. int i, col_idx, row_idx, irq_idx, ret;
  253. if (!pdata->rows || !pdata->cols || !pdata->keymap) {
  254. printk(KERN_ERR "No rows, cols or keymap from pdata\n");
  255. return -EINVAL;
  256. }
  257. omap_kp = kzalloc(sizeof(struct omap_kp), GFP_KERNEL);
  258. input_dev = input_allocate_device();
  259. if (!omap_kp || !input_dev) {
  260. kfree(omap_kp);
  261. input_free_device(input_dev);
  262. return -ENOMEM;
  263. }
  264. platform_set_drvdata(pdev, omap_kp);
  265. omap_kp->input = input_dev;
  266. /* Disable the interrupt for the MPUIO keyboard */
  267. if (!cpu_is_omap24xx())
  268. omap_writew(1, OMAP_MPUIO_BASE + OMAP_MPUIO_KBD_MASKIT);
  269. keymap = pdata->keymap;
  270. if (pdata->rep)
  271. set_bit(EV_REP, input_dev->evbit);
  272. if (pdata->delay)
  273. omap_kp->delay = pdata->delay;
  274. if (pdata->row_gpios && pdata->col_gpios) {
  275. row_gpios = pdata->row_gpios;
  276. col_gpios = pdata->col_gpios;
  277. }
  278. omap_kp->rows = pdata->rows;
  279. omap_kp->cols = pdata->cols;
  280. if (cpu_is_omap24xx()) {
  281. /* Cols: outputs */
  282. for (col_idx = 0; col_idx < omap_kp->cols; col_idx++) {
  283. if (omap_request_gpio(col_gpios[col_idx]) < 0) {
  284. printk(KERN_ERR "Failed to request"
  285. "GPIO%d for keypad\n",
  286. col_gpios[col_idx]);
  287. goto err1;
  288. }
  289. omap_set_gpio_direction(col_gpios[col_idx], 0);
  290. }
  291. /* Rows: inputs */
  292. for (row_idx = 0; row_idx < omap_kp->rows; row_idx++) {
  293. if (omap_request_gpio(row_gpios[row_idx]) < 0) {
  294. printk(KERN_ERR "Failed to request"
  295. "GPIO%d for keypad\n",
  296. row_gpios[row_idx]);
  297. goto err2;
  298. }
  299. omap_set_gpio_direction(row_gpios[row_idx], 1);
  300. }
  301. }
  302. setup_timer(&omap_kp->timer, omap_kp_timer, (unsigned long)omap_kp);
  303. /* get the irq and init timer*/
  304. tasklet_enable(&kp_tasklet);
  305. kp_tasklet.data = (unsigned long) omap_kp;
  306. ret = device_create_file(&pdev->dev, &dev_attr_enable);
  307. if (ret < 0)
  308. goto err2;
  309. /* setup input device */
  310. set_bit(EV_KEY, input_dev->evbit);
  311. for (i = 0; keymap[i] != 0; i++)
  312. set_bit(keymap[i] & KEY_MAX, input_dev->keybit);
  313. input_dev->name = "omap-keypad";
  314. input_dev->phys = "omap-keypad/input0";
  315. input_dev->cdev.dev = &pdev->dev;
  316. input_dev->private = omap_kp;
  317. input_dev->id.bustype = BUS_HOST;
  318. input_dev->id.vendor = 0x0001;
  319. input_dev->id.product = 0x0001;
  320. input_dev->id.version = 0x0100;
  321. input_dev->keycode = keymap;
  322. input_dev->keycodesize = sizeof(unsigned int);
  323. input_dev->keycodemax = pdata->keymapsize;
  324. ret = input_register_device(omap_kp->input);
  325. if (ret < 0) {
  326. printk(KERN_ERR "Unable to register omap-keypad input device\n");
  327. goto err3;
  328. }
  329. if (pdata->dbounce)
  330. omap_writew(0xff, OMAP_MPUIO_BASE + OMAP_MPUIO_GPIO_DEBOUNCING);
  331. /* scan current status and enable interrupt */
  332. omap_kp_scan_keypad(omap_kp, keypad_state);
  333. if (!cpu_is_omap24xx()) {
  334. omap_kp->irq = platform_get_irq(pdev, 0);
  335. if (omap_kp->irq >= 0) {
  336. if (request_irq(omap_kp->irq, omap_kp_interrupt, 0,
  337. "omap-keypad", omap_kp) < 0)
  338. goto err4;
  339. }
  340. omap_writew(0, OMAP_MPUIO_BASE + OMAP_MPUIO_KBD_MASKIT);
  341. } else {
  342. for (irq_idx = 0; irq_idx < omap_kp->rows; irq_idx++) {
  343. if (request_irq(OMAP_GPIO_IRQ(row_gpios[irq_idx]),
  344. omap_kp_interrupt,
  345. IRQF_TRIGGER_FALLING,
  346. "omap-keypad", omap_kp) < 0)
  347. goto err5;
  348. }
  349. }
  350. return 0;
  351. err5:
  352. for (i = irq_idx-1; i >=0; i--)
  353. free_irq(row_gpios[i], 0);
  354. err4:
  355. input_unregister_device(omap_kp->input);
  356. input_dev = NULL;
  357. err3:
  358. device_remove_file(&pdev->dev, &dev_attr_enable);
  359. err2:
  360. for (i = row_idx-1; i >=0; i--)
  361. omap_free_gpio(row_gpios[i]);
  362. err1:
  363. for (i = col_idx-1; i >=0; i--)
  364. omap_free_gpio(col_gpios[i]);
  365. kfree(omap_kp);
  366. input_free_device(input_dev);
  367. return -EINVAL;
  368. }
  369. static int omap_kp_remove(struct platform_device *pdev)
  370. {
  371. struct omap_kp *omap_kp = platform_get_drvdata(pdev);
  372. /* disable keypad interrupt handling */
  373. tasklet_disable(&kp_tasklet);
  374. if (cpu_is_omap24xx()) {
  375. int i;
  376. for (i = 0; i < omap_kp->cols; i++)
  377. omap_free_gpio(col_gpios[i]);
  378. for (i = 0; i < omap_kp->rows; i++) {
  379. omap_free_gpio(row_gpios[i]);
  380. free_irq(OMAP_GPIO_IRQ(row_gpios[i]), 0);
  381. }
  382. } else {
  383. omap_writew(1, OMAP_MPUIO_BASE + OMAP_MPUIO_KBD_MASKIT);
  384. free_irq(omap_kp->irq, 0);
  385. }
  386. del_timer_sync(&omap_kp->timer);
  387. tasklet_kill(&kp_tasklet);
  388. /* unregister everything */
  389. input_unregister_device(omap_kp->input);
  390. kfree(omap_kp);
  391. return 0;
  392. }
  393. static struct platform_driver omap_kp_driver = {
  394. .probe = omap_kp_probe,
  395. .remove = omap_kp_remove,
  396. .suspend = omap_kp_suspend,
  397. .resume = omap_kp_resume,
  398. .driver = {
  399. .name = "omap-keypad",
  400. },
  401. };
  402. static int __devinit omap_kp_init(void)
  403. {
  404. printk(KERN_INFO "OMAP Keypad Driver\n");
  405. return platform_driver_register(&omap_kp_driver);
  406. }
  407. static void __exit omap_kp_exit(void)
  408. {
  409. platform_driver_unregister(&omap_kp_driver);
  410. }
  411. module_init(omap_kp_init);
  412. module_exit(omap_kp_exit);
  413. MODULE_AUTHOR("Timo Teräs");
  414. MODULE_DESCRIPTION("OMAP Keypad Driver");
  415. MODULE_LICENSE("GPL");