projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Input: i8042 - disable MUX mode on Toshiba Equium A110
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / input / keyboard / atkbd.c
CommitLineData
1da177e4
LT		 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>
33d3f07a 30#include <linux/mutex.h>
1da177e4
LT		 31
32#define DRIVER_DESC "AT and PS/2 keyboard driver"
33
34MODULE_AUTHOR("Vojtech Pavlik <vojtech@suse.cz>");
35MODULE_DESCRIPTION(DRIVER_DESC);
36MODULE_LICENSE("GPL");
37
38static int atkbd_set = 2;
39module_param_named(set, atkbd_set, int, 0);
40MODULE_PARM_DESC(set, "Select keyboard code set (2 = default, 3 = PS/2 native)");
41
42#if defined(__i386__) || defined(__x86_64__) || defined(__hppa__)
43static int atkbd_reset;
44#else
45static int atkbd_reset = 1;
46#endif
47module_param_named(reset, atkbd_reset, bool, 0);
48MODULE_PARM_DESC(reset, "Reset keyboard during initialization");
49
50static int atkbd_softrepeat;
51module_param_named(softrepeat, atkbd_softrepeat, bool, 0);
52MODULE_PARM_DESC(softrepeat, "Use software keyboard repeat");
53
54static int atkbd_softraw = 1;
55module_param_named(softraw, atkbd_softraw, bool, 0);
56MODULE_PARM_DESC(softraw, "Use software generated rawmode");
57
0ae051a1 58static int atkbd_scroll;
1da177e4
LT		 59module_param_named(scroll, atkbd_scroll, bool, 0);
60MODULE_PARM_DESC(scroll, "Enable scroll-wheel on MS Office and similar keyboards");
61
62static int atkbd_extra;
63module_param_named(extra, atkbd_extra, bool, 0);
64MODULE_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
75static 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
106static 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
122static 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
0ae051a1
DT		 153#define ATKBD_RET_HANJA 0xf1
154#define ATKBD_RET_HANGEUL 0xf2
1da177e4
LT		 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
0d4c8597
DT		 170#define ATKBD_LED_EVENT_BIT 0
171#define ATKBD_REP_EVENT_BIT 1
172
0ae051a1
DT		 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
1da177e4
LT		 180static struct {
181 unsigned char keycode;
182 unsigned char set2;
183} atkbd_scroll_keys[] = {
184 { ATKBD_SCR_1, 0xc5 },
5212dd58
VP		 185 { ATKBD_SCR_2, 0x9d },
186 { ATKBD_SCR_4, 0xa4 },
187 { ATKBD_SCR_8, 0x9b },
1da177e4
LT		 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
197struct atkbd {
198
3c42f0c3
DT		 199 struct ps2dev ps2dev;
200 struct input_dev *dev;
1da177e4
LT		 201
202 /* Written only during init */
203 char name[64];
204 char phys[32];
1da177e4
LT		 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;
0ae051a1 221 unsigned long xl_bit;
1da177e4
LT		 222 unsigned int last;
223 unsigned long time;
0d4c8597
DT		 224
225 struct work_struct event_work;
33d3f07a 226 struct mutex event_mutex;
0d4c8597 227 unsigned long event_mask;
1da177e4
LT		 228};
229
230static ssize_t atkbd_attr_show_helper(struct device *dev, char *buf,
231 ssize_t (*handler)(struct atkbd *, char *));
232static 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) \
235static ssize_t atkbd_show_##_name(struct atkbd *, char *); \
236static ssize_t atkbd_set_##_name(struct atkbd *, const char *, size_t); \
e404e274 237static ssize_t atkbd_do_show_##_name(struct device *d, struct device_attribute *attr, char *b) \
1da177e4
LT		 238{ \
239 return atkbd_attr_show_helper(d, b, atkbd_show_##_name); \
240} \
e404e274 241static ssize_t atkbd_do_set_##_name(struct device *d, struct device_attribute *attr, const char *b, size_t s) \
1da177e4
LT		 242{ \
243 return atkbd_attr_set_helper(d, b, s, atkbd_set_##_name); \
244} \
d083e906 245static struct device_attribute atkbd_attr_##_name = \
1da177e4
LT		 246 __ATTR(_name, S_IWUSR | S_IRUGO, atkbd_do_show_##_name, atkbd_do_set_##_name);
247
248ATKBD_DEFINE_ATTR(extra);
249ATKBD_DEFINE_ATTR(scroll);
250ATKBD_DEFINE_ATTR(set);
251ATKBD_DEFINE_ATTR(softrepeat);
252ATKBD_DEFINE_ATTR(softraw);
253
0ae051a1
DT		 254static 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};
1da177e4 258
0ae051a1
DT		 259/*
260 * Checks if we should mangle the scancode to extract 'release' bit
261 * in translated mode.
262 */
263static int atkbd_need_xlate(unsigned long xl_bit, unsigned char code)
1da177e4 264{
0ae051a1
DT		 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 */
282static 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 */
301static 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;
1da177e4
LT		 313}
314
315/*
316 * atkbd_interrupt(). Here takes place processing of data received from
317 * the keyboard into events.
318 */
319
320static 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);
0ae051a1 324 struct input_dev *dev = atkbd->dev;
1da177e4 325 unsigned int code = data;
0ae051a1 326 int scroll = 0, hscroll = 0, click = -1, add_release_event = 0;
1da177e4 327 int value;
0ae051a1 328 unsigned char keycode;
1da177e4
LT		 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
0ae051a1 357 input_event(dev, EV_MSC, MSC_RAW, code);
1da177e4
LT		 358
359 if (atkbd->translated) {
360
0ae051a1 361 if (atkbd->emul || atkbd_need_xlate(atkbd->xl_bit, code)) {
1da177e4
LT		 362 atkbd->release = code >> 7;
363 code &= 0x7f;
364 }
365
0ae051a1
DT		 366 if (!atkbd->emul)
367 atkbd_calculate_xl_bit(atkbd, data);
1da177e4
LT		 368 }
369
370 switch (code) {
371 case ATKBD_RET_BAT:
372 atkbd->enabled = 0;
dbc26344 373 serio_reconnect(atkbd->ps2dev.serio);
1da177e4
LT		 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;
0ae051a1
DT		 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);
1da177e4 389 goto out;
0ae051a1 390 case ATKBD_RET_HANGEUL:
1da177e4 391 case ATKBD_RET_HANJA:
0ae051a1
DT		 392 /*
393 * These keys do not report release and thus need to be
394 * flagged properly
395 */
396 add_release_event = 1;
397 break;
1da177e4
LT		 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
0ae051a1
DT		 403 code = atkbd_compat_scancode(atkbd, code);
404
405 if (atkbd->emul && --atkbd->emul)
406 goto out;
407
408 keycode = atkbd->keycode[code];
1da177e4 409
0ae051a1
DT		 410 if (keycode != ATKBD_KEY_NULL)
411 input_event(dev, EV_MSC, MSC_SCAN, code);
1da177e4 412
0ae051a1 413 switch (keycode) {
1da177e4
LT		 414 case ATKBD_KEY_NULL:
415 break;
416 case ATKBD_KEY_UNKNOWN:
0ae051a1
DT		 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);
1da177e4
LT		 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:
0ae051a1
DT		 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;
1da177e4
LT		 459 }
460
0ae051a1 461 input_regs(dev, regs);
f8b4c46c 462 input_event(dev, EV_KEY, keycode, value);
0ae051a1
DT		 463 input_sync(dev);
464
465 if (value && add_release_event) {
466 input_report_key(dev, keycode, 0);
467 input_sync(dev);
468 }
1da177e4
LT		 469 }
470
471 if (atkbd->scroll) {
0ae051a1 472 input_regs(dev, regs);
1da177e4 473 if (click != -1)
0ae051a1
DT		 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);
1da177e4
LT		 478 }
479
480 atkbd->release = 0;
481out:
482 return IRQ_HANDLED;
483}
484
485/*
0d4c8597
DT		 486 * atkbd_event_work() is used to complete processing of events that
487 * can not be processed by input_event() which is often called from
488 * interrupt context.
1da177e4
LT		 489 */
490
0d4c8597 491static void atkbd_event_work(void *data)
1da177e4 492{
1da177e4
LT		 493 const short period[32] =
494 { 33, 37, 42, 46, 50, 54, 58, 63, 67, 75, 83, 92, 100, 109, 116, 125,
495 133, 149, 167, 182, 200, 217, 232, 250, 270, 303, 333, 370, 400, 435, 470, 500 };
496 const short delay[4] =
497 { 250, 500, 750, 1000 };
0d4c8597
DT		 498
499 struct atkbd *atkbd = data;
500 struct input_dev *dev = atkbd->dev;
1da177e4
LT		 501 unsigned char param[2];
502 int i, j;
503
33d3f07a 504 mutex_lock(&atkbd->event_mutex);
0d4c8597
DT		 505
506 if (test_and_clear_bit(ATKBD_LED_EVENT_BIT, &atkbd->event_mask)) {
507 param[0] = (test_bit(LED_SCROLLL, dev->led) ? 1 : 0)
508 | (test_bit(LED_NUML, dev->led) ? 2 : 0)
509 | (test_bit(LED_CAPSL, dev->led) ? 4 : 0);
510 ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_SETLEDS);
511
512 if (atkbd->extra) {
513 param[0] = 0;
514 param[1] = (test_bit(LED_COMPOSE, dev->led) ? 0x01 : 0)
515 | (test_bit(LED_SLEEP, dev->led) ? 0x02 : 0)
516 | (test_bit(LED_SUSPEND, dev->led) ? 0x04 : 0)
517 | (test_bit(LED_MISC, dev->led) ? 0x10 : 0)
518 | (test_bit(LED_MUTE, dev->led) ? 0x20 : 0);
519 ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_EX_SETLEDS);
520 }
521 }
522
523 if (test_and_clear_bit(ATKBD_REP_EVENT_BIT, &atkbd->event_mask)) {
524 i = j = 0;
525 while (i < 31 && period[i] < dev->rep[REP_PERIOD])
526 i++;
527 while (j < 3 && delay[j] < dev->rep[REP_DELAY])
528 j++;
529 dev->rep[REP_PERIOD] = period[i];
530 dev->rep[REP_DELAY] = delay[j];
531 param[0] = i | (j << 5);
532 ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_SETREP);
533 }
534
33d3f07a 535 mutex_unlock(&atkbd->event_mutex);
0d4c8597
DT		 536}
537
538/*
539 * Event callback from the input module. Events that change the state of
540 * the hardware are processed here. If action can not be performed in
541 * interrupt context it is offloaded to atkbd_event_work.
542 */
543
544static int atkbd_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
545{
546 struct atkbd *atkbd = dev->private;
547
1da177e4
LT		 548 if (!atkbd->write)
549 return -1;
550
551 switch (type) {
552
553 case EV_LED:
0d4c8597
DT		 554 set_bit(ATKBD_LED_EVENT_BIT, &atkbd->event_mask);
555 wmb();
556 schedule_work(&atkbd->event_work);
1da177e4
LT		 557 return 0;
558
1da177e4
LT		 559 case EV_REP:
560
0d4c8597
DT		 561 if (!atkbd->softrepeat) {
562 set_bit(ATKBD_REP_EVENT_BIT, &atkbd->event_mask);
563 wmb();
564 schedule_work(&atkbd->event_work);
565 }
1da177e4
LT		 566
567 return 0;
568 }
569
570 return -1;
571}
572
573/*
574 * atkbd_enable() signals that interrupt handler is allowed to
575 * generate input events.
576 */
577
578static inline void atkbd_enable(struct atkbd *atkbd)
579{
580 serio_pause_rx(atkbd->ps2dev.serio);
581 atkbd->enabled = 1;
582 serio_continue_rx(atkbd->ps2dev.serio);
583}
584
585/*
586 * atkbd_disable() tells input handler that all incoming data except
587 * for ACKs and command response should be dropped.
588 */
589
590static inline void atkbd_disable(struct atkbd *atkbd)
591{
592 serio_pause_rx(atkbd->ps2dev.serio);
593 atkbd->enabled = 0;
594 serio_continue_rx(atkbd->ps2dev.serio);
595}
596
597/*
598 * atkbd_probe() probes for an AT keyboard on a serio port.
599 */
600
601static int atkbd_probe(struct atkbd *atkbd)
602{
603 struct ps2dev *ps2dev = &atkbd->ps2dev;
604 unsigned char param[2];
605
606/*
607 * Some systems, where the bit-twiddling when testing the io-lines of the
608 * controller may confuse the keyboard need a full reset of the keyboard. On
609 * these systems the BIOS also usually doesn't do it for us.
610 */
611
612 if (atkbd_reset)
613 if (ps2_command(ps2dev, NULL, ATKBD_CMD_RESET_BAT))
614 printk(KERN_WARNING "atkbd.c: keyboard reset failed on %s\n", ps2dev->serio->phys);
615
616/*
617 * Then we check the keyboard ID. We should get 0xab83 under normal conditions.
618 * Some keyboards report different values, but the first byte is always 0xab or
619 * 0xac. Some old AT keyboards don't report anything. If a mouse is connected, this
620 * should make sure we don't try to set the LEDs on it.
621 */
622
623 param[0] = param[1] = 0xa5; /* initialize with invalid values */
624 if (ps2_command(ps2dev, param, ATKBD_CMD_GETID)) {
625
626/*
627 * If the get ID command failed, we check if we can at least set the LEDs on
628 * the keyboard. This should work on every keyboard out there. It also turns
629 * the LEDs off, which we want anyway.
630 */
631 param[0] = 0;
632 if (ps2_command(ps2dev, param, ATKBD_CMD_SETLEDS))
633 return -1;
634 atkbd->id = 0xabba;
635 return 0;
636 }
637
638 if (param[0] != 0xab && param[0] != 0xac && /* Regular and NCD Sun keyboards */
639 param[0] != 0x2b && param[0] != 0x5d && /* Trust keyboard, raw and translated */
640 param[0] != 0x60 && param[0] != 0x47) /* NMB SGI keyboard, raw and translated */
641 return -1;
642
643 atkbd->id = (param[0] << 8) | param[1];
644
645 if (atkbd->id == 0xaca1 && atkbd->translated) {
646 printk(KERN_ERR "atkbd.c: NCD terminal keyboards are only supported on non-translating\n");
647 printk(KERN_ERR "atkbd.c: controllers. Use i8042.direct=1 to disable translation.\n");
648 return -1;
649 }
650
651 return 0;
652}
653
654/*
655 * atkbd_select_set checks if a keyboard has a working Set 3 support, and
656 * sets it into that. Unfortunately there are keyboards that can be switched
657 * to Set 3, but don't work well in that (BTC Multimedia ...)
658 */
659
660static int atkbd_select_set(struct atkbd *atkbd, int target_set, int allow_extra)
661{
662 struct ps2dev *ps2dev = &atkbd->ps2dev;
663 unsigned char param[2];
664
665 atkbd->extra = 0;
666/*
667 * For known special keyboards we can go ahead and set the correct set.
668 * We check for NCD PS/2 Sun, NorthGate OmniKey 101 and
669 * IBM RapidAccess / IBM EzButton / Chicony KBP-8993 keyboards.
670 */
671
672 if (atkbd->translated)
673 return 2;
674
675 if (atkbd->id == 0xaca1) {
676 param[0] = 3;
677 ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET);
678 return 3;
679 }
680
681 if (allow_extra) {
682 param[0] = 0x71;
683 if (!ps2_command(ps2dev, param, ATKBD_CMD_EX_ENABLE)) {
684 atkbd->extra = 1;
685 return 2;
686 }
687 }
688
689 if (target_set != 3)
690 return 2;
691
692 if (!ps2_command(ps2dev, param, ATKBD_CMD_OK_GETID)) {
693 atkbd->id = param[0] << 8 | param[1];
694 return 2;
695 }
696
697 param[0] = 3;
698 if (ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET))
699 return 2;
700
701 param[0] = 0;
702 if (ps2_command(ps2dev, param, ATKBD_CMD_GSCANSET))
703 return 2;
704
705 if (param[0] != 3) {
706 param[0] = 2;
707 if (ps2_command(ps2dev, param, ATKBD_CMD_SSCANSET))
708 return 2;
709 }
710
711 ps2_command(ps2dev, param, ATKBD_CMD_SETALL_MBR);
712
713 return 3;
714}
715
716static int atkbd_activate(struct atkbd *atkbd)
717{
718 struct ps2dev *ps2dev = &atkbd->ps2dev;
719 unsigned char param[1];
720
721/*
722 * Set the LEDs to a defined state.
723 */
724
725 param[0] = 0;
726 if (ps2_command(ps2dev, param, ATKBD_CMD_SETLEDS))
727 return -1;
728
729/*
730 * Set autorepeat to fastest possible.
731 */
732
733 param[0] = 0;
734 if (ps2_command(ps2dev, param, ATKBD_CMD_SETREP))
735 return -1;
736
737/*
738 * Enable the keyboard to receive keystrokes.
739 */
740
741 if (ps2_command(ps2dev, NULL, ATKBD_CMD_ENABLE)) {
742 printk(KERN_ERR "atkbd.c: Failed to enable keyboard on %s\n",
743 ps2dev->serio->phys);
744 return -1;
745 }
746
747 return 0;
748}
749
750/*
751 * atkbd_cleanup() restores the keyboard state so that BIOS is happy after a
752 * reboot.
753 */
754
755static void atkbd_cleanup(struct serio *serio)
756{
757 struct atkbd *atkbd = serio_get_drvdata(serio);
758 ps2_command(&atkbd->ps2dev, NULL, ATKBD_CMD_RESET_BAT);
759}
760
761
762/*
763 * atkbd_disconnect() closes and frees.
764 */
765
766static void atkbd_disconnect(struct serio *serio)
767{
768 struct atkbd *atkbd = serio_get_drvdata(serio);
769
770 atkbd_disable(atkbd);
771
772 /* make sure we don't have a command in flight */
fbd568a3 773 synchronize_sched(); /* Allow atkbd_interrupt()s to complete. */
1da177e4
LT		 774 flush_scheduled_work();
775
776 device_remove_file(&serio->dev, &atkbd_attr_extra);
777 device_remove_file(&serio->dev, &atkbd_attr_scroll);
778 device_remove_file(&serio->dev, &atkbd_attr_set);
779 device_remove_file(&serio->dev, &atkbd_attr_softrepeat);
780 device_remove_file(&serio->dev, &atkbd_attr_softraw);
781
3c42f0c3 782 input_unregister_device(atkbd->dev);
1da177e4
LT		 783 serio_close(serio);
784 serio_set_drvdata(serio, NULL);
785 kfree(atkbd);
786}
787
788
789/*
3c42f0c3 790 * atkbd_set_keycode_table() initializes keyboard's keycode table
1da177e4
LT		 791 * according to the selected scancode set
792 */
793
794static void atkbd_set_keycode_table(struct atkbd *atkbd)
795{
796 int i, j;
797
798 memset(atkbd->keycode, 0, sizeof(atkbd->keycode));
799
800 if (atkbd->translated) {
801 for (i = 0; i < 128; i++) {
802 atkbd->keycode[i] = atkbd_set2_keycode[atkbd_unxlate_table[i]];
803 atkbd->keycode[i | 0x80] = atkbd_set2_keycode[atkbd_unxlate_table[i] | 0x80];
804 if (atkbd->scroll)
805 for (j = 0; j < ARRAY_SIZE(atkbd_scroll_keys); j++)
806 if ((atkbd_unxlate_table[i] | 0x80) == atkbd_scroll_keys[j].set2)
807 atkbd->keycode[i | 0x80] = atkbd_scroll_keys[j].keycode;
808 }
809 } else if (atkbd->set == 3) {
810 memcpy(atkbd->keycode, atkbd_set3_keycode, sizeof(atkbd->keycode));
811 } else {
812 memcpy(atkbd->keycode, atkbd_set2_keycode, sizeof(atkbd->keycode));
813
814 if (atkbd->scroll)
815 for (i = 0; i < ARRAY_SIZE(atkbd_scroll_keys); i++)
816 atkbd->keycode[atkbd_scroll_keys[i].set2] = atkbd_scroll_keys[i].keycode;
817 }
0ae051a1
DT		 818
819 atkbd->keycode[atkbd_compat_scancode(atkbd, ATKBD_RET_HANGEUL)] = KEY_HANGUEL;
820 atkbd->keycode[atkbd_compat_scancode(atkbd, ATKBD_RET_HANJA)] = KEY_HANJA;
1da177e4
LT		 821}
822
823/*
824 * atkbd_set_device_attrs() sets up keyboard's input device structure
825 */
826
827static void atkbd_set_device_attrs(struct atkbd *atkbd)
828{
3c42f0c3 829 struct input_dev *input_dev = atkbd->dev;
1da177e4
LT		 830 int i;
831
3c42f0c3 832 if (atkbd->extra)
ea08c6fa
DT		 833 snprintf(atkbd->name, sizeof(atkbd->name),
834 "AT Set 2 Extra keyboard");
3c42f0c3 835 else
ea08c6fa
DT		 836 snprintf(atkbd->name, sizeof(atkbd->name),
837 "AT %s Set %d keyboard",
838 atkbd->translated ? "Translated" : "Raw", atkbd->set);
1da177e4 839
ea08c6fa
DT		 840 snprintf(atkbd->phys, sizeof(atkbd->phys),
841 "%s/input0", atkbd->ps2dev.serio->phys);
1da177e4 842
3c42f0c3
DT		 843 input_dev->name = atkbd->name;
844 input_dev->phys = atkbd->phys;
845 input_dev->id.bustype = BUS_I8042;
846 input_dev->id.vendor = 0x0001;
847 input_dev->id.product = atkbd->translated ? 1 : atkbd->set;
848 input_dev->id.version = atkbd->id;
849 input_dev->event = atkbd_event;
850 input_dev->private = atkbd;
851 input_dev->cdev.dev = &atkbd->ps2dev.serio->dev;
1da177e4 852
3c42f0c3 853 input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP) | BIT(EV_MSC);
1da177e4
LT		 854
855 if (atkbd->write) {
3c42f0c3
DT		 856 input_dev->evbit[0] |= BIT(EV_LED);
857 input_dev->ledbit[0] = BIT(LED_NUML) | BIT(LED_CAPSL) | BIT(LED_SCROLLL);
1da177e4
LT		 858 }
859
860 if (atkbd->extra)
3c42f0c3 861 input_dev->ledbit[0] |= BIT(LED_COMPOSE) | BIT(LED_SUSPEND) |
1da177e4
LT		 862 BIT(LED_SLEEP) | BIT(LED_MUTE) | BIT(LED_MISC);
863
864 if (!atkbd->softrepeat) {
3c42f0c3
DT		 865 input_dev->rep[REP_DELAY] = 250;
866 input_dev->rep[REP_PERIOD] = 33;
1da177e4
LT		 867 }
868
3c42f0c3 869 input_dev->mscbit[0] = atkbd->softraw ? BIT(MSC_SCAN) : BIT(MSC_RAW) | BIT(MSC_SCAN);
1da177e4
LT		 870
871 if (atkbd->scroll) {
3c42f0c3
DT		 872 input_dev->evbit[0] |= BIT(EV_REL);
873 input_dev->relbit[0] = BIT(REL_WHEEL) | BIT(REL_HWHEEL);
874 set_bit(BTN_MIDDLE, input_dev->keybit);
1da177e4
LT		 875 }
876
3c42f0c3
DT		 877 input_dev->keycode = atkbd->keycode;
878 input_dev->keycodesize = sizeof(unsigned char);
879 input_dev->keycodemax = ARRAY_SIZE(atkbd_set2_keycode);
1da177e4
LT		 880
881 for (i = 0; i < 512; i++)
882 if (atkbd->keycode[i] && atkbd->keycode[i] < ATKBD_SPECIAL)
3c42f0c3 883 set_bit(atkbd->keycode[i], input_dev->keybit);
1da177e4
LT		 884}
885
886/*
887 * atkbd_connect() is called when the serio module finds an interface
888 * that isn't handled yet by an appropriate device driver. We check if
889 * there is an AT keyboard out there and if yes, we register ourselves
890 * to the input module.
891 */
892
893static int atkbd_connect(struct serio *serio, struct serio_driver *drv)
894{
895 struct atkbd *atkbd;
3c42f0c3
DT		 896 struct input_dev *dev;
897 int err = -ENOMEM;
1da177e4 898
3c42f0c3
DT		 899 atkbd = kzalloc(sizeof(struct atkbd), GFP_KERNEL);
900 dev = input_allocate_device();
901 if (!atkbd || !dev)
902 goto fail;
1da177e4 903
3c42f0c3 904 atkbd->dev = dev;
1da177e4 905 ps2_init(&atkbd->ps2dev, serio);
0d4c8597 906 INIT_WORK(&atkbd->event_work, atkbd_event_work, atkbd);
33d3f07a 907 mutex_init(&atkbd->event_mutex);
1da177e4
LT		 908
909 switch (serio->id.type) {
910
911 case SERIO_8042_XL:
912 atkbd->translated = 1;
913 case SERIO_8042:
914 if (serio->write)
915 atkbd->write = 1;
916 break;
917 }
918
919 atkbd->softraw = atkbd_softraw;
920 atkbd->softrepeat = atkbd_softrepeat;
921 atkbd->scroll = atkbd_scroll;
922
1da177e4
LT		 923 if (atkbd->softrepeat)
924 atkbd->softraw = 1;
925
926 serio_set_drvdata(serio, atkbd);
927
928 err = serio_open(serio, drv);
3c42f0c3
DT		 929 if (err)
930 goto fail;
1da177e4
LT		 931
932 if (atkbd->write) {
933
934 if (atkbd_probe(atkbd)) {
935 serio_close(serio);
3c42f0c3
DT		 936 err = -ENODEV;
937 goto fail;
1da177e4
LT		 938 }
939
940 atkbd->set = atkbd_select_set(atkbd, atkbd_set, atkbd_extra);
941 atkbd_activate(atkbd);
942
943 } else {
944 atkbd->set = 2;
945 atkbd->id = 0xab00;
946 }
947
1da177e4
LT		 948 atkbd_set_keycode_table(atkbd);
949 atkbd_set_device_attrs(atkbd);
950
1da177e4
LT		 951 device_create_file(&serio->dev, &atkbd_attr_extra);
952 device_create_file(&serio->dev, &atkbd_attr_scroll);
953 device_create_file(&serio->dev, &atkbd_attr_set);
954 device_create_file(&serio->dev, &atkbd_attr_softrepeat);
955 device_create_file(&serio->dev, &atkbd_attr_softraw);
956
957 atkbd_enable(atkbd);
958
3c42f0c3 959 input_register_device(atkbd->dev);
1da177e4
LT		 960
961 return 0;
3c42f0c3
DT		 962
963 fail: serio_set_drvdata(serio, NULL);
964 input_free_device(dev);
965 kfree(atkbd);
966 return err;
1da177e4
LT		 967}
968
969/*
970 * atkbd_reconnect() tries to restore keyboard into a sane state and is
971 * most likely called on resume.
972 */
973
974static int atkbd_reconnect(struct serio *serio)
975{
976 struct atkbd *atkbd = serio_get_drvdata(serio);
977 struct serio_driver *drv = serio->drv;
978 unsigned char param[1];
979
980 if (!atkbd || !drv) {
981 printk(KERN_DEBUG "atkbd: reconnect request, but serio is disconnected, ignoring...\n");
982 return -1;
983 }
984
985 atkbd_disable(atkbd);
986
987 if (atkbd->write) {
3c42f0c3
DT		 988 param[0] = (test_bit(LED_SCROLLL, atkbd->dev->led) ? 1 : 0)
989 | (test_bit(LED_NUML, atkbd->dev->led) ? 2 : 0)
990 | (test_bit(LED_CAPSL, atkbd->dev->led) ? 4 : 0);
1da177e4
LT		 991
992 if (atkbd_probe(atkbd))
993 return -1;
994 if (atkbd->set != atkbd_select_set(atkbd, atkbd->set, atkbd->extra))
995 return -1;
996
997 atkbd_activate(atkbd);
998
999 if (ps2_command(&atkbd->ps2dev, param, ATKBD_CMD_SETLEDS))
1000 return -1;
1001 }
1002
1003 atkbd_enable(atkbd);
1004
1005 return 0;
1006}
1007
1008static struct serio_device_id atkbd_serio_ids[] = {
1009 {
1010 .type = SERIO_8042,
1011 .proto = SERIO_ANY,
1012 .id = SERIO_ANY,
1013 .extra = SERIO_ANY,
1014 },
1015 {
1016 .type = SERIO_8042_XL,
1017 .proto = SERIO_ANY,
1018 .id = SERIO_ANY,
1019 .extra = SERIO_ANY,
1020 },
1021 {
1022 .type = SERIO_RS232,
1023 .proto = SERIO_PS2SER,
1024 .id = SERIO_ANY,
1025 .extra = SERIO_ANY,
1026 },
1027 { 0 }
1028};
1029
1030MODULE_DEVICE_TABLE(serio, atkbd_serio_ids);
1031
1032static struct serio_driver atkbd_drv = {
1033 .driver = {
1034 .name = "atkbd",
1035 },
1036 .description = DRIVER_DESC,
1037 .id_table = atkbd_serio_ids,
1038 .interrupt = atkbd_interrupt,
1039 .connect = atkbd_connect,
1040 .reconnect = atkbd_reconnect,
1041 .disconnect = atkbd_disconnect,
1042 .cleanup = atkbd_cleanup,
1043};
1044
1045static ssize_t atkbd_attr_show_helper(struct device *dev, char *buf,
1046 ssize_t (*handler)(struct atkbd *, char *))
1047{
1048 struct serio *serio = to_serio_port(dev);
1049 int retval;
1050
1051 retval = serio_pin_driver(serio);
1052 if (retval)
1053 return retval;
1054
1055 if (serio->drv != &atkbd_drv) {
1056 retval = -ENODEV;
1057 goto out;
1058 }
1059
1060 retval = handler((struct atkbd *)serio_get_drvdata(serio), buf);
1061
1062out:
1063 serio_unpin_driver(serio);
1064 return retval;
1065}
1066
1067static ssize_t atkbd_attr_set_helper(struct device *dev, const char *buf, size_t count,
1068 ssize_t (*handler)(struct atkbd *, const char *, size_t))
1069{
1070 struct serio *serio = to_serio_port(dev);
1071 struct atkbd *atkbd;
1072 int retval;
1073
1074 retval = serio_pin_driver(serio);
1075 if (retval)
1076 return retval;
1077
1078 if (serio->drv != &atkbd_drv) {
1079 retval = -ENODEV;
1080 goto out;
1081 }
1082
1083 atkbd = serio_get_drvdata(serio);
1084 atkbd_disable(atkbd);
1085 retval = handler(atkbd, buf, count);
1086 atkbd_enable(atkbd);
1087
1088out:
1089 serio_unpin_driver(serio);
1090 return retval;
1091}
1092
1093static ssize_t atkbd_show_extra(struct atkbd *atkbd, char *buf)
1094{
1095 return sprintf(buf, "%d\n", atkbd->extra ? 1 : 0);
1096}
1097
1098static ssize_t atkbd_set_extra(struct atkbd *atkbd, const char *buf, size_t count)
1099{
3c42f0c3 1100 struct input_dev *new_dev;
1da177e4
LT		 1101 unsigned long value;
1102 char *rest;
1103
1104 if (!atkbd->write)
1105 return -EIO;
1106
1107 value = simple_strtoul(buf, &rest, 10);
1108 if (*rest || value > 1)
1109 return -EINVAL;
1110
1111 if (atkbd->extra != value) {
3c42f0c3
DT		 1112 /*
1113 * Since device's properties will change we need to
1114 * unregister old device. But allocate new one first
1115 * to make sure we have it.
1116 */
1117 if (!(new_dev = input_allocate_device()))
1118 return -ENOMEM;
1119 input_unregister_device(atkbd->dev);
1120 atkbd->dev = new_dev;
1da177e4
LT		 1121 atkbd->set = atkbd_select_set(atkbd, atkbd->set, value);
1122 atkbd_activate(atkbd);
1123 atkbd_set_device_attrs(atkbd);
3c42f0c3 1124 input_register_device(atkbd->dev);
1da177e4
LT		 1125 }
1126 return count;
1127}
1128
1129static ssize_t atkbd_show_scroll(struct atkbd *atkbd, char *buf)
1130{
1131 return sprintf(buf, "%d\n", atkbd->scroll ? 1 : 0);
1132}
1133
1134static ssize_t atkbd_set_scroll(struct atkbd *atkbd, const char *buf, size_t count)
1135{
3c42f0c3 1136 struct input_dev *new_dev;
1da177e4
LT		 1137 unsigned long value;
1138 char *rest;
1139
1140 value = simple_strtoul(buf, &rest, 10);
1141 if (*rest || value > 1)
1142 return -EINVAL;
1143
1144 if (atkbd->scroll != value) {
3c42f0c3
DT		 1145 if (!(new_dev = input_allocate_device()))
1146 return -ENOMEM;
1147 input_unregister_device(atkbd->dev);
1148 atkbd->dev = new_dev;
1da177e4
LT		 1149 atkbd->scroll = value;
1150 atkbd_set_keycode_table(atkbd);
1151 atkbd_set_device_attrs(atkbd);
3c42f0c3 1152 input_register_device(atkbd->dev);
1da177e4
LT		 1153 }
1154 return count;
1155}
1156
1157static ssize_t atkbd_show_set(struct atkbd *atkbd, char *buf)
1158{
1159 return sprintf(buf, "%d\n", atkbd->set);
1160}
1161
1162static ssize_t atkbd_set_set(struct atkbd *atkbd, const char *buf, size_t count)
1163{
3c42f0c3 1164 struct input_dev *new_dev;
1da177e4
LT		 1165 unsigned long value;
1166 char *rest;
1167
1168 if (!atkbd->write)
1169 return -EIO;
1170
1171 value = simple_strtoul(buf, &rest, 10);
1172 if (*rest || (value != 2 && value != 3))
1173 return -EINVAL;
1174
1175 if (atkbd->set != value) {
3c42f0c3
DT		 1176 if (!(new_dev = input_allocate_device()))
1177 return -ENOMEM;
1178 input_unregister_device(atkbd->dev);
1179 atkbd->dev = new_dev;
1da177e4
LT		 1180 atkbd->set = atkbd_select_set(atkbd, value, atkbd->extra);
1181 atkbd_activate(atkbd);
1182 atkbd_set_keycode_table(atkbd);
1183 atkbd_set_device_attrs(atkbd);
3c42f0c3 1184 input_register_device(atkbd->dev);
1da177e4
LT		 1185 }
1186 return count;
1187}
1188
1189static ssize_t atkbd_show_softrepeat(struct atkbd *atkbd, char *buf)
1190{
1191 return sprintf(buf, "%d\n", atkbd->softrepeat ? 1 : 0);
1192}
1193
1194static ssize_t atkbd_set_softrepeat(struct atkbd *atkbd, const char *buf, size_t count)
1195{
3c42f0c3 1196 struct input_dev *new_dev;
1da177e4
LT		 1197 unsigned long value;
1198 char *rest;
1199
1200 if (!atkbd->write)
1201 return -EIO;
1202
1203 value = simple_strtoul(buf, &rest, 10);
1204 if (*rest || value > 1)
1205 return -EINVAL;
1206
1207 if (atkbd->softrepeat != value) {
3c42f0c3
DT		 1208 if (!(new_dev = input_allocate_device()))
1209 return -ENOMEM;
1210 input_unregister_device(atkbd->dev);
1211 atkbd->dev = new_dev;
1da177e4
LT		 1212 atkbd->softrepeat = value;
1213 if (atkbd->softrepeat)
1214 atkbd->softraw = 1;
1215 atkbd_set_device_attrs(atkbd);
3c42f0c3 1216 input_register_device(atkbd->dev);
1da177e4 1217 }
1da177e4
LT		 1218 return count;
1219}
1220
1221
1222static ssize_t atkbd_show_softraw(struct atkbd *atkbd, char *buf)
1223{
1224 return sprintf(buf, "%d\n", atkbd->softraw ? 1 : 0);
1225}
1226
1227static ssize_t atkbd_set_softraw(struct atkbd *atkbd, const char *buf, size_t count)
1228{
3c42f0c3 1229 struct input_dev *new_dev;
1da177e4
LT		 1230 unsigned long value;
1231 char *rest;
1232
1233 value = simple_strtoul(buf, &rest, 10);
1234 if (*rest || value > 1)
1235 return -EINVAL;
1236
1237 if (atkbd->softraw != value) {
3c42f0c3
DT		 1238 if (!(new_dev = input_allocate_device()))
1239 return -ENOMEM;
1240 input_unregister_device(atkbd->dev);
1241 atkbd->dev = new_dev;
1da177e4
LT		 1242 atkbd->softraw = value;
1243 atkbd_set_device_attrs(atkbd);
3c42f0c3 1244 input_register_device(atkbd->dev);
1da177e4
LT		 1245 }
1246 return count;
1247}
1248
1249
1250static int __init atkbd_init(void)
1251{
1252 serio_register_driver(&atkbd_drv);
1253 return 0;
1254}
1255
1256static void __exit atkbd_exit(void)
1257{
1258 serio_unregister_driver(&atkbd_drv);
1259}
1260
1261module_init(atkbd_init);
1262module_exit(atkbd_exit);
kernel source for telekom puls (alcatel/mediatek)