| /* |
| * Keyboard driver for the AAED-2000 dev board |
| * |
| * Copyright (c) 2006 Nicolas Bellido Y Ortega |
| * |
| * Based on corgikbd.c |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| * |
| */ |
| |
| #include <linux/delay.h> |
| #include <linux/platform_device.h> |
| #include <linux/init.h> |
| #include <linux/input-polldev.h> |
| #include <linux/interrupt.h> |
| #include <linux/jiffies.h> |
| #include <linux/module.h> |
| #include <linux/slab.h> |
| |
| #include <asm/arch/hardware.h> |
| #include <asm/arch/aaed2000.h> |
| |
| #define KB_ROWS 12 |
| #define KB_COLS 8 |
| #define KB_ROWMASK(r) (1 << (r)) |
| #define SCANCODE(r,c) (((c) * KB_ROWS) + (r)) |
| #define NR_SCANCODES (KB_COLS * KB_ROWS) |
| |
| #define SCAN_INTERVAL (50) /* ms */ |
| #define KB_ACTIVATE_DELAY (20) /* us */ |
| |
| static unsigned char aaedkbd_keycode[NR_SCANCODES] = { |
| KEY_9, KEY_0, KEY_MINUS, KEY_EQUAL, KEY_BACKSPACE, 0, KEY_SPACE, KEY_KP6, 0, KEY_KPDOT, 0, 0, |
| KEY_K, KEY_M, KEY_O, KEY_DOT, KEY_SLASH, 0, KEY_F, 0, 0, 0, KEY_LEFTSHIFT, 0, |
| KEY_I, KEY_P, KEY_LEFTBRACE, KEY_RIGHTBRACE, KEY_BACKSLASH, 0, 0, 0, 0, 0, KEY_RIGHTSHIFT, 0, |
| KEY_8, KEY_L, KEY_SEMICOLON, KEY_APOSTROPHE, KEY_ENTER, 0, 0, 0, 0, 0, 0, 0, |
| KEY_J, KEY_H, KEY_B, KEY_KP8, KEY_KP4, 0, KEY_C, KEY_D, KEY_S, KEY_A, 0, KEY_CAPSLOCK, |
| KEY_Y, KEY_U, KEY_N, KEY_T, 0, 0, KEY_R, KEY_E, KEY_W, KEY_Q, 0, KEY_TAB, |
| KEY_7, KEY_6, KEY_G, 0, KEY_5, 0, KEY_4, KEY_3, KEY_2, KEY_1, 0, KEY_GRAVE, |
| 0, 0, KEY_COMMA, 0, KEY_KP2, 0, KEY_V, KEY_LEFTALT, KEY_X, KEY_Z, 0, KEY_LEFTCTRL |
| }; |
| |
| struct aaedkbd { |
| unsigned char keycode[ARRAY_SIZE(aaedkbd_keycode)]; |
| struct input_polled_dev *poll_dev; |
| int kbdscan_state[KB_COLS]; |
| int kbdscan_count[KB_COLS]; |
| }; |
| |
| #define KBDSCAN_STABLE_COUNT 2 |
| |
| static void aaedkbd_report_col(struct aaedkbd *aaedkbd, |
| unsigned int col, unsigned int rowd) |
| { |
| unsigned int scancode, pressed; |
| unsigned int row; |
| |
| for (row = 0; row < KB_ROWS; row++) { |
| scancode = SCANCODE(row, col); |
| pressed = rowd & KB_ROWMASK(row); |
| |
| input_report_key(aaedkbd->poll_dev->input, |
| aaedkbd->keycode[scancode], pressed); |
| } |
| } |
| |
| /* Scan the hardware keyboard and push any changes up through the input layer */ |
| static void aaedkbd_poll(struct input_polled_dev *dev) |
| { |
| struct aaedkbd *aaedkbd = dev->private; |
| unsigned int col, rowd; |
| |
| col = 0; |
| do { |
| AAEC_GPIO_KSCAN = col + 8; |
| udelay(KB_ACTIVATE_DELAY); |
| rowd = AAED_EXT_GPIO & AAED_EGPIO_KBD_SCAN; |
| |
| if (rowd != aaedkbd->kbdscan_state[col]) { |
| aaedkbd->kbdscan_count[col] = 0; |
| aaedkbd->kbdscan_state[col] = rowd; |
| } else if (++aaedkbd->kbdscan_count[col] >= KBDSCAN_STABLE_COUNT) { |
| aaedkbd_report_col(aaedkbd, col, rowd); |
| col++; |
| } |
| } while (col < KB_COLS); |
| |
| AAEC_GPIO_KSCAN = 0x07; |
| input_sync(dev->input); |
| } |
| |
| static int __devinit aaedkbd_probe(struct platform_device *pdev) |
| { |
| struct aaedkbd *aaedkbd; |
| struct input_polled_dev *poll_dev; |
| struct input_dev *input_dev; |
| int i; |
| int error; |
| |
| aaedkbd = kzalloc(sizeof(struct aaedkbd), GFP_KERNEL); |
| poll_dev = input_allocate_polled_device(); |
| if (!aaedkbd || !poll_dev) { |
| error = -ENOMEM; |
| goto fail; |
| } |
| |
| platform_set_drvdata(pdev, aaedkbd); |
| |
| aaedkbd->poll_dev = poll_dev; |
| memcpy(aaedkbd->keycode, aaedkbd_keycode, sizeof(aaedkbd->keycode)); |
| |
| poll_dev->private = aaedkbd; |
| poll_dev->poll = aaedkbd_poll; |
| poll_dev->poll_interval = SCAN_INTERVAL; |
| |
| input_dev = poll_dev->input; |
| input_dev->name = "AAED-2000 Keyboard"; |
| input_dev->phys = "aaedkbd/input0"; |
| input_dev->id.bustype = BUS_HOST; |
| input_dev->id.vendor = 0x0001; |
| input_dev->id.product = 0x0001; |
| input_dev->id.version = 0x0100; |
| input_dev->dev.parent = &pdev->dev; |
| |
| input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP); |
| input_dev->keycode = aaedkbd->keycode; |
| input_dev->keycodesize = sizeof(unsigned char); |
| input_dev->keycodemax = ARRAY_SIZE(aaedkbd_keycode); |
| |
| for (i = 0; i < ARRAY_SIZE(aaedkbd_keycode); i++) |
| set_bit(aaedkbd->keycode[i], input_dev->keybit); |
| clear_bit(0, input_dev->keybit); |
| |
| error = input_register_polled_device(aaedkbd->poll_dev); |
| if (error) |
| goto fail; |
| |
| return 0; |
| |
| fail: kfree(aaedkbd); |
| input_free_polled_device(poll_dev); |
| return error; |
| } |
| |
| static int __devexit aaedkbd_remove(struct platform_device *pdev) |
| { |
| struct aaedkbd *aaedkbd = platform_get_drvdata(pdev); |
| |
| input_unregister_polled_device(aaedkbd->poll_dev); |
| input_free_polled_device(aaedkbd->poll_dev); |
| kfree(aaedkbd); |
| |
| return 0; |
| } |
| |
| /* work with hotplug and coldplug */ |
| MODULE_ALIAS("platform:aaed2000-keyboard"); |
| |
| static struct platform_driver aaedkbd_driver = { |
| .probe = aaedkbd_probe, |
| .remove = __devexit_p(aaedkbd_remove), |
| .driver = { |
| .name = "aaed2000-keyboard", |
| .owner = THIS_MODULE, |
| }, |
| }; |
| |
| static int __init aaedkbd_init(void) |
| { |
| return platform_driver_register(&aaedkbd_driver); |
| } |
| |
| static void __exit aaedkbd_exit(void) |
| { |
| platform_driver_unregister(&aaedkbd_driver); |
| } |
| |
| module_init(aaedkbd_init); |
| module_exit(aaedkbd_exit); |
| |
| MODULE_AUTHOR("Nicolas Bellido Y Ortega"); |
| MODULE_DESCRIPTION("AAED-2000 Keyboard Driver"); |
| MODULE_LICENSE("GPLv2"); |