Input: add support for HP Jornada onboard keyboard (HP6XX)

Signed-off-by: Kristoffer Ericson <kristoffer.ericson@gmail.com>
Signed-off-by: Dmitry Torokhov <dtor@mail.ru>

3 files changed, 289 insertions, 0 deletions

diff --git a/drivers/input/keyboard/Kconfig b/drivers/input/keyboard/Kconfig
index c97d5eb0075d..1881900f24c8 100644
--- a/drivers/input/keyboard/Kconfig
+++ b/drivers/input/keyboard/Kconfig
@@ -208,6 +208,17 @@ config KEYBOARD_HIL
           This driver implements support for HIL-keyboards attached
           to your machine, so normally you should say Y here.
 
+config KEYBOARD_HP6XX
+        tristate "HP Jornada 6XX Keyboard support"
+        depends on SH_HP6XX
+        select INPUT_POLLDEV
+        help
+          This adds support for the onboard keyboard found on
+          HP Jornada 620/660/680/690.
+
+          To compile this driver as a module, choose M here: the
+          module will be called jornada680_kbd.
+
 config KEYBOARD_OMAP
         tristate "TI OMAP keypad support"
         depends on (ARCH_OMAP1 || ARCH_OMAP2)
diff --git a/drivers/input/keyboard/Makefile b/drivers/input/keyboard/Makefile
index 28d211b87b14..7ecd2b05a28a 100644
--- a/drivers/input/keyboard/Makefile
+++ b/drivers/input/keyboard/Makefile
@@ -21,4 +21,5 @@ obj-$(CONFIG_KEYBOARD_OMAP)		+= omap-keypad.o
 obj-$(CONFIG_KEYBOARD_PXA27x)           += pxa27x_keyboard.o
 obj-$(CONFIG_KEYBOARD_AAED2000)         += aaed2000_kbd.o
 obj-$(CONFIG_KEYBOARD_GPIO)             += gpio_keys.o
+obj-$(CONFIG_KEYBOARD_HP6XX)            += jornada680_kbd.o
 
diff --git a/drivers/input/keyboard/jornada680_kbd.c b/drivers/input/keyboard/jornada680_kbd.c
new file mode 100644
index 000000000000..bec1cf483723
--- /dev/null
+++ b/drivers/input/keyboard/jornada680_kbd.c
@@ -0,0 +1,277 @@
+/*
+ * drivers/input/keyboard/jornada680_kbd.c
+ *
+ * HP Jornada 620/660/680/690 scan keyboard platform driver
+ *  Copyright (C) 2007  Kristoffer Ericson <Kristoffer.Ericson@gmail.com>
+ *
+ * Based on hp680_keyb.c
+ *  Copyright (C) 2006 Paul Mundt
+ *  Copyright (C) 2005 Andriy Skulysh
+ * Split from drivers/input/keyboard/hp600_keyb.c
+ *  Copyright (C) 2000 Yaegashi Takeshi (hp6xx kbd scan routine and translation table)
+ *  Copyright (C) 2000 Niibe Yutaka (HP620 Keyb translation table)
+ *
+ * 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/input.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/input-polldev.h>
+#include <linux/jiffies.h>
+#include <linux/platform_device.h>
+#include <linux/interrupt.h>
+
+#include <asm/delay.h>
+#include <asm/io.h>
+
+#define PCCR 0xa4000104
+#define PDCR 0xa4000106
+#define PECR 0xa4000108
+#define PFCR 0xa400010a
+#define PCDR 0xa4000124
+#define PDDR 0xa4000126
+#define PEDR 0xa4000128
+#define PFDR 0xa400012a
+#define PGDR 0xa400012c
+#define PHDR 0xa400012e
+#define PJDR 0xa4000130
+#define PKDR 0xa4000132
+#define PLDR 0xa4000134
+
+static const unsigned short jornada_scancodes[] = {
+/* PTD1 */      KEY_CAPSLOCK, KEY_MACRO, KEY_LEFTCTRL, 0, KEY_ESC, 0, 0, 0,     /*  1  -> 8   */
+                KEY_F1, KEY_F2, KEY_F3, KEY_F8, KEY_F7, KEY_F2, KEY_F4, KEY_F5, /*  9  -> 16  */
+/* PTD5 */      KEY_SLASH, KEY_APOSTROPHE, KEY_ENTER, 0, KEY_Z, 0, 0, 0,        /*  17 -> 24  */
+                KEY_X, KEY_C, KEY_V, KEY_DOT, KEY_COMMA, KEY_M, KEY_B, KEY_N,   /*  25 -> 32  */
+/* PTD7 */      KEY_KP2, KEY_KP6, 0, 0, 0, 0, 0, 0,                             /*  33 -> 40  */
+                0, 0, 0, KEY_KP4, 0, 0, KEY_LEFTALT, KEY_HANJA,                 /*  41 -> 48  */
+/* PTE0 */      0, 0, 0, 0, KEY_FINANCE, 0, 0, 0,                               /*  49 -> 56  */
+                KEY_LEFTCTRL, 0, KEY_SPACE, KEY_KPDOT, KEY_VOLUMEUP, 249, 0, 0, /*  57 -> 64  */
+/* PTE1 */      KEY_SEMICOLON, KEY_RIGHTBRACE, KEY_BACKSLASH, 0, KEY_A, 0, 0, 0,/*  65 -> 72  */
+                KEY_S, KEY_D, KEY_F, KEY_L, KEY_K, KEY_J, KEY_G, KEY_H,         /*  73 -> 80  */
+/* PTE3 */      KEY_KP8, KEY_LEFTMETA, KEY_RIGHTSHIFT, 0, KEY_TAB, 0, 0,0,      /*  81 -> 88  */
+                0, KEY_LEFTSHIFT, 0, 0, 0, 0, 0, 0,                             /*  89 -> 96  */
+/* PTE6 */      KEY_P, KEY_LEFTBRACE, KEY_BACKSPACE, 0, KEY_Q, 0, 0, 0,         /*  97 -> 104 */
+                KEY_W, KEY_E, KEY_R, KEY_O, KEY_I, KEY_U, KEY_T, KEY_R,         /* 105 -> 112 */
+/* PTE7 */      KEY_0, KEY_MINUS, KEY_EQUAL, 0, KEY_1, 0, 0, 0,                 /* 113 -> 120 */
+                KEY_2, KEY_3, KEY_4, KEY_9, KEY_8, KEY_7, KEY_5, KEY_6,         /* 121 -> 128 */
+/* **** */      0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
+                0, 0, 0, 0, 0
+};
+
+#define JORNADA_SCAN_SIZE       18
+
+struct jornadakbd {
+        struct input_polled_dev *poll_dev;
+        unsigned short keymap[ARRAY_SIZE(jornada_scancodes)];
+        unsigned char length;
+        unsigned char old_scan[JORNADA_SCAN_SIZE];
+        unsigned char new_scan[JORNADA_SCAN_SIZE];
+};
+
+static void jornada_parse_kbd(struct jornadakbd *jornadakbd)
+{
+        struct input_dev *input_dev = jornadakbd->poll_dev->input;
+        unsigned short *keymap = jornadakbd->keymap;
+        unsigned int sync_me = 0;
+        unsigned int i, j;
+
+        for (i = 0; i < JORNADA_SCAN_SIZE; i++) {
+                unsigned char new = jornadakbd->new_scan[i];
+                unsigned char old = jornadakbd->old_scan[i];
+                unsigned int xor = new ^ old;
+
+                if (xor == 0)
+                        continue;
+
+                for (j = 0; j < 8; j++) {
+                        unsigned int bit = 1 << j;
+                        if (xor & bit) {
+                                unsigned int scancode = (i << 3) + j;
+                                input_event(input_dev,
+                                            EV_MSC, MSC_SCAN, scancode);
+                                input_report_key(input_dev,
+                                                 keymap[scancode],
+                                                 !(new & bit));
+                                sync_me = 1;
+                        }
+                }
+        }
+
+        if (sync_me)
+            input_sync(input_dev);
+}
+
+static void jornada_scan_keyb(unsigned char *s)
+{
+        int i;
+        unsigned short ec_static, dc_static; /* = UINT16_t */
+        unsigned char matrix_switch[] = {
+                0xfd, 0xff,   /* PTD1 PD(1) */
+                0xdf, 0xff,   /* PTD5 PD(5) */
+                0x7f, 0xff,   /* PTD7 PD(7) */
+                0xff, 0xfe,   /* PTE0 PE(0) */
+                0xff, 0xfd,   /* PTE1 PE(1) */
+                0xff, 0xf7,   /* PTE3 PE(3) */
+                0xff, 0xbf,   /* PTE6 PE(6) */
+                0xff, 0x7f,   /* PTE7 PE(7) */
+        }, *t = matrix_switch;
+        /* PD(x) :
+        1.   0xcc0c & (1~(1 << (2*(x)+1)))))
+        2.   (0xf0cf & 0xfffff) */
+        /* PE(x) :
+        1.   0xcc0c & 0xffff
+        2.   0xf0cf & (1~(1 << (2*(x)+1))))) */
+        unsigned short matrix_PDE[] = {
+                0xcc04, 0xf0cf,  /* PD(1) */
+                0xc40c, 0xf0cf,  /* PD(5) */
+                0x4c0c, 0xf0cf,  /* PD(7) */
+                0xcc0c, 0xf0cd,  /* PE(0) */
+                0xcc0c, 0xf0c7,  /* PE(1) */
+                0xcc0c, 0xf04f,  /* PE(3) */
+                0xcc0c, 0xd0cf,  /* PE(6) */
+                0xcc0c, 0x70cf,  /* PE(7) */
+        }, *y = matrix_PDE;
+
+        /* Save these control reg bits */
+        dc_static = (ctrl_inw(PDCR) & (~0xcc0c));
+        ec_static = (ctrl_inw(PECR) & (~0xf0cf));
+
+        for (i = 0; i < 8; i++) {
+                /* disable output for all but the one we want to scan */
+                ctrl_outw((dc_static | *y++), PDCR);
+                ctrl_outw((ec_static | *y++), PECR);
+                udelay(5);
+
+                /* Get scanline row */
+                ctrl_outb(*t++, PDDR);
+                ctrl_outb(*t++, PEDR);
+                udelay(50);
+
+                /* Read data */
+                *s++ = ctrl_inb(PCDR);
+                *s++ = ctrl_inb(PFDR);
+        }
+        /* Scan no lines */
+        ctrl_outb(0xff, PDDR);
+        ctrl_outb(0xff, PEDR);
+
+        /* Enable all scanlines */
+        ctrl_outw((dc_static | (0x5555 & 0xcc0c)),PDCR);
+        ctrl_outw((ec_static | (0x5555 & 0xf0cf)),PECR);
+
+        /* Ignore extra keys and events */
+        *s++ = ctrl_inb(PGDR);
+        *s++ = ctrl_inb(PHDR);
+}
+
+static void jornadakbd680_poll(struct input_polled_dev *dev)
+{
+        struct jornadakbd *jornadakbd = dev->private;
+
+        jornada_scan_keyb(jornadakbd->new_scan);
+        jornada_parse_kbd(jornadakbd);
+        memcpy(jornadakbd->old_scan, jornadakbd->new_scan, JORNADA_SCAN_SIZE);
+}
+
+static int __devinit jornada680kbd_probe(struct platform_device *pdev)
+{
+        struct jornadakbd *jornadakbd;
+        struct input_polled_dev *poll_dev;
+        struct input_dev *input_dev;
+        int i, error;
+
+        jornadakbd = kzalloc(sizeof(struct jornadakbd), GFP_KERNEL);
+        if (!jornadakbd)
+                return -ENOMEM;
+
+        poll_dev = input_allocate_polled_device();
+        if (!poll_dev) {
+                error = -ENOMEM;
+                goto failed;
+        }
+
+        platform_set_drvdata(pdev, jornadakbd);
+
+        jornadakbd->poll_dev = poll_dev;
+
+        memcpy(jornadakbd->keymap, jornada_scancodes,
+                sizeof(jornadakbd->keymap));
+
+        poll_dev->private = jornadakbd;
+        poll_dev->poll = jornadakbd680_poll;
+        poll_dev->poll_interval = 50; /* msec */
+
+        input_dev = poll_dev->input;
+        input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP);
+        input_dev->name = "HP Jornada 680 keyboard";
+        input_dev->phys = "jornadakbd/input0";
+        input_dev->keycode = jornadakbd->keymap;
+        input_dev->keycodesize = sizeof(unsigned short);
+        input_dev->keycodemax = ARRAY_SIZE(jornada_scancodes);
+        input_dev->dev.parent = &pdev->dev;
+        input_dev->id.bustype = BUS_HOST;
+
+        for (i = 0; i < 128; i++)
+                if (jornadakbd->keymap[i])
+                        __set_bit(jornadakbd->keymap[i], input_dev->keybit);
+        __clear_bit(KEY_RESERVED, input_dev->keybit);
+
+        input_set_capability(input_dev, EV_MSC, MSC_SCAN);
+
+        error = input_register_polled_device(jornadakbd->poll_dev);
+        if (error)
+                goto failed;
+
+        return 0;
+
+ failed:
+        printk(KERN_ERR "Jornadakbd: failed to register driver, error: %d\n",
+                error);
+        platform_set_drvdata(pdev, NULL);
+        input_free_polled_device(poll_dev);
+        kfree(jornadakbd);
+        return error;
+
+}
+
+static int __devexit jornada680kbd_remove(struct platform_device *pdev)
+{
+        struct jornadakbd *jornadakbd = platform_get_drvdata(pdev);
+
+        platform_set_drvdata(pdev, NULL);
+        input_unregister_polled_device(jornadakbd->poll_dev);
+        input_free_polled_device(jornadakbd->poll_dev);
+        kfree(jornadakbd);
+
+        return 0;
+}
+
+static struct platform_driver jornada680kbd_driver = {
+        .driver = {
+                .name   = "jornada680_kbd",
+        },
+        .probe  = jornada680kbd_probe,
+        .remove = __devexit_p(jornada680kbd_remove),
+};
+
+static int __init jornada680kbd_init(void)
+{
+        return platform_driver_register(&jornada680kbd_driver);
+}
+
+static void __exit jornada680kbd_exit(void)
+{
+        platform_driver_unregister(&jornada680kbd_driver);
+}
+
+module_init(jornada680kbd_init);
+module_exit(jornada680kbd_exit);
+
+MODULE_AUTHOR("Kristoffer Ericson <kristoffer.ericson@gmail.com>");
+MODULE_DESCRIPTION("HP Jornada 620/660/680/690 Keyboard Driver");
+MODULE_LICENSE("GPLv2");