1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/device.h>
15#include <linux/errno.h>
16#include <linux/interrupt.h>
17#include <linux/input.h>
18#include <linux/kernel.h>
19#include <linux/module.h>
20#include <linux/platform_device.h>
21#include <linux/slab.h>
22
23#include <mach/jornada720.h>
24
25MODULE_AUTHOR("Kristoffer Ericson <Kristoffer.Ericson@gmail.com>");
26MODULE_DESCRIPTION("HP Jornada 710/720/728 keyboard driver");
27MODULE_LICENSE("GPL v2");
28
29static unsigned short jornada_std_keymap[128] = {
30 0, KEY_ESC, KEY_F1, KEY_F2, KEY_F3, KEY_F4, KEY_F5, KEY_F6, KEY_F7,
31 KEY_F8, KEY_F9, KEY_F10, KEY_F11, KEY_VOLUMEUP, KEY_VOLUMEDOWN, KEY_MUTE,
32 0, KEY_1, KEY_2, KEY_3, KEY_4, KEY_5, KEY_6, KEY_7, KEY_8, KEY_9,
33 KEY_0, KEY_MINUS, KEY_EQUAL,0, 0, 0,
34 0, KEY_Q, KEY_W, KEY_E, KEY_R, KEY_T, KEY_Y, KEY_U, KEY_I, KEY_O,
35 KEY_P, KEY_BACKSLASH, KEY_BACKSPACE, 0, 0, 0,
36 0, KEY_A, KEY_S, KEY_D, KEY_F, KEY_G, KEY_H, KEY_J, KEY_K, KEY_L,
37 KEY_SEMICOLON, KEY_LEFTBRACE, KEY_RIGHTBRACE, 0, 0, 0,
38 0, KEY_Z, KEY_X, KEY_C, KEY_V, KEY_B, KEY_N, KEY_M, KEY_COMMA,
39 KEY_DOT, KEY_KPMINUS, KEY_APOSTROPHE, KEY_ENTER, 0, 0,0,
40 0, KEY_TAB, 0, KEY_LEFTSHIFT, 0, KEY_APOSTROPHE, 0, 0, 0, 0,
41 KEY_UP, 0, KEY_RIGHTSHIFT, 0, 0, 0,0, 0, 0, 0, 0, KEY_LEFTALT, KEY_GRAVE,
42 0, 0, KEY_LEFT, KEY_DOWN, KEY_RIGHT, 0, 0, 0, 0,0, KEY_KPASTERISK,
43 KEY_LEFTCTRL, 0, KEY_SPACE, 0, 0, 0, KEY_SLASH, KEY_DELETE, 0, 0,
44 0, 0, 0, KEY_POWER,
45};
46
47struct jornadakbd {
48 unsigned short keymap[ARRAY_SIZE(jornada_std_keymap)];
49 struct input_dev *input;
50};
51
52static irqreturn_t jornada720_kbd_interrupt(int irq, void *dev_id)
53{
54 struct platform_device *pdev = dev_id;
55 struct jornadakbd *jornadakbd = platform_get_drvdata(pdev);
56 struct input_dev *input = jornadakbd->input;
57 u8 count, kbd_data, scan_code;
58
59
60 jornada_ssp_start();
61
62 if (jornada_ssp_inout(GETSCANKEYCODE) != TXDUMMY) {
63 dev_dbg(&pdev->dev,
64 "GetKeycode command failed with ETIMEDOUT, flushed bus\n");
65 } else {
66
67 count = jornada_ssp_byte(TXDUMMY);
68
69
70 while (count--) {
71
72 kbd_data = jornada_ssp_byte(TXDUMMY);
73 scan_code = kbd_data & 0x7f;
74
75 input_event(input, EV_MSC, MSC_SCAN, scan_code);
76 input_report_key(input, jornadakbd->keymap[scan_code],
77 !(kbd_data & 0x80));
78 input_sync(input);
79 }
80 }
81
82
83 jornada_ssp_end();
84
85 return IRQ_HANDLED;
86};
87
88static int jornada720_kbd_probe(struct platform_device *pdev)
89{
90 struct jornadakbd *jornadakbd;
91 struct input_dev *input_dev;
92 int i, err, irq;
93
94 irq = platform_get_irq(pdev, 0);
95 if (irq <= 0)
96 return irq < 0 ? irq : -EINVAL;
97
98 jornadakbd = devm_kzalloc(&pdev->dev, sizeof(*jornadakbd), GFP_KERNEL);
99 input_dev = devm_input_allocate_device(&pdev->dev);
100 if (!jornadakbd || !input_dev)
101 return -ENOMEM;
102
103 platform_set_drvdata(pdev, jornadakbd);
104
105 memcpy(jornadakbd->keymap, jornada_std_keymap,
106 sizeof(jornada_std_keymap));
107 jornadakbd->input = input_dev;
108
109 input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP);
110 input_dev->name = "HP Jornada 720 keyboard";
111 input_dev->phys = "jornadakbd/input0";
112 input_dev->keycode = jornadakbd->keymap;
113 input_dev->keycodesize = sizeof(unsigned short);
114 input_dev->keycodemax = ARRAY_SIZE(jornada_std_keymap);
115 input_dev->id.bustype = BUS_HOST;
116 input_dev->dev.parent = &pdev->dev;
117
118 for (i = 0; i < ARRAY_SIZE(jornadakbd->keymap); i++)
119 __set_bit(jornadakbd->keymap[i], input_dev->keybit);
120 __clear_bit(KEY_RESERVED, input_dev->keybit);
121
122 input_set_capability(input_dev, EV_MSC, MSC_SCAN);
123
124 err = devm_request_irq(&pdev->dev, irq, jornada720_kbd_interrupt,
125 IRQF_TRIGGER_FALLING, "jornadakbd", pdev);
126 if (err) {
127 dev_err(&pdev->dev, "unable to grab IRQ%d: %d\n", irq, err);
128 return err;
129 }
130
131 return input_register_device(jornadakbd->input);
132};
133
134
135MODULE_ALIAS("platform:jornada720_kbd");
136
137static struct platform_driver jornada720_kbd_driver = {
138 .driver = {
139 .name = "jornada720_kbd",
140 },
141 .probe = jornada720_kbd_probe,
142};
143module_platform_driver(jornada720_kbd_driver);
144
