forked from luck/tmp_suning_uos_patched
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>
This commit is contained in:
parent
1788180eec
commit
2aa2cb9e7a
@ -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)
|
||||
|
@ -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
|
||||
|
||||
|
277
drivers/input/keyboard/jornada680_kbd.c
Normal file
277
drivers/input/keyboard/jornada680_kbd.c
Normal file
@ -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");
|
Loading…
Reference in New Issue
Block a user