0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012
0013
0014
0015
0016 #include <linux/device.h>
0017 #include <linux/input.h>
0018 #include <linux/interrupt.h>
0019 #include <linux/jiffies.h>
0020 #include <linux/kernel.h>
0021 #include <linux/module.h>
0022 #include <linux/platform_device.h>
0023 #include <linux/slab.h>
0024
0025 #include <asm/delay.h>
0026 #include <asm/io.h>
0027
0028 #define PCCR 0xa4000104
0029 #define PDCR 0xa4000106
0030 #define PECR 0xa4000108
0031 #define PFCR 0xa400010a
0032 #define PCDR 0xa4000124
0033 #define PDDR 0xa4000126
0034 #define PEDR 0xa4000128
0035 #define PFDR 0xa400012a
0036 #define PGDR 0xa400012c
0037 #define PHDR 0xa400012e
0038 #define PJDR 0xa4000130
0039 #define PKDR 0xa4000132
0040 #define PLDR 0xa4000134
0041
0042 static const unsigned short jornada_scancodes[] = {
0043 KEY_CAPSLOCK, KEY_MACRO, KEY_LEFTCTRL, 0, KEY_ESC, KEY_KP5, 0, 0,
0044 KEY_F1, KEY_F2, KEY_F3, KEY_F8, KEY_F7, KEY_F6, KEY_F4, KEY_F5,
0045 KEY_SLASH, KEY_APOSTROPHE, KEY_ENTER, 0, KEY_Z, 0, 0, 0,
0046 KEY_X, KEY_C, KEY_V, KEY_DOT, KEY_COMMA, KEY_M, KEY_B, KEY_N,
0047 KEY_KP2, KEY_KP6, KEY_KP3, 0, 0, 0, 0, 0,
0048 KEY_F10, KEY_RO, KEY_F9, KEY_KP4, KEY_NUMLOCK, KEY_SCROLLLOCK, KEY_LEFTALT, KEY_HANJA,
0049 KEY_KATAKANA, KEY_KP0, KEY_GRAVE, 0, KEY_FINANCE, 0, 0, 0,
0050 KEY_KPMINUS, KEY_HIRAGANA, KEY_SPACE, KEY_KPDOT, KEY_VOLUMEUP, 249, 0, 0,
0051 KEY_SEMICOLON, KEY_RIGHTBRACE, KEY_BACKSLASH, 0, KEY_A, 0, 0, 0,
0052 KEY_S, KEY_D, KEY_F, KEY_L, KEY_K, KEY_J, KEY_G, KEY_H,
0053 KEY_KP8, KEY_LEFTMETA, KEY_RIGHTSHIFT, 0, KEY_TAB, 0, 0, 0,
0054 0, KEY_LEFTSHIFT, KEY_KP7, KEY_KP9, KEY_KP1, KEY_F11, KEY_KPPLUS, KEY_KPASTERISK,
0055 KEY_P, KEY_LEFTBRACE, KEY_BACKSPACE, 0, KEY_Q, 0, 0, 0,
0056 KEY_W, KEY_E, KEY_R, KEY_O, KEY_I, KEY_U, KEY_T, KEY_Y,
0057 KEY_0, KEY_MINUS, KEY_EQUAL, 0, KEY_1, 0, 0, 0,
0058 KEY_2, KEY_3, KEY_4, KEY_9, KEY_8, KEY_7, KEY_5, KEY_6,
0059 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
0060 0, 0, 0, 0, 0
0061 };
0062
0063 #define JORNADA_SCAN_SIZE 18
0064
0065 struct jornadakbd {
0066 struct input_dev *input;
0067 unsigned short keymap[ARRAY_SIZE(jornada_scancodes)];
0068 unsigned char length;
0069 unsigned char old_scan[JORNADA_SCAN_SIZE];
0070 unsigned char new_scan[JORNADA_SCAN_SIZE];
0071 };
0072
0073 static void jornada_parse_kbd(struct jornadakbd *jornadakbd)
0074 {
0075 struct input_dev *input_dev = jornadakbd->input;
0076 unsigned short *keymap = jornadakbd->keymap;
0077 unsigned int sync_me = 0;
0078 unsigned int i, j;
0079
0080 for (i = 0; i < JORNADA_SCAN_SIZE; i++) {
0081 unsigned char new = jornadakbd->new_scan[i];
0082 unsigned char old = jornadakbd->old_scan[i];
0083 unsigned int xor = new ^ old;
0084
0085 if (xor == 0)
0086 continue;
0087
0088 for (j = 0; j < 8; j++) {
0089 unsigned int bit = 1 << j;
0090 if (xor & bit) {
0091 unsigned int scancode = (i << 3) + j;
0092 input_event(input_dev,
0093 EV_MSC, MSC_SCAN, scancode);
0094 input_report_key(input_dev,
0095 keymap[scancode],
0096 !(new & bit));
0097 sync_me = 1;
0098 }
0099 }
0100 }
0101
0102 if (sync_me)
0103 input_sync(input_dev);
0104 }
0105
0106 static void jornada_scan_keyb(unsigned char *s)
0107 {
0108 int i;
0109 unsigned short ec_static, dc_static;
0110 unsigned char matrix_switch[] = {
0111 0xfd, 0xff,
0112 0xdf, 0xff,
0113 0x7f, 0xff,
0114 0xff, 0xfe,
0115 0xff, 0xfd,
0116 0xff, 0xf7,
0117 0xff, 0xbf,
0118 0xff, 0x7f,
0119 }, *t = matrix_switch;
0120
0121
0122
0123
0124
0125
0126 unsigned short matrix_PDE[] = {
0127 0xcc04, 0xf0cf,
0128 0xc40c, 0xf0cf,
0129 0x4c0c, 0xf0cf,
0130 0xcc0c, 0xf0cd,
0131 0xcc0c, 0xf0c7,
0132 0xcc0c, 0xf04f,
0133 0xcc0c, 0xd0cf,
0134 0xcc0c, 0x70cf,
0135 }, *y = matrix_PDE;
0136
0137
0138 dc_static = (__raw_readw(PDCR) & (~0xcc0c));
0139 ec_static = (__raw_readw(PECR) & (~0xf0cf));
0140
0141 for (i = 0; i < 8; i++) {
0142
0143 __raw_writew((dc_static | *y++), PDCR);
0144 __raw_writew((ec_static | *y++), PECR);
0145 udelay(5);
0146
0147
0148 __raw_writeb(*t++, PDDR);
0149 __raw_writeb(*t++, PEDR);
0150 udelay(50);
0151
0152
0153 *s++ = __raw_readb(PCDR);
0154 *s++ = __raw_readb(PFDR);
0155 }
0156
0157 __raw_writeb(0xff, PDDR);
0158 __raw_writeb(0xff, PEDR);
0159
0160
0161 __raw_writew((dc_static | (0x5555 & 0xcc0c)),PDCR);
0162 __raw_writew((ec_static | (0x5555 & 0xf0cf)),PECR);
0163
0164
0165 *s++ = __raw_readb(PGDR);
0166 *s++ = __raw_readb(PHDR);
0167 }
0168
0169 static void jornadakbd680_poll(struct input_dev *input)
0170 {
0171 struct jornadakbd *jornadakbd = input_get_drvdata(input);
0172
0173 jornada_scan_keyb(jornadakbd->new_scan);
0174 jornada_parse_kbd(jornadakbd);
0175 memcpy(jornadakbd->old_scan, jornadakbd->new_scan, JORNADA_SCAN_SIZE);
0176 }
0177
0178 static int jornada680kbd_probe(struct platform_device *pdev)
0179 {
0180 struct jornadakbd *jornadakbd;
0181 struct input_dev *input_dev;
0182 int i, error;
0183
0184 jornadakbd = devm_kzalloc(&pdev->dev, sizeof(struct jornadakbd),
0185 GFP_KERNEL);
0186 if (!jornadakbd)
0187 return -ENOMEM;
0188
0189 input_dev = devm_input_allocate_device(&pdev->dev);
0190 if (!input_dev) {
0191 dev_err(&pdev->dev, "failed to allocate input device\n");
0192 return -ENOMEM;
0193 }
0194
0195 jornadakbd->input = input_dev;
0196
0197 memcpy(jornadakbd->keymap, jornada_scancodes,
0198 sizeof(jornadakbd->keymap));
0199
0200 input_set_drvdata(input_dev, jornadakbd);
0201 input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP);
0202 input_dev->name = "HP Jornada 680 keyboard";
0203 input_dev->phys = "jornadakbd/input0";
0204 input_dev->keycode = jornadakbd->keymap;
0205 input_dev->keycodesize = sizeof(unsigned short);
0206 input_dev->keycodemax = ARRAY_SIZE(jornada_scancodes);
0207 input_dev->id.bustype = BUS_HOST;
0208
0209 for (i = 0; i < 128; i++)
0210 if (jornadakbd->keymap[i])
0211 __set_bit(jornadakbd->keymap[i], input_dev->keybit);
0212 __clear_bit(KEY_RESERVED, input_dev->keybit);
0213
0214 input_set_capability(input_dev, EV_MSC, MSC_SCAN);
0215
0216 error = input_setup_polling(input_dev, jornadakbd680_poll);
0217 if (error) {
0218 dev_err(&pdev->dev, "failed to set up polling\n");
0219 return error;
0220 }
0221
0222 input_set_poll_interval(input_dev, 50 );
0223
0224 error = input_register_device(input_dev);
0225 if (error) {
0226 dev_err(&pdev->dev, "failed to register input device\n");
0227 return error;
0228 }
0229
0230 return 0;
0231 }
0232
0233 static struct platform_driver jornada680kbd_driver = {
0234 .driver = {
0235 .name = "jornada680_kbd",
0236 },
0237 .probe = jornada680kbd_probe,
0238 };
0239 module_platform_driver(jornada680kbd_driver);
0240
0241 MODULE_AUTHOR("Kristoffer Ericson <kristoffer.ericson@gmail.com>");
0242 MODULE_DESCRIPTION("HP Jornada 620/660/680/690 Keyboard Driver");
0243 MODULE_LICENSE("GPL v2");
0244 MODULE_ALIAS("platform:jornada680_kbd");