s3c-keypad.c 7.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333
  1. /*
  2. * drivers/input/keyboard/s3c-keypad.c
  3. * KeyPad Interface on S3C
  4. *
  5. * $Id: s3c-keypad.c,v 1.2 2008/02/29 01:57:09 wizardsj Exp $
  6. *
  7. * This file is subject to the terms and conditions of the GNU General Public
  8. * License. See the file COPYING in the main directory of this archive
  9. * for more details.
  10. */
  11. #include <linux/module.h>
  12. #include <linux/kernel.h>
  13. #include <linux/init.h>
  14. #include <linux/interrupt.h>
  15. #include <linux/input.h>
  16. #include <linux/platform_device.h>
  17. #include <linux/miscdevice.h>
  18. #include <asm/hardware.h>
  19. #include <asm/io.h>
  20. #include <asm/delay.h>
  21. #include <asm/irq.h>
  22. #include <asm/arch/regs-gpio.h>
  23. #include <asm/arch/regs-keypad.h>
  24. #include "s3c-keypad.h"
  25. #undef S3C_KEYPAD_DEBUG
  26. //#define S3C_KEYPAD_DEBUG
  27. #ifdef S3C_KEYPAD_DEBUG
  28. #define DPRINTK(x...) printk("S3C-Keypad " x)
  29. #else
  30. #define DPRINTK(x...) /* !!!! */
  31. #endif
  32. #define DEVICE_NAME "s3c-keypad"
  33. #define TRUE 1
  34. #define FALSE 0
  35. static struct timer_list keypad_timer;
  36. static int is_timer_on = FALSE;
  37. static int keypad_scan(u32 *keymask_low, u32 *keymask_high)
  38. {
  39. int i,j = 0;
  40. u32 cval,rval;
  41. for (i=0; i<KEYPAD_COLUMNS; i++) {
  42. cval = readl(key_base+S3C_KEYIFCOL) | KEYCOL_DMASK;
  43. cval &= ~(1 << i);
  44. writel(cval, key_base+S3C_KEYIFCOL);
  45. udelay(KEYPAD_DELAY);
  46. rval = ~(readl(key_base+S3C_KEYIFROW)) & KEYROW_DMASK;
  47. if ((i*KEYPAD_ROWS) < MAX_KEYMASK_NR)
  48. *keymask_low |= (rval << (i * KEYPAD_ROWS));
  49. else {
  50. *keymask_high |= (rval << (j * KEYPAD_ROWS));
  51. j = j +1;
  52. }
  53. }
  54. writel(KEYIFCOL_CLEAR, key_base+S3C_KEYIFCOL);
  55. return 0;
  56. }
  57. static unsigned prevmask_low = 0, prevmask_high = 0;
  58. static void keypad_timer_handler(unsigned long data)
  59. {
  60. u32 keymask_low = 0, keymask_high = 0;
  61. u32 press_mask_low, press_mask_high;
  62. u32 release_mask_low, release_mask_high;
  63. int i;
  64. struct s3c_keypad *pdata = (struct s3c_keypad *)data;
  65. struct input_dev *dev = pdata->dev;
  66. keypad_scan(&keymask_low, &keymask_high);
  67. if (keymask_low != prevmask_low) {
  68. press_mask_low =
  69. ((keymask_low ^ prevmask_low) & keymask_low);
  70. release_mask_low =
  71. ((keymask_low ^ prevmask_low) & prevmask_low);
  72. i = 0;
  73. while (press_mask_low) {
  74. if (press_mask_low & 1) {
  75. input_report_key(dev,pdata->keycodes[i],1);
  76. DPRINTK("low Pressed : %d\n",i);
  77. }
  78. press_mask_low >>= 1;
  79. i++;
  80. }
  81. i = 0;
  82. while (release_mask_low) {
  83. if (release_mask_low & 1) {
  84. input_report_key(dev,pdata->keycodes[i],0);
  85. DPRINTK("low Released : %d\n",i);
  86. }
  87. release_mask_low >>= 1;
  88. i++;
  89. }
  90. prevmask_low = keymask_low;
  91. }
  92. if (keymask_high != prevmask_high) {
  93. press_mask_high =
  94. ((keymask_high ^ prevmask_high) & keymask_high);
  95. release_mask_high =
  96. ((keymask_high ^ prevmask_high) & prevmask_high);
  97. i = 0;
  98. while (press_mask_high) {
  99. if (press_mask_high & 1) {
  100. input_report_key(dev,pdata->keycodes[i+MAX_KEYMASK_NR],1);
  101. DPRINTK("high Pressed : %d %d\n",pdata->keycodes[i+MAX_KEYMASK_NR],i);
  102. }
  103. press_mask_high >>= 1;
  104. i++;
  105. }
  106. i = 0;
  107. while (release_mask_high) {
  108. if (release_mask_high & 1) {
  109. input_report_key(dev,pdata->keycodes[i+MAX_KEYMASK_NR],0);
  110. DPRINTK("high Released : %d\n",pdata->keycodes[i+MAX_KEYMASK_NR]);
  111. }
  112. release_mask_high >>= 1;
  113. i++;
  114. }
  115. prevmask_high = keymask_high;
  116. }
  117. if (keymask_low | keymask_high) {
  118. mod_timer(&keypad_timer,jiffies + HZ/10);
  119. } else {
  120. writel(KEYIFCON_INIT, key_base+S3C_KEYIFCON);
  121. is_timer_on = FALSE;
  122. }
  123. }
  124. static irqreturn_t s3c_keypad_isr(int irq, void *dev_id)
  125. {
  126. /* disable keypad interrupt and schedule for keypad timer handler */
  127. writel(readl(key_base+S3C_KEYIFCON) & ~(INT_F_EN|INT_R_EN), key_base+S3C_KEYIFCON);
  128. keypad_timer.expires = jiffies + (HZ/100);
  129. if ( is_timer_on == FALSE) {
  130. add_timer(&keypad_timer);
  131. is_timer_on = TRUE;
  132. } else {
  133. mod_timer(&keypad_timer,keypad_timer.expires);
  134. }
  135. /*Clear the keypad interrupt status*/
  136. writel(KEYIFSTSCLR_CLEAR, key_base+S3C_KEYIFSTSCLR);
  137. return IRQ_HANDLED;
  138. }
  139. static int __init s3c_keypad_probe(struct platform_device *pdev)
  140. {
  141. int ret = 0;
  142. struct input_dev *input_dev;
  143. int key, code;
  144. struct s3c_keypad *s3c_keypad;
  145. key_base = ioremap(S3C24XX_PA_KEYPAD, S3C24XX_SZ_KEYPAD);
  146. if (key_base == NULL) {
  147. printk(KERN_ERR "Failed to remap register block\n");
  148. return -ENOMEM;
  149. }
  150. s3c_keypad = kzalloc(sizeof(struct s3c_keypad), GFP_KERNEL);
  151. input_dev = input_allocate_device();
  152. if (!s3c_keypad || !input_dev) {
  153. kfree(s3c_keypad);
  154. input_free_device(input_dev);
  155. return -ENOMEM;
  156. }
  157. platform_set_drvdata(pdev, s3c_keypad);
  158. s3c_keypad->dev = input_dev;
  159. writel(KEYIFCON_INIT, key_base+S3C_KEYIFCON);
  160. writel(KEYIFFC_DIV, key_base+S3C_KEYIFFC);
  161. /* Set GPIO Port for keypad mode and pull-up disable*/
  162. writel(KEYPAD_ROW_GPIO_SET, KEYPAD_ROW_GPIOCON);
  163. writel(KEYPAD_COL_GPIO_SET, KEYPAD_COL_GPIOCON);
  164. writel(KEYPAD_ROW_GPIOPUD_DIS, KEYPAD_ROW_GPIOPUD);
  165. writel(KEYPAD_COL_GPIOPUD_DIS, KEYPAD_COL_GPIOPUD);
  166. writel(KEYIFCOL_CLEAR, key_base+S3C_KEYIFCOL);
  167. /* create and register the input driver */
  168. set_bit(EV_KEY, input_dev->evbit);
  169. set_bit(EV_REP, input_dev->evbit);
  170. s3c_keypad->nr_rows = KEYPAD_ROWS;
  171. s3c_keypad->no_cols = KEYPAD_COLUMNS;
  172. s3c_keypad->total_keys = MAX_KEYPAD_NR;
  173. for(key = 0; key < s3c_keypad->total_keys; key++){
  174. code = s3c_keypad->keycodes[key] = keypad_keycode[key];
  175. if(code<=0)
  176. continue;
  177. set_bit(code & KEY_MAX, input_dev->keybit);
  178. }
  179. input_dev->name = DEVICE_NAME;
  180. input_dev->phys = "s3c-keypad/input0";
  181. input_dev->cdev.dev = &pdev->dev;
  182. input_dev->private = s3c_keypad;
  183. input_dev->id.bustype = BUS_HOST;
  184. input_dev->id.vendor = 0x0001;
  185. input_dev->id.product = 0x0001;
  186. input_dev->id.version = 0x0001;
  187. input_dev->keycode = keypad_keycode;
  188. input_register_device(input_dev);
  189. /* Scan timer init */
  190. init_timer(&keypad_timer);
  191. keypad_timer.function = keypad_timer_handler;
  192. keypad_timer.data = (unsigned long)s3c_keypad;
  193. ret = request_irq(IRQ_KEYPAD, s3c_keypad_isr, SA_SAMPLE_RANDOM,
  194. DEVICE_NAME, (void *) pdev);
  195. if (ret) {
  196. printk("request_irq failed (IRQ_KEYPAD) !!!\n");
  197. goto out;
  198. }
  199. keypad_timer.expires = jiffies + (HZ/10);
  200. if (is_timer_on == FALSE) {
  201. add_timer(&keypad_timer);
  202. is_timer_on = TRUE;
  203. } else {
  204. mod_timer(&keypad_timer,keypad_timer.expires);
  205. }
  206. printk( DEVICE_NAME " Initialized\n");
  207. return 0;
  208. out:
  209. input_unregister_device(input_dev);
  210. kfree(s3c_keypad);
  211. return ret;
  212. }
  213. static int s3c_keypad_remove(struct platform_device *pdev)
  214. {
  215. struct input_dev *input_dev = platform_get_drvdata(pdev);
  216. writel(KEYIFCON_CLEAR, key_base+S3C_KEYIFCON);
  217. input_unregister_device(input_dev);
  218. kfree(pdev->dev.platform_data);
  219. free_irq(IRQ_KEYPAD, (void *) pdev);
  220. del_timer(&keypad_timer);
  221. printk(DEVICE_NAME " Removed.\n");
  222. return 0;
  223. }
  224. #ifdef CONFIG_PM
  225. static int s3c_keypad_suspend(struct platform_device *dev, pm_message_t state)
  226. {
  227. /* TODO */
  228. return 0;
  229. }
  230. static int s3c_keypad_resume(struct platform_device *dev)
  231. {
  232. /* TODO */
  233. return 0;
  234. }
  235. #else
  236. #define s3c_keypad_suspend NULL
  237. #define s3c_keypad_resume NULL
  238. #endif /* CONFIG_PM */
  239. static struct platform_driver s3c_keypad_driver = {
  240. .probe = s3c_keypad_probe,
  241. .remove = s3c_keypad_remove,
  242. .suspend = s3c_keypad_suspend,
  243. .resume = s3c_keypad_resume,
  244. .driver = {
  245. .owner = THIS_MODULE,
  246. .name = "s3c-keypad",
  247. },
  248. };
  249. static int __init s3c_keypad_init(void)
  250. {
  251. int ret;
  252. ret = platform_driver_register(&s3c_keypad_driver);
  253. if(!ret)
  254. printk(KERN_INFO "S3C Keypad Driver\n");
  255. return ret;
  256. }
  257. static void __exit s3c_keypad_exit(void)
  258. {
  259. platform_driver_unregister(&s3c_keypad_driver);
  260. }
  261. module_init(s3c_keypad_init);
  262. module_exit(s3c_keypad_exit);
  263. MODULE_AUTHOR("Samsung");
  264. MODULE_LICENSE("GPL");
  265. MODULE_DESCRIPTION("KeyPad interface for Samsung S3C");