Merge git://git.kernel.org/pub/scm/linux/kernel/git/paulus/powerpc
[linux-2.6] / drivers / input / keyboard / atkbd.c
1 /*
2  * AT and PS/2 keyboard driver
3  *
4  * Copyright (c) 1999-2002 Vojtech Pavlik
5  */
6
7 /*
8  * This program is free software; you can redistribute it and/or modify it
9  * under the terms of the GNU General Public License version 2 as published by
10  * the Free Software Foundation.
11  */
12
13 /*
14  * This driver can handle standard AT keyboards and PS/2 keyboards in
15  * Translated and Raw Set 2 and Set 3, as well as AT keyboards on dumb
16  * input-only controllers and AT keyboards connected over a one way RS232
17  * converter.
18  */
19
20 #include <linux/delay.h>
21 #include <linux/module.h>
22 #include <linux/moduleparam.h>
23 #include <linux/slab.h>
24 #include <linux/interrupt.h>
25 #include <linux/init.h>
26 #include <linux/input.h>
27 #include <linux/serio.h>
28 #include <linux/workqueue.h>
29 #include <linux/libps2.h>
30 #include <linux/mutex.h>
31
32 #define DRIVER_DESC     "AT and PS/2 keyboard driver"
33
34 MODULE_AUTHOR("Vojtech Pavlik <vojtech@suse.cz>");
35 MODULE_DESCRIPTION(DRIVER_DESC);
36 MODULE_LICENSE("GPL");
37
38 static int atkbd_set = 2;
39 module_param_named(set, atkbd_set, int, 0);
40 MODULE_PARM_DESC(set, "Select keyboard code set (2 = default, 3 = PS/2 native)");
41
42 #if defined(__i386__) || defined(__x86_64__) || defined(__hppa__)
43 static int atkbd_reset;
44 #else
45 static int atkbd_reset = 1;
46 #endif
47 module_param_named(reset, atkbd_reset, bool, 0);
48 MODULE_PARM_DESC(reset, "Reset keyboard during initialization");
49
50 static int atkbd_softrepeat;
51 module_param_named(softrepeat, atkbd_softrepeat, bool, 0);
52 MODULE_PARM_DESC(softrepeat, "Use software keyboard repeat");
53
54 static int atkbd_softraw = 1;
55 module_param_named(softraw, atkbd_softraw, bool, 0);
56 MODULE_PARM_DESC(softraw, "Use software generated rawmode");
57
58 static int atkbd_scroll;
59 module_param_named(scroll, atkbd_scroll, bool, 0);
60 MODULE_PARM_DESC(scroll, "Enable scroll-wheel on MS Office and similar keyboards");
61
62 static int atkbd_extra;
63 module_param_named(extra, atkbd_extra, bool, 0);
64 MODULE_PARM_DESC(extra, "Enable extra LEDs and keys on IBM RapidAcces, EzKey and similar keyboards");
65
66 __obsolete_setup("atkbd_set=");
67 __obsolete_setup("atkbd_reset");
68 __obsolete_setup("atkbd_softrepeat=");
69
70 /*
71  * Scancode to keycode tables. These are just the default setting, and
72  * are loadable via an userland utility.
73  */
74
75 static unsigned char atkbd_set2_keycode[512] = {
76
77 #ifdef CONFIG_KEYBOARD_ATKBD_HP_KEYCODES
78
79 /* XXX: need a more general approach */
80
81 #include "hpps2atkbd.h" /* include the keyboard scancodes */
82
83 #else
84           0, 67, 65, 63, 61, 59, 60, 88,  0, 68, 66, 64, 62, 15, 41,117,
85           0, 56, 42, 93, 29, 16,  2,  0,  0,  0, 44, 31, 30, 17,  3,  0,
86           0, 46, 45, 32, 18,  5,  4, 95,  0, 57, 47, 33, 20, 19,  6,183,
87           0, 49, 48, 35, 34, 21,  7,184,  0,  0, 50, 36, 22,  8,  9,185,
88           0, 51, 37, 23, 24, 11, 10,  0,  0, 52, 53, 38, 39, 25, 12,  0,
89           0, 89, 40,  0, 26, 13,  0,  0, 58, 54, 28, 27,  0, 43,  0, 85,
90           0, 86, 91, 90, 92,  0, 14, 94,  0, 79,124, 75, 71,121,  0,  0,
91          82, 83, 80, 76, 77, 72,  1, 69, 87, 78, 81, 74, 55, 73, 70, 99,
92
93           0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
94         217,100,255,  0, 97,165,  0,  0,156,  0,  0,  0,  0,  0,  0,125,
95         173,114,  0,113,  0,  0,  0,126,128,  0,  0,140,  0,  0,  0,127,
96         159,  0,115,  0,164,  0,  0,116,158,  0,150,166,  0,  0,  0,142,
97         157,  0,  0,  0,  0,  0,  0,  0,155,  0, 98,  0,  0,163,  0,  0,
98         226,  0,  0,  0,  0,  0,  0,  0,  0,255, 96,  0,  0,  0,143,  0,
99           0,  0,  0,  0,  0,  0,  0,  0,  0,107,  0,105,102,  0,  0,112,
100         110,111,108,112,106,103,  0,119,  0,118,109,  0, 99,104,119,  0,
101
102           0,  0,  0, 65, 99,
103 #endif
104 };
105
106 static unsigned char atkbd_set3_keycode[512] = {
107
108           0,  0,  0,  0,  0,  0,  0, 59,  1,138,128,129,130, 15, 41, 60,
109         131, 29, 42, 86, 58, 16,  2, 61,133, 56, 44, 31, 30, 17,  3, 62,
110         134, 46, 45, 32, 18,  5,  4, 63,135, 57, 47, 33, 20, 19,  6, 64,
111         136, 49, 48, 35, 34, 21,  7, 65,137,100, 50, 36, 22,  8,  9, 66,
112         125, 51, 37, 23, 24, 11, 10, 67,126, 52, 53, 38, 39, 25, 12, 68,
113         113,114, 40, 43, 26, 13, 87, 99, 97, 54, 28, 27, 43, 43, 88, 70,
114         108,105,119,103,111,107, 14,110,  0, 79,106, 75, 71,109,102,104,
115          82, 83, 80, 76, 77, 72, 69, 98,  0, 96, 81,  0, 78, 73, 55,183,
116
117         184,185,186,187, 74, 94, 92, 93,  0,  0,  0,125,126,127,112,  0,
118           0,139,150,163,165,115,152,150,166,140,160,154,113,114,167,168,
119         148,149,147,140
120 };
121
122 static unsigned char atkbd_unxlate_table[128] = {
123           0,118, 22, 30, 38, 37, 46, 54, 61, 62, 70, 69, 78, 85,102, 13,
124          21, 29, 36, 45, 44, 53, 60, 67, 68, 77, 84, 91, 90, 20, 28, 27,
125          35, 43, 52, 51, 59, 66, 75, 76, 82, 14, 18, 93, 26, 34, 33, 42,
126          50, 49, 58, 65, 73, 74, 89,124, 17, 41, 88,  5,  6,  4, 12,  3,
127          11,  2, 10,  1,  9,119,126,108,117,125,123,107,115,116,121,105,
128         114,122,112,113,127, 96, 97,120,  7, 15, 23, 31, 39, 47, 55, 63,
129          71, 79, 86, 94,  8, 16, 24, 32, 40, 48, 56, 64, 72, 80, 87,111,
130          19, 25, 57, 81, 83, 92, 95, 98, 99,100,101,103,104,106,109,110
131 };
132
133 #define ATKBD_CMD_SETLEDS       0x10ed
134 #define ATKBD_CMD_GSCANSET      0x11f0
135 #define ATKBD_CMD_SSCANSET      0x10f0
136 #define ATKBD_CMD_GETID         0x02f2
137 #define ATKBD_CMD_SETREP        0x10f3
138 #define ATKBD_CMD_ENABLE        0x00f4
139 #define ATKBD_CMD_RESET_DIS     0x00f5
140 #define ATKBD_CMD_SETALL_MBR    0x00fa
141 #define ATKBD_CMD_RESET_BAT     0x02ff
142 #define ATKBD_CMD_RESEND        0x00fe
143 #define ATKBD_CMD_EX_ENABLE     0x10ea
144 #define ATKBD_CMD_EX_SETLEDS    0x20eb
145 #define ATKBD_CMD_OK_GETID      0x02e8
146
147 #define ATKBD_RET_ACK           0xfa
148 #define ATKBD_RET_NAK           0xfe
149 #define ATKBD_RET_BAT           0xaa
150 #define ATKBD_RET_EMUL0         0xe0
151 #define ATKBD_RET_EMUL1         0xe1
152 #define ATKBD_RET_RELEASE       0xf0
153 #define ATKBD_RET_HANJA         0xf1
154 #define ATKBD_RET_HANGEUL       0xf2
155 #define ATKBD_RET_ERR           0xff
156
157 #define ATKBD_KEY_UNKNOWN         0
158 #define ATKBD_KEY_NULL          255
159
160 #define ATKBD_SCR_1             254
161 #define ATKBD_SCR_2             253
162 #define ATKBD_SCR_4             252
163 #define ATKBD_SCR_8             251
164 #define ATKBD_SCR_CLICK         250
165 #define ATKBD_SCR_LEFT          249
166 #define ATKBD_SCR_RIGHT         248
167
168 #define ATKBD_SPECIAL           248
169
170 #define ATKBD_LED_EVENT_BIT     0
171 #define ATKBD_REP_EVENT_BIT     1
172
173 #define ATKBD_XL_ERR            0x01
174 #define ATKBD_XL_BAT            0x02
175 #define ATKBD_XL_ACK            0x04
176 #define ATKBD_XL_NAK            0x08
177 #define ATKBD_XL_HANGEUL        0x10
178 #define ATKBD_XL_HANJA          0x20
179
180 static struct {
181         unsigned char keycode;
182         unsigned char set2;
183 } atkbd_scroll_keys[] = {
184         { ATKBD_SCR_1,     0xc5 },
185         { ATKBD_SCR_2,     0x9d },
186         { ATKBD_SCR_4,     0xa4 },
187         { ATKBD_SCR_8,     0x9b },
188         { ATKBD_SCR_CLICK, 0xe0 },
189         { ATKBD_SCR_LEFT,  0xcb },
190         { ATKBD_SCR_RIGHT, 0xd2 },
191 };
192
193 /*
194  * The atkbd control structure
195  */
196
197 struct atkbd {
198
199         struct ps2dev ps2dev;
200         struct input_dev *dev;
201
202         /* Written only during init */
203         char name[64];
204         char phys[32];
205
206         unsigned short id;
207         unsigned char keycode[512];
208         unsigned char set;
209         unsigned char translated;
210         unsigned char extra;
211         unsigned char write;
212         unsigned char softrepeat;
213         unsigned char softraw;
214         unsigned char scroll;
215         unsigned char enabled;
216
217         /* Accessed only from interrupt */
218         unsigned char emul;
219         unsigned char resend;
220         unsigned char release;
221         unsigned long xl_bit;
222         unsigned int last;
223         unsigned long time;
224
225         struct work_struct event_work;
226         struct mutex event_mutex;
227         unsigned long event_mask;
228 };
229
230 static ssize_t atkbd_attr_show_helper(struct device *dev, char *buf,
231                                 ssize_t (*handler)(struct atkbd *, char *));
232 static ssize_t atkbd_attr_set_helper(struct device *dev, const char *buf, size_t count,
233                                 ssize_t (*handler)(struct atkbd *, const char *, size_t));
234 #define ATKBD_DEFINE_ATTR(_name)                                                \
235 static ssize_t atkbd_show_##_name(struct atkbd *, char *);                      \
236 static ssize_t atkbd_set_##_name(struct atkbd *, const char *, size_t);         \
237 static ssize_t atkbd_do_show_##_name(struct device *d, struct device_attribute *attr, char *b)                  \
238 {                                                                               \
239         return atkbd_attr_show_helper(d, b, atkbd_show_##_name);                \
240 }                                                                               \
241 static ssize_t atkbd_do_set_##_name(struct device *d, struct device_attribute *attr, const char *b, size_t s)   \
242 {                                                                               \
243         return atkbd_attr_set_helper(d, b, s, atkbd_set_##_name);               \
244 }                                                                               \
245 static struct device_attribute atkbd_attr_##_name =                             \
246         __ATTR(_name, S_IWUSR | S_IRUGO, atkbd_do_show_##_name, atkbd_do_set_##_name);
247
248 ATKBD_DEFINE_ATTR(extra);
249 ATKBD_DEFINE_ATTR(scroll);
250 ATKBD_DEFINE_ATTR(set);
251 ATKBD_DEFINE_ATTR(softrepeat);
252 ATKBD_DEFINE_ATTR(softraw);
253
254 static const unsigned int xl_table[] = {
255         ATKBD_RET_BAT, ATKBD_RET_ERR, ATKBD_RET_ACK,
256         ATKBD_RET_NAK, ATKBD_RET_HANJA, ATKBD_RET_HANGEUL,
257 };
258
259 /*
260  * Checks if we should mangle the scancode to extract 'release' bit
261  * in translated mode.
262  */
263 static int atkbd_need_xlate(unsigned long xl_bit, unsigned char code)
264 {
265         int i;
266
267         if (code == ATKBD_RET_EMUL0 || code == ATKBD_RET_EMUL1)
268                 return 0;
269
270         for (i = 0; i < ARRAY_SIZE(xl_table); i++)
271                 if (code == xl_table[i])
272                         return test_bit(i, &xl_bit);
273
274         return 1;
275 }
276
277 /*
278  * Calculates new value of xl_bit so the driver can distinguish
279  * between make/break pair of scancodes for select keys and PS/2
280  * protocol responses.
281  */
282 static void atkbd_calculate_xl_bit(struct atkbd *atkbd, unsigned char code)
283 {
284         int i;
285
286         for (i = 0; i < ARRAY_SIZE(xl_table); i++) {
287                 if (!((code ^ xl_table[i]) & 0x7f)) {
288                         if (code & 0x80)
289                                 __clear_bit(i, &atkbd->xl_bit);
290                         else
291                                 __set_bit(i, &atkbd->xl_bit);
292                         break;
293                 }
294         }
295 }
296
297 /*
298  * Encode the scancode, 0xe0 prefix, and high bit into a single integer,
299  * keeping kernel 2.4 compatibility for set 2
300  */
301 static unsigned int atkbd_compat_scancode(struct atkbd *atkbd, unsigned int code)
302 {
303         if (atkbd->set == 3) {
304                 if (atkbd->emul == 1)
305                         code |= 0x100;
306         } else {
307                 code = (code & 0x7f) | ((code & 0x80) << 1);
308                 if (atkbd->emul == 1)
309                         code |= 0x80;
310         }
311
312         return code;
313 }
314
315 /*
316  * atkbd_interrupt(). Here takes place processing of data received from
317  * the keyboard into events.
318  */
319
320 static irqreturn_t atkbd_interrupt(struct serio *serio, unsigned char data,
321                         unsigned int flags, struct pt_regs *regs)
322 {
323         struct atkbd *atkbd = serio_get_drvdata(serio);
324         struct input_dev *dev = atkbd->dev;
325         unsigned int code = data;
326         int scroll = 0, hscroll = 0, click = -1, add_release_event = 0;
327         int value;
328         unsigned char keycode;
329
330 #ifdef ATKBD_DEBUG
331         printk(KERN_DEBUG "atkbd.c: Received %02x flags %02x\n", data, flags);
332 #endif
333
334 #if !defined(__i386__) && !defined (__x86_64__)
335         if ((flags & (SERIO_FRAME | SERIO_PARITY)) && (~flags & SERIO_TIMEOUT) && !atkbd->resend && atkbd->write) {
336                 printk(KERN_WARNING "atkbd.c: frame/parity error: %02x\n", flags);
337                 serio_write(serio, ATKBD_CMD_RESEND);
338                 atkbd->resend = 1;
339                 goto out;
340         }
341
342         if (!flags && data == ATKBD_RET_ACK)
343                 atkbd->resend = 0;
344 #endif
345
346         if (unlikely(atkbd->ps2dev.flags & PS2_FLAG_ACK))
347                 if  (ps2_handle_ack(&atkbd->ps2dev, data))
348                         goto out;
349
350         if (unlikely(atkbd->ps2dev.flags & PS2_FLAG_CMD))
351                 if  (ps2_handle_response(&atkbd->ps2dev, data))
352                         goto out;
353
354         if (!atkbd->enabled)
355                 goto out;
356
357         input_event(dev, EV_MSC, MSC_RAW, code);
358
359         if (atkbd->translated) {
360
361                 if (atkbd->emul || atkbd_need_xlate(atkbd->xl_bit, code)) {
362                         atkbd->release = code >> 7;
363                         code &= 0x7f;
364                 }
365
366                 if (!atkbd->emul)
367                         atkbd_calculate_xl_bit(atkbd, data);
368         }
369
370         switch (code) {
371                 case ATKBD_RET_BAT:
372                         atkbd->enabled = 0;
373                         serio_reconnect(atkbd->ps2dev.serio);
374                         goto out;
375                 case ATKBD_RET_EMUL0:
376                         atkbd->emul = 1;
377                         goto out;
378                 case ATKBD_RET_EMUL1:
379                         atkbd->emul = 2;
380                         goto out;
381                 case ATKBD_RET_RELEASE:
382                         atkbd->release = 1;
383                         goto out;
384                 case ATKBD_RET_ACK:
385                 case ATKBD_RET_NAK:
386                         printk(KERN_WARNING "atkbd.c: Spurious %s on %s. "
387                                "Some program might be trying access hardware directly.\n",
388                                data == ATKBD_RET_ACK ? "ACK" : "NAK", serio->phys);
389                         goto out;
390                 case ATKBD_RET_HANGEUL:
391                 case ATKBD_RET_HANJA:
392                         /*
393                          * These keys do not report release and thus need to be
394                          * flagged properly
395                          */
396                         add_release_event = 1;
397                         break;
398                 case ATKBD_RET_ERR:
399                         printk(KERN_DEBUG "atkbd.c: Keyboard on %s reports too many keys pressed.\n", serio->phys);
400                         goto out;
401         }
402
403         code = atkbd_compat_scancode(atkbd, code);
404
405         if (atkbd->emul && --atkbd->emul)
406                 goto out;
407
408         keycode = atkbd->keycode[code];
409
410         if (keycode != ATKBD_KEY_NULL)
411                 input_event(dev, EV_MSC, MSC_SCAN, code);
412
413         switch (keycode) {
414                 case ATKBD_KEY_NULL:
415                         break;
416                 case ATKBD_KEY_UNKNOWN:
417                         printk(KERN_WARNING
418                                "atkbd.c: Unknown key %s (%s set %d, code %#x on %s).\n",
419                                atkbd->release ? "released" : "pressed",
420                                atkbd->translated ? "translated" : "raw",
421                                atkbd->set, code, serio->phys);
422                         printk(KERN_WARNING
423                                "atkbd.c: Use 'setkeycodes %s%02x <keycode>' to make it known.\n",
424                                code & 0x80 ? "e0" : "", code & 0x7f);
425                         input_sync(dev);
426                         break;
427                 case ATKBD_SCR_1:
428                         scroll = 1 - atkbd->release * 2;
429                         break;
430                 case ATKBD_SCR_2:
431                         scroll = 2 - atkbd->release * 4;
432                         break;
433                 case ATKBD_SCR_4:
434                         scroll = 4 - atkbd->release * 8;
435                         break;
436                 case ATKBD_SCR_8:
437                         scroll = 8 - atkbd->release * 16;
438                         break;
439                 case ATKBD_SCR_CLICK:
440                         click = !atkbd->release;
441                         break;
442                 case ATKBD_SCR_LEFT:
443                         hscroll = -1;
444                         break;
445                 case ATKBD_SCR_RIGHT:
446                         hscroll = 1;
447                         break;
448                 default:
449                         if (atkbd->release) {
450                                 value = 0;
451                                 atkbd->last = 0;
452                         } else if (!atkbd->softrepeat && test_bit(keycode, dev->key)) {
453                                 /* Workaround Toshiba laptop multiple keypress */
454                                 value = time_before(jiffies, atkbd->time) && atkbd->last == code ? 1 : 2;
455                         } else {
456                                 value = 1;
457                                 atkbd->last = code;
458                                 atkbd->time = jiffies + msecs_to_jiffies(dev->rep[REP_DELAY]) / 2;
459                         }
460
461                         input_regs(dev, regs);
462                         input_event(dev, EV_KEY, keycode, value);
463                         input_sync(dev);
464
465                         if (value && add_release_event) {
466                                 input_report_key(dev, keycode, 0);
467                                 input_sync(dev);
468                         }
469         }
470
471         if (atkbd->scroll) {
472                 input_regs(dev, regs);
473                 if (click != -1)
474                         input_report_key(dev, BTN_MIDDLE, click);
475                 input_report_rel(dev, REL_WHEEL, scroll);
476                 input_report_rel(dev, REL_HWHEEL, hscroll);
477                 input_sync(dev);
478         }
479
480         atkbd->release = 0;
481 out:
482         return IRQ_HANDLED;
483 }
484
485 static int atkbd_set_repeat_rate(struct atkbd *atkbd)
486 {
487         const short period[32] =
488                 { 33,  37,  42,  46,  50,  54,  58,  63,  67,  75,  83,  92, 100, 109, 116, 125,
489                  133, 149, 167, 182, 200, 217, 232, 250, 270, 303, 333, 370, 400, 435, 470, 500 };
490         const short delay[4] =
491                 { 250, 500, 750, 1000 };
492
493         struct input_dev *dev = atkbd->dev;
494         unsigned char param;
495         int i = 0, j = 0;
496
497         while (i < ARRAY_SIZE(period) - 1 && period[i] < dev->rep[REP_PERIOD])
498                 i++;
499         dev->rep[REP_PERIOD] = period[i];
500
501         while (j < ARRAY_SIZE(delay) - 1 && delay[j] < dev->rep[REP_DELAY])
502                 j++;
503         dev->rep[REP_DELAY] = delay[j];
504
505         param = i | (j << 5);
506         return ps2_command(&atkbd->ps2dev, &param, ATKBD_CMD_SETREP);
507 }
508
509 static int atkbd_set_leds(struct atkbd *atkbd)
510 {
511         struct input_dev *dev = atkbd->dev;
512         unsigned char param[2];
513
514         param[0] = (test_bit(LED_SCROLLL, dev->led) ? 1 : 0)
515                  | (test_bit(LED_NUML,    dev->led) ? 2 : 0)
516                  | (test_bit(LED_CAPSL,   dev->led) ? 4 : 0);
517         if (ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_SETLEDS))
518                 return -1;
519
520         if (atkbd->extra) {
521                 param[0] = 0;
522                 param[1] = (test_bit(LED_COMPOSE, dev->led) ? 0x01 : 0)
523                          | (test_bit(LED_SLEEP,   dev->led) ? 0x02 : 0)
524                          | (test_bit(LED_SUSPEND, dev->led) ? 0x04 : 0)
525                          | (test_bit(LED_MISC,    dev->led) ? 0x10 : 0)
526                          | (test_bit(LED_MUTE,    dev->led) ? 0x20 : 0);
527                 if (ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_EX_SETLEDS))
528                         return -1;
529         }
530
531         return 0;
532 }
533
534 /*
535  * atkbd_event_work() is used to complete processing of events that
536  * can not be processed by input_event() which is often called from
537  * interrupt context.
538  */
539
540 static void atkbd_event_work(void *data)
541 {
542         struct atkbd *atkbd = data;
543
544         mutex_lock(&atkbd->event_mutex);
545
546         if (test_and_clear_bit(ATKBD_LED_EVENT_BIT, &atkbd->event_mask))
547                 atkbd_set_leds(atkbd);
548
549         if (test_and_clear_bit(ATKBD_REP_EVENT_BIT, &atkbd->event_mask))
550                 atkbd_set_repeat_rate(atkbd);
551
552         mutex_unlock(&atkbd->event_mutex);
553 }
554
555 /*
556  * Event callback from the input module. Events that change the state of
557  * the hardware are processed here. If action can not be performed in
558  * interrupt context it is offloaded to atkbd_event_work.
559  */
560
561 static int atkbd_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
562 {
563         struct atkbd *atkbd = dev->private;
564
565         if (!atkbd->write)
566                 return -1;
567
568         switch (type) {
569
570                 case EV_LED:
571                         set_bit(ATKBD_LED_EVENT_BIT, &atkbd->event_mask);
572                         wmb();
573                         schedule_work(&atkbd->event_work);
574                         return 0;
575
576                 case EV_REP:
577
578                         if (!atkbd->softrepeat) {
579                                 set_bit(ATKBD_REP_EVENT_BIT, &atkbd->event_mask);
580                                 wmb();
581                                 schedule_work(&atkbd->event_work);
582                         }
583
584                         return 0;
585         }
586
587         return -1;
588 }
589
590 /*
591  * atkbd_enable() signals that interrupt handler is allowed to
592  * generate input events.
593  */
594
595 static inline void atkbd_enable(struct atkbd *atkbd)
596 {
597         serio_pause_rx(atkbd->ps2dev.serio);
598         atkbd->enabled = 1;
599         serio_continue_rx(atkbd->ps2dev.serio);
600 }
601
602 /*
603  * atkbd_disable() tells input handler that all incoming data except
604  * for ACKs and command response should be dropped.
605  */
606
607 static inline void atkbd_disable(struct atkbd *atkbd)
608 {
609         serio_pause_rx(atkbd->ps2dev.serio);
610         atkbd->enabled = 0;
611         serio_continue_rx(atkbd->ps2dev.serio);
612 }
613
614 /*
615  * atkbd_probe() probes for an AT keyboard on a serio port.
616  */
617
618 static int atkbd_probe(struct atkbd *atkbd)
619 {
620         struct ps2dev *ps2dev = &atkbd->ps2dev;
621         unsigned char param[2];
622
623 /*
624  * Some systems, where the bit-twiddling when testing the io-lines of the
625  * controller may confuse the keyboard need a full reset of the keyboard. On
626  * these systems the BIOS also usually doesn't do it for us.
627  */
628
629         if (atkbd_reset)
630                 if (ps2_command(ps2dev, NULL, ATKBD_CMD_RESET_BAT))
631                         printk(KERN_WARNING "atkbd.c: keyboard reset failed on %s\n", ps2dev->serio->phys);
632
633 /*
634  * Then we check the keyboard ID. We should get 0xab83 under normal conditions.
635  * Some keyboards report different values, but the first byte is always 0xab or
636  * 0xac. Some old AT keyboards don't report anything. If a mouse is connected, this
637  * should make sure we don't try to set the LEDs on it.
638  */
639
640         param[0] = param[1] = 0xa5;     /* initialize with invalid values */
641         if (ps2_command(ps2dev, param, ATKBD_CMD_GETID)) {
642
643 /*
644  * If the get ID command failed, we check if we can at least set the LEDs on
645  * the keyboard. This should work on every keyboard out there. It also turns
646  * the LEDs off, which we want anyway.
647  */
648                 param[0] = 0;
649                 if (ps2_command(ps2dev, param, ATKBD_CMD_SETLEDS))
650                         return -1;
651                 atkbd->id = 0xabba;
652                 return 0;
653         }
654
655         if (!ps2_is_keyboard_id(param[0]))
656                 return -1;
657
658         atkbd->id = (param[0] << 8) | param[1];
659
660         if (atkbd->id == 0xaca1 && atkbd->translated) {
661                 printk(KERN_ERR "atkbd.c: NCD terminal keyboards are only supported on non-translating\n");
662                 printk(KERN_ERR "atkbd.c: controllers. Use i8042.direct=1 to disable translation.\n");
663                 return -1;
664         }
665
666         return 0;
667 }
668
669 /*
670  * atkbd_select_set checks if a keyboard has a working Set 3 support, and
671  * sets it into that. Unfortunately there are keyboards that can be switched
672  * to Set 3, but don't work well in that (BTC Multimedia ...)
673  */
674
675 static int atkbd_select_set(struct atkbd *atkbd, int target_set, int allow_extra)
676 {
677         struct ps2dev *ps2dev = &atkbd->ps2dev;
678         unsigned char param[2];
679
680         atkbd->extra = 0;
681 /*
682  * For known special keyboards we can go ahead and set the correct set.
683  * We check for NCD PS/2 Sun, NorthGate OmniKey 101 and
684  * IBM RapidAccess / IBM EzButton / Chicony KBP-8993 keyboards.
685  */
686
687         if (atkbd->translated)
688                 return 2;
689
690         if (atkbd->id == 0xaca1) {
691                 param[0] = 3;
692                 ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET);
693                 return 3;
694         }
695
696         if (allow_extra) {
697                 param[0] = 0x71;
698                 if (!ps2_command(ps2dev, param, ATKBD_CMD_EX_ENABLE)) {
699                         atkbd->extra = 1;
700                         return 2;
701                 }
702         }
703
704         if (target_set != 3)
705                 return 2;
706
707         if (!ps2_command(ps2dev, param, ATKBD_CMD_OK_GETID)) {
708                 atkbd->id = param[0] << 8 | param[1];
709                 return 2;
710         }
711
712         param[0] = 3;
713         if (ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET))
714                 return 2;
715
716         param[0] = 0;
717         if (ps2_command(ps2dev, param, ATKBD_CMD_GSCANSET))
718                 return 2;
719
720         if (param[0] != 3) {
721                 param[0] = 2;
722                 if (ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET))
723                 return 2;
724         }
725
726         ps2_command(ps2dev, param, ATKBD_CMD_SETALL_MBR);
727
728         return 3;
729 }
730
731 static int atkbd_activate(struct atkbd *atkbd)
732 {
733         struct ps2dev *ps2dev = &atkbd->ps2dev;
734         unsigned char param[1];
735
736 /*
737  * Set the LEDs to a defined state.
738  */
739
740         param[0] = 0;
741         if (ps2_command(ps2dev, param, ATKBD_CMD_SETLEDS))
742                 return -1;
743
744 /*
745  * Set autorepeat to fastest possible.
746  */
747
748         param[0] = 0;
749         if (ps2_command(ps2dev, param, ATKBD_CMD_SETREP))
750                 return -1;
751
752 /*
753  * Enable the keyboard to receive keystrokes.
754  */
755
756         if (ps2_command(ps2dev, NULL, ATKBD_CMD_ENABLE)) {
757                 printk(KERN_ERR "atkbd.c: Failed to enable keyboard on %s\n",
758                         ps2dev->serio->phys);
759                 return -1;
760         }
761
762         return 0;
763 }
764
765 /*
766  * atkbd_cleanup() restores the keyboard state so that BIOS is happy after a
767  * reboot.
768  */
769
770 static void atkbd_cleanup(struct serio *serio)
771 {
772         struct atkbd *atkbd = serio_get_drvdata(serio);
773         ps2_command(&atkbd->ps2dev, NULL, ATKBD_CMD_RESET_BAT);
774 }
775
776
777 /*
778  * atkbd_disconnect() closes and frees.
779  */
780
781 static void atkbd_disconnect(struct serio *serio)
782 {
783         struct atkbd *atkbd = serio_get_drvdata(serio);
784
785         atkbd_disable(atkbd);
786
787         /* make sure we don't have a command in flight */
788         synchronize_sched();  /* Allow atkbd_interrupt()s to complete. */
789         flush_scheduled_work();
790
791         device_remove_file(&serio->dev, &atkbd_attr_extra);
792         device_remove_file(&serio->dev, &atkbd_attr_scroll);
793         device_remove_file(&serio->dev, &atkbd_attr_set);
794         device_remove_file(&serio->dev, &atkbd_attr_softrepeat);
795         device_remove_file(&serio->dev, &atkbd_attr_softraw);
796
797         input_unregister_device(atkbd->dev);
798         serio_close(serio);
799         serio_set_drvdata(serio, NULL);
800         kfree(atkbd);
801 }
802
803
804 /*
805  * atkbd_set_keycode_table() initializes keyboard's keycode table
806  * according to the selected scancode set
807  */
808
809 static void atkbd_set_keycode_table(struct atkbd *atkbd)
810 {
811         int i, j;
812
813         memset(atkbd->keycode, 0, sizeof(atkbd->keycode));
814
815         if (atkbd->translated) {
816                 for (i = 0; i < 128; i++) {
817                         atkbd->keycode[i] = atkbd_set2_keycode[atkbd_unxlate_table[i]];
818                         atkbd->keycode[i | 0x80] = atkbd_set2_keycode[atkbd_unxlate_table[i] | 0x80];
819                         if (atkbd->scroll)
820                                 for (j = 0; j < ARRAY_SIZE(atkbd_scroll_keys); j++)
821                                         if ((atkbd_unxlate_table[i] | 0x80) == atkbd_scroll_keys[j].set2)
822                                                 atkbd->keycode[i | 0x80] = atkbd_scroll_keys[j].keycode;
823                 }
824         } else if (atkbd->set == 3) {
825                 memcpy(atkbd->keycode, atkbd_set3_keycode, sizeof(atkbd->keycode));
826         } else {
827                 memcpy(atkbd->keycode, atkbd_set2_keycode, sizeof(atkbd->keycode));
828
829                 if (atkbd->scroll)
830                         for (i = 0; i < ARRAY_SIZE(atkbd_scroll_keys); i++)
831                                 atkbd->keycode[atkbd_scroll_keys[i].set2] = atkbd_scroll_keys[i].keycode;
832         }
833
834         atkbd->keycode[atkbd_compat_scancode(atkbd, ATKBD_RET_HANGEUL)] = KEY_HANGUEL;
835         atkbd->keycode[atkbd_compat_scancode(atkbd, ATKBD_RET_HANJA)] = KEY_HANJA;
836 }
837
838 /*
839  * atkbd_set_device_attrs() sets up keyboard's input device structure
840  */
841
842 static void atkbd_set_device_attrs(struct atkbd *atkbd)
843 {
844         struct input_dev *input_dev = atkbd->dev;
845         int i;
846
847         if (atkbd->extra)
848                 snprintf(atkbd->name, sizeof(atkbd->name),
849                          "AT Set 2 Extra keyboard");
850         else
851                 snprintf(atkbd->name, sizeof(atkbd->name),
852                          "AT %s Set %d keyboard",
853                          atkbd->translated ? "Translated" : "Raw", atkbd->set);
854
855         snprintf(atkbd->phys, sizeof(atkbd->phys),
856                  "%s/input0", atkbd->ps2dev.serio->phys);
857
858         input_dev->name = atkbd->name;
859         input_dev->phys = atkbd->phys;
860         input_dev->id.bustype = BUS_I8042;
861         input_dev->id.vendor = 0x0001;
862         input_dev->id.product = atkbd->translated ? 1 : atkbd->set;
863         input_dev->id.version = atkbd->id;
864         input_dev->event = atkbd_event;
865         input_dev->private = atkbd;
866         input_dev->cdev.dev = &atkbd->ps2dev.serio->dev;
867
868         input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP) | BIT(EV_MSC);
869
870         if (atkbd->write) {
871                 input_dev->evbit[0] |= BIT(EV_LED);
872                 input_dev->ledbit[0] = BIT(LED_NUML) | BIT(LED_CAPSL) | BIT(LED_SCROLLL);
873         }
874
875         if (atkbd->extra)
876                 input_dev->ledbit[0] |= BIT(LED_COMPOSE) | BIT(LED_SUSPEND) |
877                                         BIT(LED_SLEEP) | BIT(LED_MUTE) | BIT(LED_MISC);
878
879         if (!atkbd->softrepeat) {
880                 input_dev->rep[REP_DELAY] = 250;
881                 input_dev->rep[REP_PERIOD] = 33;
882         }
883
884         input_dev->mscbit[0] = atkbd->softraw ? BIT(MSC_SCAN) : BIT(MSC_RAW) | BIT(MSC_SCAN);
885
886         if (atkbd->scroll) {
887                 input_dev->evbit[0] |= BIT(EV_REL);
888                 input_dev->relbit[0] = BIT(REL_WHEEL) | BIT(REL_HWHEEL);
889                 set_bit(BTN_MIDDLE, input_dev->keybit);
890         }
891
892         input_dev->keycode = atkbd->keycode;
893         input_dev->keycodesize = sizeof(unsigned char);
894         input_dev->keycodemax = ARRAY_SIZE(atkbd_set2_keycode);
895
896         for (i = 0; i < 512; i++)
897                 if (atkbd->keycode[i] && atkbd->keycode[i] < ATKBD_SPECIAL)
898                         set_bit(atkbd->keycode[i], input_dev->keybit);
899 }
900
901 /*
902  * atkbd_connect() is called when the serio module finds an interface
903  * that isn't handled yet by an appropriate device driver. We check if
904  * there is an AT keyboard out there and if yes, we register ourselves
905  * to the input module.
906  */
907
908 static int atkbd_connect(struct serio *serio, struct serio_driver *drv)
909 {
910         struct atkbd *atkbd;
911         struct input_dev *dev;
912         int err = -ENOMEM;
913
914         atkbd = kzalloc(sizeof(struct atkbd), GFP_KERNEL);
915         dev = input_allocate_device();
916         if (!atkbd || !dev)
917                 goto fail;
918
919         atkbd->dev = dev;
920         ps2_init(&atkbd->ps2dev, serio);
921         INIT_WORK(&atkbd->event_work, atkbd_event_work, atkbd);
922         mutex_init(&atkbd->event_mutex);
923
924         switch (serio->id.type) {
925
926                 case SERIO_8042_XL:
927                         atkbd->translated = 1;
928                 case SERIO_8042:
929                         if (serio->write)
930                                 atkbd->write = 1;
931                         break;
932         }
933
934         atkbd->softraw = atkbd_softraw;
935         atkbd->softrepeat = atkbd_softrepeat;
936         atkbd->scroll = atkbd_scroll;
937
938         if (atkbd->softrepeat)
939                 atkbd->softraw = 1;
940
941         serio_set_drvdata(serio, atkbd);
942
943         err = serio_open(serio, drv);
944         if (err)
945                 goto fail;
946
947         if (atkbd->write) {
948
949                 if (atkbd_probe(atkbd)) {
950                         serio_close(serio);
951                         err = -ENODEV;
952                         goto fail;
953                 }
954
955                 atkbd->set = atkbd_select_set(atkbd, atkbd_set, atkbd_extra);
956                 atkbd_activate(atkbd);
957
958         } else {
959                 atkbd->set = 2;
960                 atkbd->id = 0xab00;
961         }
962
963         atkbd_set_keycode_table(atkbd);
964         atkbd_set_device_attrs(atkbd);
965
966         device_create_file(&serio->dev, &atkbd_attr_extra);
967         device_create_file(&serio->dev, &atkbd_attr_scroll);
968         device_create_file(&serio->dev, &atkbd_attr_set);
969         device_create_file(&serio->dev, &atkbd_attr_softrepeat);
970         device_create_file(&serio->dev, &atkbd_attr_softraw);
971
972         atkbd_enable(atkbd);
973
974         input_register_device(atkbd->dev);
975
976         return 0;
977
978  fail:  serio_set_drvdata(serio, NULL);
979         input_free_device(dev);
980         kfree(atkbd);
981         return err;
982 }
983
984 /*
985  * atkbd_reconnect() tries to restore keyboard into a sane state and is
986  * most likely called on resume.
987  */
988
989 static int atkbd_reconnect(struct serio *serio)
990 {
991         struct atkbd *atkbd = serio_get_drvdata(serio);
992         struct serio_driver *drv = serio->drv;
993
994         if (!atkbd || !drv) {
995                 printk(KERN_DEBUG "atkbd: reconnect request, but serio is disconnected, ignoring...\n");
996                 return -1;
997         }
998
999         atkbd_disable(atkbd);
1000
1001         if (atkbd->write) {
1002                 if (atkbd_probe(atkbd))
1003                         return -1;
1004                 if (atkbd->set != atkbd_select_set(atkbd, atkbd->set, atkbd->extra))
1005                         return -1;
1006
1007                 atkbd_activate(atkbd);
1008
1009 /*
1010  * Restore repeat rate and LEDs (that were reset by atkbd_activate)
1011  * to pre-resume state
1012  */
1013                 if (!atkbd->softrepeat)
1014                         atkbd_set_repeat_rate(atkbd);
1015                 atkbd_set_leds(atkbd);
1016         }
1017
1018         atkbd_enable(atkbd);
1019
1020         return 0;
1021 }
1022
1023 static struct serio_device_id atkbd_serio_ids[] = {
1024         {
1025                 .type   = SERIO_8042,
1026                 .proto  = SERIO_ANY,
1027                 .id     = SERIO_ANY,
1028                 .extra  = SERIO_ANY,
1029         },
1030         {
1031                 .type   = SERIO_8042_XL,
1032                 .proto  = SERIO_ANY,
1033                 .id     = SERIO_ANY,
1034                 .extra  = SERIO_ANY,
1035         },
1036         {
1037                 .type   = SERIO_RS232,
1038                 .proto  = SERIO_PS2SER,
1039                 .id     = SERIO_ANY,
1040                 .extra  = SERIO_ANY,
1041         },
1042         { 0 }
1043 };
1044
1045 MODULE_DEVICE_TABLE(serio, atkbd_serio_ids);
1046
1047 static struct serio_driver atkbd_drv = {
1048         .driver         = {
1049                 .name   = "atkbd",
1050         },
1051         .description    = DRIVER_DESC,
1052         .id_table       = atkbd_serio_ids,
1053         .interrupt      = atkbd_interrupt,
1054         .connect        = atkbd_connect,
1055         .reconnect      = atkbd_reconnect,
1056         .disconnect     = atkbd_disconnect,
1057         .cleanup        = atkbd_cleanup,
1058 };
1059
1060 static ssize_t atkbd_attr_show_helper(struct device *dev, char *buf,
1061                                 ssize_t (*handler)(struct atkbd *, char *))
1062 {
1063         struct serio *serio = to_serio_port(dev);
1064         int retval;
1065
1066         retval = serio_pin_driver(serio);
1067         if (retval)
1068                 return retval;
1069
1070         if (serio->drv != &atkbd_drv) {
1071                 retval = -ENODEV;
1072                 goto out;
1073         }
1074
1075         retval = handler((struct atkbd *)serio_get_drvdata(serio), buf);
1076
1077 out:
1078         serio_unpin_driver(serio);
1079         return retval;
1080 }
1081
1082 static ssize_t atkbd_attr_set_helper(struct device *dev, const char *buf, size_t count,
1083                                 ssize_t (*handler)(struct atkbd *, const char *, size_t))
1084 {
1085         struct serio *serio = to_serio_port(dev);
1086         struct atkbd *atkbd;
1087         int retval;
1088
1089         retval = serio_pin_driver(serio);
1090         if (retval)
1091                 return retval;
1092
1093         if (serio->drv != &atkbd_drv) {
1094                 retval = -ENODEV;
1095                 goto out;
1096         }
1097
1098         atkbd = serio_get_drvdata(serio);
1099         atkbd_disable(atkbd);
1100         retval = handler(atkbd, buf, count);
1101         atkbd_enable(atkbd);
1102
1103 out:
1104         serio_unpin_driver(serio);
1105         return retval;
1106 }
1107
1108 static ssize_t atkbd_show_extra(struct atkbd *atkbd, char *buf)
1109 {
1110         return sprintf(buf, "%d\n", atkbd->extra ? 1 : 0);
1111 }
1112
1113 static ssize_t atkbd_set_extra(struct atkbd *atkbd, const char *buf, size_t count)
1114 {
1115         struct input_dev *new_dev;
1116         unsigned long value;
1117         char *rest;
1118
1119         if (!atkbd->write)
1120                 return -EIO;
1121
1122         value = simple_strtoul(buf, &rest, 10);
1123         if (*rest || value > 1)
1124                 return -EINVAL;
1125
1126         if (atkbd->extra != value) {
1127                 /*
1128                  * Since device's properties will change we need to
1129                  * unregister old device. But allocate new one first
1130                  * to make sure we have it.
1131                  */
1132                 if (!(new_dev = input_allocate_device()))
1133                         return -ENOMEM;
1134                 input_unregister_device(atkbd->dev);
1135                 atkbd->dev = new_dev;
1136                 atkbd->set = atkbd_select_set(atkbd, atkbd->set, value);
1137                 atkbd_activate(atkbd);
1138                 atkbd_set_device_attrs(atkbd);
1139                 input_register_device(atkbd->dev);
1140         }
1141         return count;
1142 }
1143
1144 static ssize_t atkbd_show_scroll(struct atkbd *atkbd, char *buf)
1145 {
1146         return sprintf(buf, "%d\n", atkbd->scroll ? 1 : 0);
1147 }
1148
1149 static ssize_t atkbd_set_scroll(struct atkbd *atkbd, const char *buf, size_t count)
1150 {
1151         struct input_dev *new_dev;
1152         unsigned long value;
1153         char *rest;
1154
1155         value = simple_strtoul(buf, &rest, 10);
1156         if (*rest || value > 1)
1157                 return -EINVAL;
1158
1159         if (atkbd->scroll != value) {
1160                 if (!(new_dev = input_allocate_device()))
1161                         return -ENOMEM;
1162                 input_unregister_device(atkbd->dev);
1163                 atkbd->dev = new_dev;
1164                 atkbd->scroll = value;
1165                 atkbd_set_keycode_table(atkbd);
1166                 atkbd_set_device_attrs(atkbd);
1167                 input_register_device(atkbd->dev);
1168         }
1169         return count;
1170 }
1171
1172 static ssize_t atkbd_show_set(struct atkbd *atkbd, char *buf)
1173 {
1174         return sprintf(buf, "%d\n", atkbd->set);
1175 }
1176
1177 static ssize_t atkbd_set_set(struct atkbd *atkbd, const char *buf, size_t count)
1178 {
1179         struct input_dev *new_dev;
1180         unsigned long value;
1181         char *rest;
1182
1183         if (!atkbd->write)
1184                 return -EIO;
1185
1186         value = simple_strtoul(buf, &rest, 10);
1187         if (*rest || (value != 2 && value != 3))
1188                 return -EINVAL;
1189
1190         if (atkbd->set != value) {
1191                 if (!(new_dev = input_allocate_device()))
1192                         return -ENOMEM;
1193                 input_unregister_device(atkbd->dev);
1194                 atkbd->dev = new_dev;
1195                 atkbd->set = atkbd_select_set(atkbd, value, atkbd->extra);
1196                 atkbd_activate(atkbd);
1197                 atkbd_set_keycode_table(atkbd);
1198                 atkbd_set_device_attrs(atkbd);
1199                 input_register_device(atkbd->dev);
1200         }
1201         return count;
1202 }
1203
1204 static ssize_t atkbd_show_softrepeat(struct atkbd *atkbd, char *buf)
1205 {
1206         return sprintf(buf, "%d\n", atkbd->softrepeat ? 1 : 0);
1207 }
1208
1209 static ssize_t atkbd_set_softrepeat(struct atkbd *atkbd, const char *buf, size_t count)
1210 {
1211         struct input_dev *new_dev;
1212         unsigned long value;
1213         char *rest;
1214
1215         if (!atkbd->write)
1216                 return -EIO;
1217
1218         value = simple_strtoul(buf, &rest, 10);
1219         if (*rest || value > 1)
1220                 return -EINVAL;
1221
1222         if (atkbd->softrepeat != value) {
1223                 if (!(new_dev = input_allocate_device()))
1224                         return -ENOMEM;
1225                 input_unregister_device(atkbd->dev);
1226                 atkbd->dev = new_dev;
1227                 atkbd->softrepeat = value;
1228                 if (atkbd->softrepeat)
1229                         atkbd->softraw = 1;
1230                 atkbd_set_device_attrs(atkbd);
1231                 input_register_device(atkbd->dev);
1232         }
1233         return count;
1234 }
1235
1236
1237 static ssize_t atkbd_show_softraw(struct atkbd *atkbd, char *buf)
1238 {
1239         return sprintf(buf, "%d\n", atkbd->softraw ? 1 : 0);
1240 }
1241
1242 static ssize_t atkbd_set_softraw(struct atkbd *atkbd, const char *buf, size_t count)
1243 {
1244         struct input_dev *new_dev;
1245         unsigned long value;
1246         char *rest;
1247
1248         value = simple_strtoul(buf, &rest, 10);
1249         if (*rest || value > 1)
1250                 return -EINVAL;
1251
1252         if (atkbd->softraw != value) {
1253                 if (!(new_dev = input_allocate_device()))
1254                         return -ENOMEM;
1255                 input_unregister_device(atkbd->dev);
1256                 atkbd->dev = new_dev;
1257                 atkbd->softraw = value;
1258                 atkbd_set_device_attrs(atkbd);
1259                 input_register_device(atkbd->dev);
1260         }
1261         return count;
1262 }
1263
1264
1265 static int __init atkbd_init(void)
1266 {
1267         serio_register_driver(&atkbd_drv);
1268         return 0;
1269 }
1270
1271 static void __exit atkbd_exit(void)
1272 {
1273         serio_unregister_driver(&atkbd_drv);
1274 }
1275
1276 module_init(atkbd_init);
1277 module_exit(atkbd_exit);