]>
Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
1da177e4 LT |
2 | * Written for linux by Johan Myreen as a translation from |
3 | * the assembly version by Linus (with diacriticals added) | |
4 | * | |
5 | * Some additional features added by Christoph Niemann (ChN), March 1993 | |
6 | * | |
7 | * Loadable keymaps by Risto Kankkunen, May 1993 | |
8 | * | |
9 | * Diacriticals redone & other small changes, aeb@cwi.nl, June 1993 | |
10 | * Added decr/incr_console, dynamic keymaps, Unicode support, | |
11 | * dynamic function/string keys, led setting, Sept 1994 | |
12 | * `Sticky' modifier keys, 951006. | |
13 | * | |
14 | * 11-11-96: SAK should now work in the raw mode (Martin Mares) | |
fe1e8604 | 15 | * |
1da177e4 LT |
16 | * Modified to provide 'generic' keyboard support by Hamish Macdonald |
17 | * Merge with the m68k keyboard driver and split-off of the PC low-level | |
18 | * parts by Geert Uytterhoeven, May 1997 | |
19 | * | |
20 | * 27-05-97: Added support for the Magic SysRq Key (Martin Mares) | |
21 | * 30-07-98: Dead keys redone, aeb@cwi.nl. | |
22 | * 21-08-02: Converted to input API, major cleanup. (Vojtech Pavlik) | |
23 | */ | |
24 | ||
9272e9a2 DT |
25 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
26 | ||
759448f4 | 27 | #include <linux/consolemap.h> |
1da177e4 LT |
28 | #include <linux/module.h> |
29 | #include <linux/sched.h> | |
30 | #include <linux/tty.h> | |
31 | #include <linux/tty_flip.h> | |
32 | #include <linux/mm.h> | |
33 | #include <linux/string.h> | |
34 | #include <linux/init.h> | |
35 | #include <linux/slab.h> | |
36 | ||
37 | #include <linux/kbd_kern.h> | |
38 | #include <linux/kbd_diacr.h> | |
39 | #include <linux/vt_kern.h> | |
1da177e4 | 40 | #include <linux/input.h> |
83cc5ed3 | 41 | #include <linux/reboot.h> |
41ab4396 | 42 | #include <linux/notifier.h> |
b39b0440 | 43 | #include <linux/jiffies.h> |
1da177e4 | 44 | |
98c2b373 GU |
45 | #include <asm/irq_regs.h> |
46 | ||
1da177e4 LT |
47 | extern void ctrl_alt_del(void); |
48 | ||
49 | /* | |
50 | * Exported functions/variables | |
51 | */ | |
52 | ||
53 | #define KBD_DEFMODE ((1 << VC_REPEAT) | (1 << VC_META)) | |
54 | ||
55 | /* | |
56 | * Some laptops take the 789uiojklm,. keys as number pad when NumLock is on. | |
57 | * This seems a good reason to start with NumLock off. On HIL keyboards | |
6aeed479 AC |
58 | * of PARISC machines however there is no NumLock key and everyone expects the |
59 | * keypad to be used for numbers. | |
1da177e4 LT |
60 | */ |
61 | ||
62 | #if defined(CONFIG_PARISC) && (defined(CONFIG_KEYBOARD_HIL) || defined(CONFIG_KEYBOARD_HIL_OLD)) | |
63 | #define KBD_DEFLEDS (1 << VC_NUMLOCK) | |
64 | #else | |
65 | #define KBD_DEFLEDS 0 | |
66 | #endif | |
67 | ||
68 | #define KBD_DEFLOCK 0 | |
69 | ||
70 | void compute_shiftstate(void); | |
71 | ||
72 | /* | |
73 | * Handler Tables. | |
74 | */ | |
75 | ||
76 | #define K_HANDLERS\ | |
77 | k_self, k_fn, k_spec, k_pad,\ | |
78 | k_dead, k_cons, k_cur, k_shift,\ | |
79 | k_meta, k_ascii, k_lock, k_lowercase,\ | |
b9ec4e10 | 80 | k_slock, k_dead2, k_brl, k_ignore |
1da177e4 | 81 | |
fe1e8604 | 82 | typedef void (k_handler_fn)(struct vc_data *vc, unsigned char value, |
7d12e780 | 83 | char up_flag); |
1da177e4 | 84 | static k_handler_fn K_HANDLERS; |
97f5f0cd | 85 | static k_handler_fn *k_handler[16] = { K_HANDLERS }; |
1da177e4 LT |
86 | |
87 | #define FN_HANDLERS\ | |
fe1e8604 DT |
88 | fn_null, fn_enter, fn_show_ptregs, fn_show_mem,\ |
89 | fn_show_state, fn_send_intr, fn_lastcons, fn_caps_toggle,\ | |
90 | fn_num, fn_hold, fn_scroll_forw, fn_scroll_back,\ | |
91 | fn_boot_it, fn_caps_on, fn_compose, fn_SAK,\ | |
92 | fn_dec_console, fn_inc_console, fn_spawn_con, fn_bare_num | |
1da177e4 | 93 | |
7d12e780 | 94 | typedef void (fn_handler_fn)(struct vc_data *vc); |
1da177e4 LT |
95 | static fn_handler_fn FN_HANDLERS; |
96 | static fn_handler_fn *fn_handler[] = { FN_HANDLERS }; | |
97 | ||
98 | /* | |
99 | * Variables exported for vt_ioctl.c | |
100 | */ | |
101 | ||
102 | /* maximum values each key_handler can handle */ | |
103 | const int max_vals[] = { | |
104 | 255, ARRAY_SIZE(func_table) - 1, ARRAY_SIZE(fn_handler) - 1, NR_PAD - 1, | |
105 | NR_DEAD - 1, 255, 3, NR_SHIFT - 1, 255, NR_ASCII - 1, NR_LOCK - 1, | |
b9ec4e10 | 106 | 255, NR_LOCK - 1, 255, NR_BRL - 1 |
1da177e4 LT |
107 | }; |
108 | ||
109 | const int NR_TYPES = ARRAY_SIZE(max_vals); | |
110 | ||
111 | struct kbd_struct kbd_table[MAX_NR_CONSOLES]; | |
f7511d5f | 112 | EXPORT_SYMBOL_GPL(kbd_table); |
1da177e4 | 113 | static struct kbd_struct *kbd = kbd_table; |
1da177e4 | 114 | |
81af8d67 | 115 | struct vt_spawn_console vt_spawn_con = { |
ccc94256 | 116 | .lock = __SPIN_LOCK_UNLOCKED(vt_spawn_con.lock), |
81af8d67 EB |
117 | .pid = NULL, |
118 | .sig = 0, | |
119 | }; | |
1da177e4 LT |
120 | |
121 | /* | |
122 | * Variables exported for vt.c | |
123 | */ | |
124 | ||
125 | int shift_state = 0; | |
126 | ||
127 | /* | |
128 | * Internal Data. | |
129 | */ | |
130 | ||
131 | static struct input_handler kbd_handler; | |
21cea58e | 132 | static DEFINE_SPINLOCK(kbd_event_lock); |
7b19ada2 | 133 | static unsigned long key_down[BITS_TO_LONGS(KEY_CNT)]; /* keyboard key bitmap */ |
1da177e4 | 134 | static unsigned char shift_down[NR_SHIFT]; /* shift state counters.. */ |
e0785572 | 135 | static bool dead_key_next; |
1da177e4 | 136 | static int npadch = -1; /* -1 or number assembled on pad */ |
b9ec4e10 | 137 | static unsigned int diacr; |
1da177e4 LT |
138 | static char rep; /* flag telling character repeat */ |
139 | ||
140 | static unsigned char ledstate = 0xff; /* undefined */ | |
141 | static unsigned char ledioctl; | |
142 | ||
143 | static struct ledptr { | |
144 | unsigned int *addr; | |
145 | unsigned int mask; | |
146 | unsigned char valid:1; | |
147 | } ledptrs[3]; | |
148 | ||
41ab4396 ST |
149 | /* |
150 | * Notifier list for console keyboard events | |
151 | */ | |
152 | static ATOMIC_NOTIFIER_HEAD(keyboard_notifier_list); | |
153 | ||
154 | int register_keyboard_notifier(struct notifier_block *nb) | |
155 | { | |
156 | return atomic_notifier_chain_register(&keyboard_notifier_list, nb); | |
157 | } | |
158 | EXPORT_SYMBOL_GPL(register_keyboard_notifier); | |
159 | ||
160 | int unregister_keyboard_notifier(struct notifier_block *nb) | |
161 | { | |
162 | return atomic_notifier_chain_unregister(&keyboard_notifier_list, nb); | |
163 | } | |
164 | EXPORT_SYMBOL_GPL(unregister_keyboard_notifier); | |
165 | ||
1da177e4 | 166 | /* |
c8e4c772 MR |
167 | * Translation of scancodes to keycodes. We set them on only the first |
168 | * keyboard in the list that accepts the scancode and keycode. | |
169 | * Explanation for not choosing the first attached keyboard anymore: | |
170 | * USB keyboards for example have two event devices: one for all "normal" | |
171 | * keys and one for extra function keys (like "volume up", "make coffee", | |
172 | * etc.). So this means that scancodes for the extra function keys won't | |
173 | * be valid for the first event device, but will be for the second. | |
1da177e4 | 174 | */ |
66d2a595 DT |
175 | |
176 | struct getset_keycode_data { | |
8613e4c2 | 177 | struct input_keymap_entry ke; |
66d2a595 DT |
178 | int error; |
179 | }; | |
180 | ||
181 | static int getkeycode_helper(struct input_handle *handle, void *data) | |
182 | { | |
183 | struct getset_keycode_data *d = data; | |
184 | ||
8613e4c2 | 185 | d->error = input_get_keycode(handle->dev, &d->ke); |
66d2a595 DT |
186 | |
187 | return d->error == 0; /* stop as soon as we successfully get one */ | |
188 | } | |
189 | ||
1da177e4 LT |
190 | int getkeycode(unsigned int scancode) |
191 | { | |
8613e4c2 MCC |
192 | struct getset_keycode_data d = { |
193 | .ke = { | |
194 | .flags = 0, | |
195 | .len = sizeof(scancode), | |
196 | .keycode = 0, | |
197 | }, | |
198 | .error = -ENODEV, | |
199 | }; | |
200 | ||
201 | memcpy(d.ke.scancode, &scancode, sizeof(scancode)); | |
c8e4c772 | 202 | |
66d2a595 | 203 | input_handler_for_each_handle(&kbd_handler, &d, getkeycode_helper); |
1da177e4 | 204 | |
8613e4c2 | 205 | return d.error ?: d.ke.keycode; |
66d2a595 DT |
206 | } |
207 | ||
208 | static int setkeycode_helper(struct input_handle *handle, void *data) | |
209 | { | |
210 | struct getset_keycode_data *d = data; | |
211 | ||
8613e4c2 | 212 | d->error = input_set_keycode(handle->dev, &d->ke); |
66d2a595 DT |
213 | |
214 | return d->error == 0; /* stop as soon as we successfully set one */ | |
1da177e4 LT |
215 | } |
216 | ||
217 | int setkeycode(unsigned int scancode, unsigned int keycode) | |
218 | { | |
8613e4c2 MCC |
219 | struct getset_keycode_data d = { |
220 | .ke = { | |
221 | .flags = 0, | |
222 | .len = sizeof(scancode), | |
223 | .keycode = keycode, | |
224 | }, | |
225 | .error = -ENODEV, | |
226 | }; | |
227 | ||
228 | memcpy(d.ke.scancode, &scancode, sizeof(scancode)); | |
c8e4c772 | 229 | |
66d2a595 | 230 | input_handler_for_each_handle(&kbd_handler, &d, setkeycode_helper); |
1da177e4 | 231 | |
66d2a595 | 232 | return d.error; |
1da177e4 LT |
233 | } |
234 | ||
235 | /* | |
18f7ad59 DT |
236 | * Making beeps and bells. Note that we prefer beeps to bells, but when |
237 | * shutting the sound off we do both. | |
1da177e4 | 238 | */ |
66d2a595 DT |
239 | |
240 | static int kd_sound_helper(struct input_handle *handle, void *data) | |
1da177e4 | 241 | { |
66d2a595 DT |
242 | unsigned int *hz = data; |
243 | struct input_dev *dev = handle->dev; | |
1da177e4 | 244 | |
66d2a595 | 245 | if (test_bit(EV_SND, dev->evbit)) { |
18f7ad59 | 246 | if (test_bit(SND_TONE, dev->sndbit)) { |
66d2a595 | 247 | input_inject_event(handle, EV_SND, SND_TONE, *hz); |
18f7ad59 DT |
248 | if (*hz) |
249 | return 0; | |
250 | } | |
251 | if (test_bit(SND_BELL, dev->sndbit)) | |
66d2a595 | 252 | input_inject_event(handle, EV_SND, SND_BELL, *hz ? 1 : 0); |
1da177e4 | 253 | } |
66d2a595 DT |
254 | |
255 | return 0; | |
256 | } | |
257 | ||
258 | static void kd_nosound(unsigned long ignored) | |
259 | { | |
260 | static unsigned int zero; | |
261 | ||
262 | input_handler_for_each_handle(&kbd_handler, &zero, kd_sound_helper); | |
1da177e4 LT |
263 | } |
264 | ||
8d06afab | 265 | static DEFINE_TIMER(kd_mksound_timer, kd_nosound, 0, 0); |
1da177e4 LT |
266 | |
267 | void kd_mksound(unsigned int hz, unsigned int ticks) | |
268 | { | |
66d2a595 | 269 | del_timer_sync(&kd_mksound_timer); |
1da177e4 | 270 | |
66d2a595 | 271 | input_handler_for_each_handle(&kbd_handler, &hz, kd_sound_helper); |
1da177e4 | 272 | |
66d2a595 DT |
273 | if (hz && ticks) |
274 | mod_timer(&kd_mksound_timer, jiffies + ticks); | |
1da177e4 | 275 | } |
f7511d5f | 276 | EXPORT_SYMBOL(kd_mksound); |
1da177e4 LT |
277 | |
278 | /* | |
279 | * Setting the keyboard rate. | |
280 | */ | |
281 | ||
66d2a595 | 282 | static int kbd_rate_helper(struct input_handle *handle, void *data) |
1da177e4 | 283 | { |
66d2a595 DT |
284 | struct input_dev *dev = handle->dev; |
285 | struct kbd_repeat *rep = data; | |
286 | ||
287 | if (test_bit(EV_REP, dev->evbit)) { | |
288 | ||
289 | if (rep[0].delay > 0) | |
290 | input_inject_event(handle, | |
291 | EV_REP, REP_DELAY, rep[0].delay); | |
292 | if (rep[0].period > 0) | |
293 | input_inject_event(handle, | |
294 | EV_REP, REP_PERIOD, rep[0].period); | |
295 | ||
296 | rep[1].delay = dev->rep[REP_DELAY]; | |
297 | rep[1].period = dev->rep[REP_PERIOD]; | |
1da177e4 | 298 | } |
66d2a595 DT |
299 | |
300 | return 0; | |
301 | } | |
302 | ||
303 | int kbd_rate(struct kbd_repeat *rep) | |
304 | { | |
305 | struct kbd_repeat data[2] = { *rep }; | |
306 | ||
307 | input_handler_for_each_handle(&kbd_handler, data, kbd_rate_helper); | |
308 | *rep = data[1]; /* Copy currently used settings */ | |
309 | ||
1da177e4 LT |
310 | return 0; |
311 | } | |
312 | ||
313 | /* | |
314 | * Helper Functions. | |
315 | */ | |
316 | static void put_queue(struct vc_data *vc, int ch) | |
317 | { | |
8ce73264 | 318 | struct tty_struct *tty = vc->port.tty; |
1da177e4 LT |
319 | |
320 | if (tty) { | |
321 | tty_insert_flip_char(tty, ch, 0); | |
322 | con_schedule_flip(tty); | |
323 | } | |
324 | } | |
325 | ||
326 | static void puts_queue(struct vc_data *vc, char *cp) | |
327 | { | |
8ce73264 | 328 | struct tty_struct *tty = vc->port.tty; |
1da177e4 LT |
329 | |
330 | if (!tty) | |
331 | return; | |
332 | ||
333 | while (*cp) { | |
334 | tty_insert_flip_char(tty, *cp, 0); | |
335 | cp++; | |
336 | } | |
337 | con_schedule_flip(tty); | |
338 | } | |
339 | ||
340 | static void applkey(struct vc_data *vc, int key, char mode) | |
341 | { | |
342 | static char buf[] = { 0x1b, 'O', 0x00, 0x00 }; | |
343 | ||
344 | buf[1] = (mode ? 'O' : '['); | |
345 | buf[2] = key; | |
346 | puts_queue(vc, buf); | |
347 | } | |
348 | ||
349 | /* | |
350 | * Many other routines do put_queue, but I think either | |
351 | * they produce ASCII, or they produce some user-assigned | |
352 | * string, and in both cases we might assume that it is | |
759448f4 | 353 | * in utf-8 already. |
1da177e4 | 354 | */ |
759448f4 | 355 | static void to_utf8(struct vc_data *vc, uint c) |
1da177e4 LT |
356 | { |
357 | if (c < 0x80) | |
358 | /* 0******* */ | |
359 | put_queue(vc, c); | |
fe1e8604 | 360 | else if (c < 0x800) { |
1da177e4 | 361 | /* 110***** 10****** */ |
fe1e8604 | 362 | put_queue(vc, 0xc0 | (c >> 6)); |
1da177e4 | 363 | put_queue(vc, 0x80 | (c & 0x3f)); |
e0785572 DT |
364 | } else if (c < 0x10000) { |
365 | if (c >= 0xD800 && c < 0xE000) | |
759448f4 JE |
366 | return; |
367 | if (c == 0xFFFF) | |
368 | return; | |
1da177e4 LT |
369 | /* 1110**** 10****** 10****** */ |
370 | put_queue(vc, 0xe0 | (c >> 12)); | |
371 | put_queue(vc, 0x80 | ((c >> 6) & 0x3f)); | |
372 | put_queue(vc, 0x80 | (c & 0x3f)); | |
e0785572 | 373 | } else if (c < 0x110000) { |
759448f4 JE |
374 | /* 11110*** 10****** 10****** 10****** */ |
375 | put_queue(vc, 0xf0 | (c >> 18)); | |
376 | put_queue(vc, 0x80 | ((c >> 12) & 0x3f)); | |
377 | put_queue(vc, 0x80 | ((c >> 6) & 0x3f)); | |
378 | put_queue(vc, 0x80 | (c & 0x3f)); | |
fe1e8604 | 379 | } |
1da177e4 LT |
380 | } |
381 | ||
fe1e8604 | 382 | /* |
1da177e4 LT |
383 | * Called after returning from RAW mode or when changing consoles - recompute |
384 | * shift_down[] and shift_state from key_down[] maybe called when keymap is | |
385 | * undefined, so that shiftkey release is seen | |
386 | */ | |
387 | void compute_shiftstate(void) | |
388 | { | |
389 | unsigned int i, j, k, sym, val; | |
390 | ||
391 | shift_state = 0; | |
392 | memset(shift_down, 0, sizeof(shift_down)); | |
fe1e8604 | 393 | |
1da177e4 LT |
394 | for (i = 0; i < ARRAY_SIZE(key_down); i++) { |
395 | ||
396 | if (!key_down[i]) | |
397 | continue; | |
398 | ||
399 | k = i * BITS_PER_LONG; | |
400 | ||
401 | for (j = 0; j < BITS_PER_LONG; j++, k++) { | |
402 | ||
403 | if (!test_bit(k, key_down)) | |
404 | continue; | |
405 | ||
406 | sym = U(key_maps[0][k]); | |
407 | if (KTYP(sym) != KT_SHIFT && KTYP(sym) != KT_SLOCK) | |
408 | continue; | |
409 | ||
410 | val = KVAL(sym); | |
411 | if (val == KVAL(K_CAPSSHIFT)) | |
412 | val = KVAL(K_SHIFT); | |
413 | ||
414 | shift_down[val]++; | |
415 | shift_state |= (1 << val); | |
416 | } | |
417 | } | |
418 | } | |
419 | ||
420 | /* | |
421 | * We have a combining character DIACR here, followed by the character CH. | |
422 | * If the combination occurs in the table, return the corresponding value. | |
423 | * Otherwise, if CH is a space or equals DIACR, return DIACR. | |
424 | * Otherwise, conclude that DIACR was not combining after all, | |
425 | * queue it and return CH. | |
426 | */ | |
b9ec4e10 | 427 | static unsigned int handle_diacr(struct vc_data *vc, unsigned int ch) |
1da177e4 | 428 | { |
b9ec4e10 | 429 | unsigned int d = diacr; |
1da177e4 LT |
430 | unsigned int i; |
431 | ||
432 | diacr = 0; | |
433 | ||
b9ec4e10 ST |
434 | if ((d & ~0xff) == BRL_UC_ROW) { |
435 | if ((ch & ~0xff) == BRL_UC_ROW) | |
436 | return d | ch; | |
437 | } else { | |
438 | for (i = 0; i < accent_table_size; i++) | |
439 | if (accent_table[i].diacr == d && accent_table[i].base == ch) | |
440 | return accent_table[i].result; | |
1da177e4 LT |
441 | } |
442 | ||
b9ec4e10 | 443 | if (ch == ' ' || ch == (BRL_UC_ROW|0) || ch == d) |
1da177e4 LT |
444 | return d; |
445 | ||
b9ec4e10 | 446 | if (kbd->kbdmode == VC_UNICODE) |
04c71976 ST |
447 | to_utf8(vc, d); |
448 | else { | |
449 | int c = conv_uni_to_8bit(d); | |
450 | if (c != -1) | |
451 | put_queue(vc, c); | |
452 | } | |
b9ec4e10 | 453 | |
1da177e4 LT |
454 | return ch; |
455 | } | |
456 | ||
457 | /* | |
458 | * Special function handlers | |
459 | */ | |
7d12e780 | 460 | static void fn_enter(struct vc_data *vc) |
1da177e4 LT |
461 | { |
462 | if (diacr) { | |
b9ec4e10 | 463 | if (kbd->kbdmode == VC_UNICODE) |
04c71976 ST |
464 | to_utf8(vc, diacr); |
465 | else { | |
466 | int c = conv_uni_to_8bit(diacr); | |
467 | if (c != -1) | |
468 | put_queue(vc, c); | |
469 | } | |
1da177e4 LT |
470 | diacr = 0; |
471 | } | |
e0785572 | 472 | |
1da177e4 LT |
473 | put_queue(vc, 13); |
474 | if (vc_kbd_mode(kbd, VC_CRLF)) | |
475 | put_queue(vc, 10); | |
476 | } | |
477 | ||
7d12e780 | 478 | static void fn_caps_toggle(struct vc_data *vc) |
1da177e4 LT |
479 | { |
480 | if (rep) | |
481 | return; | |
e0785572 | 482 | |
1da177e4 LT |
483 | chg_vc_kbd_led(kbd, VC_CAPSLOCK); |
484 | } | |
485 | ||
7d12e780 | 486 | static void fn_caps_on(struct vc_data *vc) |
1da177e4 LT |
487 | { |
488 | if (rep) | |
489 | return; | |
e0785572 | 490 | |
1da177e4 LT |
491 | set_vc_kbd_led(kbd, VC_CAPSLOCK); |
492 | } | |
493 | ||
7d12e780 | 494 | static void fn_show_ptregs(struct vc_data *vc) |
1da177e4 | 495 | { |
7d12e780 | 496 | struct pt_regs *regs = get_irq_regs(); |
e0785572 | 497 | |
1da177e4 LT |
498 | if (regs) |
499 | show_regs(regs); | |
500 | } | |
501 | ||
7d12e780 | 502 | static void fn_hold(struct vc_data *vc) |
1da177e4 | 503 | { |
8ce73264 | 504 | struct tty_struct *tty = vc->port.tty; |
1da177e4 LT |
505 | |
506 | if (rep || !tty) | |
507 | return; | |
508 | ||
509 | /* | |
510 | * Note: SCROLLOCK will be set (cleared) by stop_tty (start_tty); | |
511 | * these routines are also activated by ^S/^Q. | |
512 | * (And SCROLLOCK can also be set by the ioctl KDSKBLED.) | |
513 | */ | |
514 | if (tty->stopped) | |
515 | start_tty(tty); | |
516 | else | |
517 | stop_tty(tty); | |
518 | } | |
519 | ||
7d12e780 | 520 | static void fn_num(struct vc_data *vc) |
1da177e4 | 521 | { |
e0785572 | 522 | if (vc_kbd_mode(kbd, VC_APPLIC)) |
1da177e4 LT |
523 | applkey(vc, 'P', 1); |
524 | else | |
7d12e780 | 525 | fn_bare_num(vc); |
1da177e4 LT |
526 | } |
527 | ||
528 | /* | |
529 | * Bind this to Shift-NumLock if you work in application keypad mode | |
530 | * but want to be able to change the NumLock flag. | |
531 | * Bind this to NumLock if you prefer that the NumLock key always | |
532 | * changes the NumLock flag. | |
533 | */ | |
7d12e780 | 534 | static void fn_bare_num(struct vc_data *vc) |
1da177e4 LT |
535 | { |
536 | if (!rep) | |
537 | chg_vc_kbd_led(kbd, VC_NUMLOCK); | |
538 | } | |
539 | ||
7d12e780 | 540 | static void fn_lastcons(struct vc_data *vc) |
1da177e4 LT |
541 | { |
542 | /* switch to the last used console, ChN */ | |
543 | set_console(last_console); | |
544 | } | |
545 | ||
7d12e780 | 546 | static void fn_dec_console(struct vc_data *vc) |
1da177e4 LT |
547 | { |
548 | int i, cur = fg_console; | |
549 | ||
550 | /* Currently switching? Queue this next switch relative to that. */ | |
551 | if (want_console != -1) | |
552 | cur = want_console; | |
553 | ||
fe1e8604 | 554 | for (i = cur - 1; i != cur; i--) { |
1da177e4 | 555 | if (i == -1) |
fe1e8604 | 556 | i = MAX_NR_CONSOLES - 1; |
1da177e4 LT |
557 | if (vc_cons_allocated(i)) |
558 | break; | |
559 | } | |
560 | set_console(i); | |
561 | } | |
562 | ||
7d12e780 | 563 | static void fn_inc_console(struct vc_data *vc) |
1da177e4 LT |
564 | { |
565 | int i, cur = fg_console; | |
566 | ||
567 | /* Currently switching? Queue this next switch relative to that. */ | |
568 | if (want_console != -1) | |
569 | cur = want_console; | |
570 | ||
571 | for (i = cur+1; i != cur; i++) { | |
572 | if (i == MAX_NR_CONSOLES) | |
573 | i = 0; | |
574 | if (vc_cons_allocated(i)) | |
575 | break; | |
576 | } | |
577 | set_console(i); | |
578 | } | |
579 | ||
7d12e780 | 580 | static void fn_send_intr(struct vc_data *vc) |
1da177e4 | 581 | { |
8ce73264 | 582 | struct tty_struct *tty = vc->port.tty; |
1da177e4 LT |
583 | |
584 | if (!tty) | |
585 | return; | |
586 | tty_insert_flip_char(tty, 0, TTY_BREAK); | |
587 | con_schedule_flip(tty); | |
588 | } | |
589 | ||
7d12e780 | 590 | static void fn_scroll_forw(struct vc_data *vc) |
1da177e4 LT |
591 | { |
592 | scrollfront(vc, 0); | |
593 | } | |
594 | ||
7d12e780 | 595 | static void fn_scroll_back(struct vc_data *vc) |
1da177e4 LT |
596 | { |
597 | scrollback(vc, 0); | |
598 | } | |
599 | ||
7d12e780 | 600 | static void fn_show_mem(struct vc_data *vc) |
1da177e4 | 601 | { |
b2b755b5 | 602 | show_mem(0); |
1da177e4 LT |
603 | } |
604 | ||
7d12e780 | 605 | static void fn_show_state(struct vc_data *vc) |
1da177e4 LT |
606 | { |
607 | show_state(); | |
608 | } | |
609 | ||
7d12e780 | 610 | static void fn_boot_it(struct vc_data *vc) |
1da177e4 LT |
611 | { |
612 | ctrl_alt_del(); | |
613 | } | |
614 | ||
7d12e780 | 615 | static void fn_compose(struct vc_data *vc) |
1da177e4 | 616 | { |
e0785572 | 617 | dead_key_next = true; |
1da177e4 LT |
618 | } |
619 | ||
7d12e780 | 620 | static void fn_spawn_con(struct vc_data *vc) |
1da177e4 | 621 | { |
81af8d67 EB |
622 | spin_lock(&vt_spawn_con.lock); |
623 | if (vt_spawn_con.pid) | |
624 | if (kill_pid(vt_spawn_con.pid, vt_spawn_con.sig, 1)) { | |
625 | put_pid(vt_spawn_con.pid); | |
626 | vt_spawn_con.pid = NULL; | |
627 | } | |
628 | spin_unlock(&vt_spawn_con.lock); | |
1da177e4 LT |
629 | } |
630 | ||
7d12e780 | 631 | static void fn_SAK(struct vc_data *vc) |
1da177e4 | 632 | { |
8b6312f4 | 633 | struct work_struct *SAK_work = &vc_cons[fg_console].SAK_work; |
8b6312f4 | 634 | schedule_work(SAK_work); |
1da177e4 LT |
635 | } |
636 | ||
7d12e780 | 637 | static void fn_null(struct vc_data *vc) |
1da177e4 LT |
638 | { |
639 | compute_shiftstate(); | |
640 | } | |
641 | ||
642 | /* | |
643 | * Special key handlers | |
644 | */ | |
7d12e780 | 645 | static void k_ignore(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
646 | { |
647 | } | |
648 | ||
7d12e780 | 649 | static void k_spec(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
650 | { |
651 | if (up_flag) | |
652 | return; | |
653 | if (value >= ARRAY_SIZE(fn_handler)) | |
654 | return; | |
fe1e8604 | 655 | if ((kbd->kbdmode == VC_RAW || |
9fc3de9c AT |
656 | kbd->kbdmode == VC_MEDIUMRAW || |
657 | kbd->kbdmode == VC_OFF) && | |
1da177e4 LT |
658 | value != KVAL(K_SAK)) |
659 | return; /* SAK is allowed even in raw mode */ | |
7d12e780 | 660 | fn_handler[value](vc); |
1da177e4 LT |
661 | } |
662 | ||
7d12e780 | 663 | static void k_lowercase(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 | 664 | { |
9272e9a2 | 665 | pr_err("k_lowercase was called - impossible\n"); |
1da177e4 LT |
666 | } |
667 | ||
7d12e780 | 668 | static void k_unicode(struct vc_data *vc, unsigned int value, char up_flag) |
1da177e4 LT |
669 | { |
670 | if (up_flag) | |
671 | return; /* no action, if this is a key release */ | |
672 | ||
673 | if (diacr) | |
674 | value = handle_diacr(vc, value); | |
675 | ||
676 | if (dead_key_next) { | |
e0785572 | 677 | dead_key_next = false; |
1da177e4 LT |
678 | diacr = value; |
679 | return; | |
680 | } | |
b9ec4e10 | 681 | if (kbd->kbdmode == VC_UNICODE) |
04c71976 ST |
682 | to_utf8(vc, value); |
683 | else { | |
684 | int c = conv_uni_to_8bit(value); | |
685 | if (c != -1) | |
686 | put_queue(vc, c); | |
687 | } | |
1da177e4 LT |
688 | } |
689 | ||
690 | /* | |
691 | * Handle dead key. Note that we now may have several | |
692 | * dead keys modifying the same character. Very useful | |
693 | * for Vietnamese. | |
694 | */ | |
7d12e780 | 695 | static void k_deadunicode(struct vc_data *vc, unsigned int value, char up_flag) |
1da177e4 LT |
696 | { |
697 | if (up_flag) | |
698 | return; | |
e0785572 | 699 | |
1da177e4 LT |
700 | diacr = (diacr ? handle_diacr(vc, value) : value); |
701 | } | |
702 | ||
7d12e780 | 703 | static void k_self(struct vc_data *vc, unsigned char value, char up_flag) |
b9ec4e10 | 704 | { |
d2187ebd | 705 | k_unicode(vc, conv_8bit_to_uni(value), up_flag); |
b9ec4e10 ST |
706 | } |
707 | ||
7d12e780 | 708 | static void k_dead2(struct vc_data *vc, unsigned char value, char up_flag) |
b9ec4e10 | 709 | { |
7d12e780 | 710 | k_deadunicode(vc, value, up_flag); |
b9ec4e10 ST |
711 | } |
712 | ||
1da177e4 LT |
713 | /* |
714 | * Obsolete - for backwards compatibility only | |
715 | */ | |
7d12e780 | 716 | static void k_dead(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 | 717 | { |
0f5e560e | 718 | static const unsigned char ret_diacr[NR_DEAD] = {'`', '\'', '^', '~', '"', ',' }; |
e0785572 DT |
719 | |
720 | k_deadunicode(vc, ret_diacr[value], up_flag); | |
1da177e4 LT |
721 | } |
722 | ||
7d12e780 | 723 | static void k_cons(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
724 | { |
725 | if (up_flag) | |
726 | return; | |
e0785572 | 727 | |
1da177e4 LT |
728 | set_console(value); |
729 | } | |
730 | ||
7d12e780 | 731 | static void k_fn(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 | 732 | { |
1da177e4 LT |
733 | if (up_flag) |
734 | return; | |
e0785572 DT |
735 | |
736 | if ((unsigned)value < ARRAY_SIZE(func_table)) { | |
1da177e4 LT |
737 | if (func_table[value]) |
738 | puts_queue(vc, func_table[value]); | |
739 | } else | |
9272e9a2 | 740 | pr_err("k_fn called with value=%d\n", value); |
1da177e4 LT |
741 | } |
742 | ||
7d12e780 | 743 | static void k_cur(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 | 744 | { |
e52b29c2 | 745 | static const char cur_chars[] = "BDCA"; |
1da177e4 LT |
746 | |
747 | if (up_flag) | |
748 | return; | |
e0785572 | 749 | |
1da177e4 LT |
750 | applkey(vc, cur_chars[value], vc_kbd_mode(kbd, VC_CKMODE)); |
751 | } | |
752 | ||
7d12e780 | 753 | static void k_pad(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 | 754 | { |
0f5e560e AM |
755 | static const char pad_chars[] = "0123456789+-*/\015,.?()#"; |
756 | static const char app_map[] = "pqrstuvwxylSRQMnnmPQS"; | |
1da177e4 LT |
757 | |
758 | if (up_flag) | |
759 | return; /* no action, if this is a key release */ | |
760 | ||
761 | /* kludge... shift forces cursor/number keys */ | |
762 | if (vc_kbd_mode(kbd, VC_APPLIC) && !shift_down[KG_SHIFT]) { | |
763 | applkey(vc, app_map[value], 1); | |
764 | return; | |
765 | } | |
766 | ||
e0785572 DT |
767 | if (!vc_kbd_led(kbd, VC_NUMLOCK)) { |
768 | ||
1da177e4 | 769 | switch (value) { |
e0785572 DT |
770 | case KVAL(K_PCOMMA): |
771 | case KVAL(K_PDOT): | |
772 | k_fn(vc, KVAL(K_REMOVE), 0); | |
773 | return; | |
774 | case KVAL(K_P0): | |
775 | k_fn(vc, KVAL(K_INSERT), 0); | |
776 | return; | |
777 | case KVAL(K_P1): | |
778 | k_fn(vc, KVAL(K_SELECT), 0); | |
779 | return; | |
780 | case KVAL(K_P2): | |
781 | k_cur(vc, KVAL(K_DOWN), 0); | |
782 | return; | |
783 | case KVAL(K_P3): | |
784 | k_fn(vc, KVAL(K_PGDN), 0); | |
785 | return; | |
786 | case KVAL(K_P4): | |
787 | k_cur(vc, KVAL(K_LEFT), 0); | |
788 | return; | |
789 | case KVAL(K_P6): | |
790 | k_cur(vc, KVAL(K_RIGHT), 0); | |
791 | return; | |
792 | case KVAL(K_P7): | |
793 | k_fn(vc, KVAL(K_FIND), 0); | |
794 | return; | |
795 | case KVAL(K_P8): | |
796 | k_cur(vc, KVAL(K_UP), 0); | |
797 | return; | |
798 | case KVAL(K_P9): | |
799 | k_fn(vc, KVAL(K_PGUP), 0); | |
800 | return; | |
801 | case KVAL(K_P5): | |
802 | applkey(vc, 'G', vc_kbd_mode(kbd, VC_APPLIC)); | |
803 | return; | |
1da177e4 | 804 | } |
e0785572 | 805 | } |
1da177e4 LT |
806 | |
807 | put_queue(vc, pad_chars[value]); | |
808 | if (value == KVAL(K_PENTER) && vc_kbd_mode(kbd, VC_CRLF)) | |
809 | put_queue(vc, 10); | |
810 | } | |
811 | ||
7d12e780 | 812 | static void k_shift(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
813 | { |
814 | int old_state = shift_state; | |
815 | ||
816 | if (rep) | |
817 | return; | |
818 | /* | |
819 | * Mimic typewriter: | |
820 | * a CapsShift key acts like Shift but undoes CapsLock | |
821 | */ | |
822 | if (value == KVAL(K_CAPSSHIFT)) { | |
823 | value = KVAL(K_SHIFT); | |
824 | if (!up_flag) | |
825 | clr_vc_kbd_led(kbd, VC_CAPSLOCK); | |
826 | } | |
827 | ||
828 | if (up_flag) { | |
829 | /* | |
830 | * handle the case that two shift or control | |
831 | * keys are depressed simultaneously | |
832 | */ | |
833 | if (shift_down[value]) | |
834 | shift_down[value]--; | |
835 | } else | |
836 | shift_down[value]++; | |
837 | ||
838 | if (shift_down[value]) | |
839 | shift_state |= (1 << value); | |
840 | else | |
841 | shift_state &= ~(1 << value); | |
842 | ||
843 | /* kludge */ | |
844 | if (up_flag && shift_state != old_state && npadch != -1) { | |
845 | if (kbd->kbdmode == VC_UNICODE) | |
759448f4 | 846 | to_utf8(vc, npadch); |
1da177e4 LT |
847 | else |
848 | put_queue(vc, npadch & 0xff); | |
849 | npadch = -1; | |
850 | } | |
851 | } | |
852 | ||
7d12e780 | 853 | static void k_meta(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
854 | { |
855 | if (up_flag) | |
856 | return; | |
857 | ||
858 | if (vc_kbd_mode(kbd, VC_META)) { | |
859 | put_queue(vc, '\033'); | |
860 | put_queue(vc, value); | |
861 | } else | |
862 | put_queue(vc, value | 0x80); | |
863 | } | |
864 | ||
7d12e780 | 865 | static void k_ascii(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
866 | { |
867 | int base; | |
868 | ||
869 | if (up_flag) | |
870 | return; | |
871 | ||
872 | if (value < 10) { | |
873 | /* decimal input of code, while Alt depressed */ | |
874 | base = 10; | |
875 | } else { | |
876 | /* hexadecimal input of code, while AltGr depressed */ | |
877 | value -= 10; | |
878 | base = 16; | |
879 | } | |
880 | ||
881 | if (npadch == -1) | |
882 | npadch = value; | |
883 | else | |
884 | npadch = npadch * base + value; | |
885 | } | |
886 | ||
7d12e780 | 887 | static void k_lock(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
888 | { |
889 | if (up_flag || rep) | |
890 | return; | |
e0785572 | 891 | |
1da177e4 LT |
892 | chg_vc_kbd_lock(kbd, value); |
893 | } | |
894 | ||
7d12e780 | 895 | static void k_slock(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 | 896 | { |
7d12e780 | 897 | k_shift(vc, value, up_flag); |
1da177e4 LT |
898 | if (up_flag || rep) |
899 | return; | |
e0785572 | 900 | |
1da177e4 LT |
901 | chg_vc_kbd_slock(kbd, value); |
902 | /* try to make Alt, oops, AltGr and such work */ | |
903 | if (!key_maps[kbd->lockstate ^ kbd->slockstate]) { | |
904 | kbd->slockstate = 0; | |
905 | chg_vc_kbd_slock(kbd, value); | |
906 | } | |
907 | } | |
908 | ||
b9ec4e10 | 909 | /* by default, 300ms interval for combination release */ |
77426d72 ST |
910 | static unsigned brl_timeout = 300; |
911 | MODULE_PARM_DESC(brl_timeout, "Braille keys release delay in ms (0 for commit on first key release)"); | |
912 | module_param(brl_timeout, uint, 0644); | |
913 | ||
914 | static unsigned brl_nbchords = 1; | |
915 | MODULE_PARM_DESC(brl_nbchords, "Number of chords that produce a braille pattern (0 for dead chords)"); | |
916 | module_param(brl_nbchords, uint, 0644); | |
917 | ||
7d12e780 | 918 | static void k_brlcommit(struct vc_data *vc, unsigned int pattern, char up_flag) |
77426d72 ST |
919 | { |
920 | static unsigned long chords; | |
921 | static unsigned committed; | |
922 | ||
923 | if (!brl_nbchords) | |
7d12e780 | 924 | k_deadunicode(vc, BRL_UC_ROW | pattern, up_flag); |
77426d72 ST |
925 | else { |
926 | committed |= pattern; | |
927 | chords++; | |
928 | if (chords == brl_nbchords) { | |
7d12e780 | 929 | k_unicode(vc, BRL_UC_ROW | committed, up_flag); |
77426d72 ST |
930 | chords = 0; |
931 | committed = 0; | |
932 | } | |
933 | } | |
934 | } | |
935 | ||
7d12e780 | 936 | static void k_brl(struct vc_data *vc, unsigned char value, char up_flag) |
b9ec4e10 | 937 | { |
e0785572 | 938 | static unsigned pressed, committing; |
b9ec4e10 ST |
939 | static unsigned long releasestart; |
940 | ||
941 | if (kbd->kbdmode != VC_UNICODE) { | |
942 | if (!up_flag) | |
9272e9a2 | 943 | pr_warning("keyboard mode must be unicode for braille patterns\n"); |
b9ec4e10 ST |
944 | return; |
945 | } | |
946 | ||
947 | if (!value) { | |
7d12e780 | 948 | k_unicode(vc, BRL_UC_ROW, up_flag); |
b9ec4e10 ST |
949 | return; |
950 | } | |
951 | ||
952 | if (value > 8) | |
953 | return; | |
954 | ||
e0785572 | 955 | if (!up_flag) { |
b9ec4e10 ST |
956 | pressed |= 1 << (value - 1); |
957 | if (!brl_timeout) | |
958 | committing = pressed; | |
e0785572 DT |
959 | } else if (brl_timeout) { |
960 | if (!committing || | |
961 | time_after(jiffies, | |
962 | releasestart + msecs_to_jiffies(brl_timeout))) { | |
963 | committing = pressed; | |
964 | releasestart = jiffies; | |
965 | } | |
966 | pressed &= ~(1 << (value - 1)); | |
967 | if (!pressed && committing) { | |
968 | k_brlcommit(vc, committing, 0); | |
969 | committing = 0; | |
970 | } | |
971 | } else { | |
972 | if (committing) { | |
973 | k_brlcommit(vc, committing, 0); | |
974 | committing = 0; | |
975 | } | |
976 | pressed &= ~(1 << (value - 1)); | |
b9ec4e10 ST |
977 | } |
978 | } | |
979 | ||
1da177e4 LT |
980 | /* |
981 | * The leds display either (i) the status of NumLock, CapsLock, ScrollLock, | |
982 | * or (ii) whatever pattern of lights people want to show using KDSETLED, | |
983 | * or (iii) specified bits of specified words in kernel memory. | |
984 | */ | |
985 | unsigned char getledstate(void) | |
986 | { | |
987 | return ledstate; | |
988 | } | |
989 | ||
990 | void setledstate(struct kbd_struct *kbd, unsigned int led) | |
991 | { | |
992 | if (!(led & ~7)) { | |
993 | ledioctl = led; | |
994 | kbd->ledmode = LED_SHOW_IOCTL; | |
995 | } else | |
996 | kbd->ledmode = LED_SHOW_FLAGS; | |
e0785572 | 997 | |
1da177e4 LT |
998 | set_leds(); |
999 | } | |
1000 | ||
1001 | static inline unsigned char getleds(void) | |
1002 | { | |
1003 | struct kbd_struct *kbd = kbd_table + fg_console; | |
1004 | unsigned char leds; | |
1005 | int i; | |
1006 | ||
1007 | if (kbd->ledmode == LED_SHOW_IOCTL) | |
1008 | return ledioctl; | |
1009 | ||
1010 | leds = kbd->ledflagstate; | |
1011 | ||
1012 | if (kbd->ledmode == LED_SHOW_MEM) { | |
1013 | for (i = 0; i < 3; i++) | |
1014 | if (ledptrs[i].valid) { | |
1015 | if (*ledptrs[i].addr & ledptrs[i].mask) | |
1016 | leds |= (1 << i); | |
1017 | else | |
1018 | leds &= ~(1 << i); | |
1019 | } | |
1020 | } | |
1021 | return leds; | |
1022 | } | |
1023 | ||
66d2a595 DT |
1024 | static int kbd_update_leds_helper(struct input_handle *handle, void *data) |
1025 | { | |
1026 | unsigned char leds = *(unsigned char *)data; | |
1027 | ||
1028 | if (test_bit(EV_LED, handle->dev->evbit)) { | |
1029 | input_inject_event(handle, EV_LED, LED_SCROLLL, !!(leds & 0x01)); | |
1030 | input_inject_event(handle, EV_LED, LED_NUML, !!(leds & 0x02)); | |
1031 | input_inject_event(handle, EV_LED, LED_CAPSL, !!(leds & 0x04)); | |
1032 | input_inject_event(handle, EV_SYN, SYN_REPORT, 0); | |
1033 | } | |
1034 | ||
1035 | return 0; | |
1036 | } | |
1037 | ||
1da177e4 | 1038 | /* |
66d2a595 DT |
1039 | * This is the tasklet that updates LED state on all keyboards |
1040 | * attached to the box. The reason we use tasklet is that we | |
1041 | * need to handle the scenario when keyboard handler is not | |
1042 | * registered yet but we already getting updates form VT to | |
1043 | * update led state. | |
1da177e4 | 1044 | */ |
1da177e4 LT |
1045 | static void kbd_bh(unsigned long dummy) |
1046 | { | |
1da177e4 LT |
1047 | unsigned char leds = getleds(); |
1048 | ||
1049 | if (leds != ledstate) { | |
66d2a595 DT |
1050 | input_handler_for_each_handle(&kbd_handler, &leds, |
1051 | kbd_update_leds_helper); | |
1052 | ledstate = leds; | |
1da177e4 | 1053 | } |
1da177e4 LT |
1054 | } |
1055 | ||
1056 | DECLARE_TASKLET_DISABLED(keyboard_tasklet, kbd_bh, 0); | |
1057 | ||
1da177e4 | 1058 | #if defined(CONFIG_X86) || defined(CONFIG_IA64) || defined(CONFIG_ALPHA) ||\ |
0b57ee9e AB |
1059 | defined(CONFIG_MIPS) || defined(CONFIG_PPC) || defined(CONFIG_SPARC) ||\ |
1060 | defined(CONFIG_PARISC) || defined(CONFIG_SUPERH) ||\ | |
3a4e832c HCE |
1061 | (defined(CONFIG_ARM) && defined(CONFIG_KEYBOARD_ATKBD) && !defined(CONFIG_ARCH_RPC)) ||\ |
1062 | defined(CONFIG_AVR32) | |
1da177e4 LT |
1063 | |
1064 | #define HW_RAW(dev) (test_bit(EV_MSC, dev->evbit) && test_bit(MSC_RAW, dev->mscbit) &&\ | |
1065 | ((dev)->id.bustype == BUS_I8042) && ((dev)->id.vendor == 0x0001) && ((dev)->id.product == 0x0001)) | |
1066 | ||
0f5e560e | 1067 | static const unsigned short x86_keycodes[256] = |
1da177e4 LT |
1068 | { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, |
1069 | 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, | |
1070 | 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, | |
1071 | 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, | |
1072 | 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, | |
1073 | 80, 81, 82, 83, 84,118, 86, 87, 88,115,120,119,121,112,123, 92, | |
896cdc7b | 1074 | 284,285,309, 0,312, 91,327,328,329,331,333,335,336,337,338,339, |
1da177e4 LT |
1075 | 367,288,302,304,350, 89,334,326,267,126,268,269,125,347,348,349, |
1076 | 360,261,262,263,268,376,100,101,321,316,373,286,289,102,351,355, | |
72a42f24 HG |
1077 | 103,104,105,275,287,279,258,106,274,107,294,364,358,363,362,361, |
1078 | 291,108,381,281,290,272,292,305,280, 99,112,257,306,359,113,114, | |
1da177e4 LT |
1079 | 264,117,271,374,379,265,266, 93, 94, 95, 85,259,375,260, 90,116, |
1080 | 377,109,111,277,278,282,283,295,296,297,299,300,301,293,303,307, | |
1081 | 308,310,313,314,315,317,318,319,320,357,322,323,324,325,276,330, | |
1082 | 332,340,365,342,343,344,345,346,356,270,341,368,369,370,371,372 }; | |
1083 | ||
0b57ee9e | 1084 | #ifdef CONFIG_SPARC |
e0785572 | 1085 | static int sparc_l1_a_state; |
1da177e4 LT |
1086 | extern void sun_do_break(void); |
1087 | #endif | |
1088 | ||
fe1e8604 | 1089 | static int emulate_raw(struct vc_data *vc, unsigned int keycode, |
1da177e4 LT |
1090 | unsigned char up_flag) |
1091 | { | |
896cdc7b | 1092 | int code; |
1da177e4 LT |
1093 | |
1094 | switch (keycode) { | |
896cdc7b | 1095 | |
e0785572 DT |
1096 | case KEY_PAUSE: |
1097 | put_queue(vc, 0xe1); | |
1098 | put_queue(vc, 0x1d | up_flag); | |
1099 | put_queue(vc, 0x45 | up_flag); | |
1100 | break; | |
896cdc7b | 1101 | |
e0785572 DT |
1102 | case KEY_HANGEUL: |
1103 | if (!up_flag) | |
1104 | put_queue(vc, 0xf2); | |
1105 | break; | |
1da177e4 | 1106 | |
e0785572 DT |
1107 | case KEY_HANJA: |
1108 | if (!up_flag) | |
1109 | put_queue(vc, 0xf1); | |
1110 | break; | |
896cdc7b | 1111 | |
e0785572 DT |
1112 | case KEY_SYSRQ: |
1113 | /* | |
1114 | * Real AT keyboards (that's what we're trying | |
1115 | * to emulate here emit 0xe0 0x2a 0xe0 0x37 when | |
1116 | * pressing PrtSc/SysRq alone, but simply 0x54 | |
1117 | * when pressing Alt+PrtSc/SysRq. | |
1118 | */ | |
1119 | if (test_bit(KEY_LEFTALT, key_down) || | |
1120 | test_bit(KEY_RIGHTALT, key_down)) { | |
1121 | put_queue(vc, 0x54 | up_flag); | |
1122 | } else { | |
1123 | put_queue(vc, 0xe0); | |
1124 | put_queue(vc, 0x2a | up_flag); | |
1125 | put_queue(vc, 0xe0); | |
1126 | put_queue(vc, 0x37 | up_flag); | |
1127 | } | |
1128 | break; | |
1da177e4 | 1129 | |
e0785572 DT |
1130 | default: |
1131 | if (keycode > 255) | |
1132 | return -1; | |
1da177e4 | 1133 | |
e0785572 DT |
1134 | code = x86_keycodes[keycode]; |
1135 | if (!code) | |
1136 | return -1; | |
1da177e4 | 1137 | |
e0785572 DT |
1138 | if (code & 0x100) |
1139 | put_queue(vc, 0xe0); | |
1140 | put_queue(vc, (code & 0x7f) | up_flag); | |
1141 | ||
1142 | break; | |
1da177e4 LT |
1143 | } |
1144 | ||
1145 | return 0; | |
1146 | } | |
1147 | ||
1148 | #else | |
1149 | ||
1150 | #define HW_RAW(dev) 0 | |
1151 | ||
1da177e4 LT |
1152 | static int emulate_raw(struct vc_data *vc, unsigned int keycode, unsigned char up_flag) |
1153 | { | |
1154 | if (keycode > 127) | |
1155 | return -1; | |
1156 | ||
1157 | put_queue(vc, keycode | up_flag); | |
1158 | return 0; | |
1159 | } | |
1160 | #endif | |
1161 | ||
1162 | static void kbd_rawcode(unsigned char data) | |
1163 | { | |
1164 | struct vc_data *vc = vc_cons[fg_console].d; | |
e0785572 | 1165 | |
0c09b2ac | 1166 | kbd = kbd_table + vc->vc_num; |
1da177e4 LT |
1167 | if (kbd->kbdmode == VC_RAW) |
1168 | put_queue(vc, data); | |
1169 | } | |
1170 | ||
7d12e780 | 1171 | static void kbd_keycode(unsigned int keycode, int down, int hw_raw) |
1da177e4 LT |
1172 | { |
1173 | struct vc_data *vc = vc_cons[fg_console].d; | |
1174 | unsigned short keysym, *key_map; | |
e0785572 DT |
1175 | unsigned char type; |
1176 | bool raw_mode; | |
1da177e4 LT |
1177 | struct tty_struct *tty; |
1178 | int shift_final; | |
41ab4396 | 1179 | struct keyboard_notifier_param param = { .vc = vc, .value = keycode, .down = down }; |
e0785572 | 1180 | int rc; |
1da177e4 | 1181 | |
8ce73264 | 1182 | tty = vc->port.tty; |
1da177e4 LT |
1183 | |
1184 | if (tty && (!tty->driver_data)) { | |
1185 | /* No driver data? Strange. Okay we fix it then. */ | |
1186 | tty->driver_data = vc; | |
1187 | } | |
1188 | ||
0c09b2ac | 1189 | kbd = kbd_table + vc->vc_num; |
1da177e4 | 1190 | |
0b57ee9e | 1191 | #ifdef CONFIG_SPARC |
1da177e4 LT |
1192 | if (keycode == KEY_STOP) |
1193 | sparc_l1_a_state = down; | |
1194 | #endif | |
1195 | ||
1196 | rep = (down == 2); | |
1197 | ||
e0785572 DT |
1198 | raw_mode = (kbd->kbdmode == VC_RAW); |
1199 | if (raw_mode && !hw_raw) | |
1da177e4 | 1200 | if (emulate_raw(vc, keycode, !down << 7)) |
9e35d206 | 1201 | if (keycode < BTN_MISC && printk_ratelimit()) |
9272e9a2 DT |
1202 | pr_warning("can't emulate rawmode for keycode %d\n", |
1203 | keycode); | |
1da177e4 | 1204 | |
0b57ee9e | 1205 | #ifdef CONFIG_SPARC |
1da177e4 | 1206 | if (keycode == KEY_A && sparc_l1_a_state) { |
e0785572 | 1207 | sparc_l1_a_state = false; |
1da177e4 LT |
1208 | sun_do_break(); |
1209 | } | |
1210 | #endif | |
1211 | ||
1212 | if (kbd->kbdmode == VC_MEDIUMRAW) { | |
1213 | /* | |
1214 | * This is extended medium raw mode, with keys above 127 | |
1215 | * encoded as 0, high 7 bits, low 7 bits, with the 0 bearing | |
1216 | * the 'up' flag if needed. 0 is reserved, so this shouldn't | |
1217 | * interfere with anything else. The two bytes after 0 will | |
1218 | * always have the up flag set not to interfere with older | |
1219 | * applications. This allows for 16384 different keycodes, | |
1220 | * which should be enough. | |
1221 | */ | |
1222 | if (keycode < 128) { | |
1223 | put_queue(vc, keycode | (!down << 7)); | |
1224 | } else { | |
1225 | put_queue(vc, !down << 7); | |
1226 | put_queue(vc, (keycode >> 7) | 0x80); | |
1227 | put_queue(vc, keycode | 0x80); | |
1228 | } | |
e0785572 | 1229 | raw_mode = true; |
1da177e4 LT |
1230 | } |
1231 | ||
1232 | if (down) | |
1233 | set_bit(keycode, key_down); | |
1234 | else | |
1235 | clear_bit(keycode, key_down); | |
1236 | ||
fe1e8604 DT |
1237 | if (rep && |
1238 | (!vc_kbd_mode(kbd, VC_REPEAT) || | |
f34d7a5b | 1239 | (tty && !L_ECHO(tty) && tty_chars_in_buffer(tty)))) { |
1da177e4 LT |
1240 | /* |
1241 | * Don't repeat a key if the input buffers are not empty and the | |
fe1e8604 | 1242 | * characters get aren't echoed locally. This makes key repeat |
1da177e4 LT |
1243 | * usable with slow applications and under heavy loads. |
1244 | */ | |
1245 | return; | |
1246 | } | |
1247 | ||
41ab4396 | 1248 | param.shift = shift_final = (shift_state | kbd->slockstate) ^ kbd->lockstate; |
0beb4f6f | 1249 | param.ledstate = kbd->ledflagstate; |
1da177e4 LT |
1250 | key_map = key_maps[shift_final]; |
1251 | ||
e0785572 DT |
1252 | rc = atomic_notifier_call_chain(&keyboard_notifier_list, |
1253 | KBD_KEYCODE, ¶m); | |
1254 | if (rc == NOTIFY_STOP || !key_map) { | |
1255 | atomic_notifier_call_chain(&keyboard_notifier_list, | |
1256 | KBD_UNBOUND_KEYCODE, ¶m); | |
1da177e4 LT |
1257 | compute_shiftstate(); |
1258 | kbd->slockstate = 0; | |
1259 | return; | |
1260 | } | |
1261 | ||
e0785572 | 1262 | if (keycode < NR_KEYS) |
b9ec4e10 | 1263 | keysym = key_map[keycode]; |
e0785572 DT |
1264 | else if (keycode >= KEY_BRL_DOT1 && keycode <= KEY_BRL_DOT8) |
1265 | keysym = U(K(KT_BRL, keycode - KEY_BRL_DOT1 + 1)); | |
1266 | else | |
1267 | return; | |
1da177e4 | 1268 | |
1da177e4 LT |
1269 | type = KTYP(keysym); |
1270 | ||
1271 | if (type < 0xf0) { | |
41ab4396 | 1272 | param.value = keysym; |
e0785572 DT |
1273 | rc = atomic_notifier_call_chain(&keyboard_notifier_list, |
1274 | KBD_UNICODE, ¶m); | |
1275 | if (rc != NOTIFY_STOP) | |
1276 | if (down && !raw_mode) | |
1277 | to_utf8(vc, keysym); | |
1da177e4 LT |
1278 | return; |
1279 | } | |
1280 | ||
1281 | type -= 0xf0; | |
1282 | ||
1da177e4 LT |
1283 | if (type == KT_LETTER) { |
1284 | type = KT_LATIN; | |
1285 | if (vc_kbd_led(kbd, VC_CAPSLOCK)) { | |
1286 | key_map = key_maps[shift_final ^ (1 << KG_SHIFT)]; | |
1287 | if (key_map) | |
1288 | keysym = key_map[keycode]; | |
1289 | } | |
1290 | } | |
41ab4396 | 1291 | |
e0785572 DT |
1292 | param.value = keysym; |
1293 | rc = atomic_notifier_call_chain(&keyboard_notifier_list, | |
1294 | KBD_KEYSYM, ¶m); | |
1295 | if (rc == NOTIFY_STOP) | |
41ab4396 ST |
1296 | return; |
1297 | ||
9fc3de9c | 1298 | if ((raw_mode || kbd->kbdmode == VC_OFF) && type != KT_SPEC && type != KT_SHIFT) |
41ab4396 | 1299 | return; |
1da177e4 | 1300 | |
7d12e780 | 1301 | (*k_handler[type])(vc, keysym & 0xff, !down); |
1da177e4 | 1302 | |
0beb4f6f | 1303 | param.ledstate = kbd->ledflagstate; |
41ab4396 ST |
1304 | atomic_notifier_call_chain(&keyboard_notifier_list, KBD_POST_KEYSYM, ¶m); |
1305 | ||
1da177e4 LT |
1306 | if (type != KT_SLOCK) |
1307 | kbd->slockstate = 0; | |
1308 | } | |
1309 | ||
fe1e8604 | 1310 | static void kbd_event(struct input_handle *handle, unsigned int event_type, |
1da177e4 LT |
1311 | unsigned int event_code, int value) |
1312 | { | |
21cea58e DT |
1313 | /* We are called with interrupts disabled, just take the lock */ |
1314 | spin_lock(&kbd_event_lock); | |
1315 | ||
1da177e4 LT |
1316 | if (event_type == EV_MSC && event_code == MSC_RAW && HW_RAW(handle->dev)) |
1317 | kbd_rawcode(value); | |
1318 | if (event_type == EV_KEY) | |
7d12e780 | 1319 | kbd_keycode(event_code, value, HW_RAW(handle->dev)); |
21cea58e DT |
1320 | |
1321 | spin_unlock(&kbd_event_lock); | |
1322 | ||
1da177e4 LT |
1323 | tasklet_schedule(&keyboard_tasklet); |
1324 | do_poke_blanked_console = 1; | |
1325 | schedule_console_callback(); | |
1326 | } | |
1327 | ||
0b7024ac DT |
1328 | static bool kbd_match(struct input_handler *handler, struct input_dev *dev) |
1329 | { | |
1330 | int i; | |
1331 | ||
1332 | if (test_bit(EV_SND, dev->evbit)) | |
1333 | return true; | |
1334 | ||
53c1f764 | 1335 | if (test_bit(EV_KEY, dev->evbit)) { |
0b7024ac DT |
1336 | for (i = KEY_RESERVED; i < BTN_MISC; i++) |
1337 | if (test_bit(i, dev->keybit)) | |
1338 | return true; | |
53c1f764 ST |
1339 | for (i = KEY_BRL_DOT1; i <= KEY_BRL_DOT10; i++) |
1340 | if (test_bit(i, dev->keybit)) | |
1341 | return true; | |
1342 | } | |
0b7024ac DT |
1343 | |
1344 | return false; | |
1345 | } | |
1346 | ||
1da177e4 LT |
1347 | /* |
1348 | * When a keyboard (or other input device) is found, the kbd_connect | |
1349 | * function is called. The function then looks at the device, and if it | |
1350 | * likes it, it can open it and get events from it. In this (kbd_connect) | |
1351 | * function, we should decide which VT to bind that keyboard to initially. | |
1352 | */ | |
5b2a0826 DT |
1353 | static int kbd_connect(struct input_handler *handler, struct input_dev *dev, |
1354 | const struct input_device_id *id) | |
1da177e4 LT |
1355 | { |
1356 | struct input_handle *handle; | |
5b2a0826 | 1357 | int error; |
1da177e4 | 1358 | |
22479e1c DT |
1359 | handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL); |
1360 | if (!handle) | |
5b2a0826 | 1361 | return -ENOMEM; |
1da177e4 LT |
1362 | |
1363 | handle->dev = dev; | |
1364 | handle->handler = handler; | |
fe1e8604 | 1365 | handle->name = "kbd"; |
1da177e4 | 1366 | |
5b2a0826 DT |
1367 | error = input_register_handle(handle); |
1368 | if (error) | |
1369 | goto err_free_handle; | |
1da177e4 | 1370 | |
5b2a0826 DT |
1371 | error = input_open_device(handle); |
1372 | if (error) | |
1373 | goto err_unregister_handle; | |
1374 | ||
1375 | return 0; | |
1376 | ||
1377 | err_unregister_handle: | |
1378 | input_unregister_handle(handle); | |
1379 | err_free_handle: | |
1380 | kfree(handle); | |
1381 | return error; | |
1da177e4 LT |
1382 | } |
1383 | ||
1384 | static void kbd_disconnect(struct input_handle *handle) | |
1385 | { | |
1386 | input_close_device(handle); | |
5b2a0826 | 1387 | input_unregister_handle(handle); |
1da177e4 LT |
1388 | kfree(handle); |
1389 | } | |
1390 | ||
c7e8dc6e DT |
1391 | /* |
1392 | * Start keyboard handler on the new keyboard by refreshing LED state to | |
1393 | * match the rest of the system. | |
1394 | */ | |
1395 | static void kbd_start(struct input_handle *handle) | |
1396 | { | |
c7e8dc6e | 1397 | tasklet_disable(&keyboard_tasklet); |
66d2a595 DT |
1398 | |
1399 | if (ledstate != 0xff) | |
1400 | kbd_update_leds_helper(handle, &ledstate); | |
1401 | ||
c7e8dc6e DT |
1402 | tasklet_enable(&keyboard_tasklet); |
1403 | } | |
1404 | ||
66e66118 | 1405 | static const struct input_device_id kbd_ids[] = { |
1da177e4 | 1406 | { |
6aeed479 AC |
1407 | .flags = INPUT_DEVICE_ID_MATCH_EVBIT, |
1408 | .evbit = { BIT_MASK(EV_KEY) }, | |
1409 | }, | |
fe1e8604 | 1410 | |
1da177e4 | 1411 | { |
6aeed479 AC |
1412 | .flags = INPUT_DEVICE_ID_MATCH_EVBIT, |
1413 | .evbit = { BIT_MASK(EV_SND) }, | |
1414 | }, | |
1da177e4 LT |
1415 | |
1416 | { }, /* Terminating entry */ | |
1417 | }; | |
1418 | ||
1419 | MODULE_DEVICE_TABLE(input, kbd_ids); | |
1420 | ||
1421 | static struct input_handler kbd_handler = { | |
1422 | .event = kbd_event, | |
0b7024ac | 1423 | .match = kbd_match, |
1da177e4 LT |
1424 | .connect = kbd_connect, |
1425 | .disconnect = kbd_disconnect, | |
c7e8dc6e | 1426 | .start = kbd_start, |
1da177e4 LT |
1427 | .name = "kbd", |
1428 | .id_table = kbd_ids, | |
1429 | }; | |
1430 | ||
1431 | int __init kbd_init(void) | |
1432 | { | |
1433 | int i; | |
4263cf0f | 1434 | int error; |
1da177e4 | 1435 | |
6aeed479 | 1436 | for (i = 0; i < MAX_NR_CONSOLES; i++) { |
2b192908 DT |
1437 | kbd_table[i].ledflagstate = KBD_DEFLEDS; |
1438 | kbd_table[i].default_ledflagstate = KBD_DEFLEDS; | |
1439 | kbd_table[i].ledmode = LED_SHOW_FLAGS; | |
1440 | kbd_table[i].lockstate = KBD_DEFLOCK; | |
1441 | kbd_table[i].slockstate = 0; | |
1442 | kbd_table[i].modeflags = KBD_DEFMODE; | |
2e8ecb9d | 1443 | kbd_table[i].kbdmode = default_utf8 ? VC_UNICODE : VC_XLATE; |
2b192908 | 1444 | } |
1da177e4 | 1445 | |
4263cf0f DT |
1446 | error = input_register_handler(&kbd_handler); |
1447 | if (error) | |
1448 | return error; | |
1da177e4 LT |
1449 | |
1450 | tasklet_enable(&keyboard_tasklet); | |
1451 | tasklet_schedule(&keyboard_tasklet); | |
1452 | ||
1453 | return 0; | |
1454 | } | |
247ff8e6 AC |
1455 | |
1456 | /* Ioctl support code */ | |
1457 | ||
1458 | /** | |
1459 | * vt_do_diacrit - diacritical table updates | |
1460 | * @cmd: ioctl request | |
1461 | * @up: pointer to user data for ioctl | |
1462 | * @perm: permissions check computed by caller | |
1463 | * | |
1464 | * Update the diacritical tables atomically and safely. Lock them | |
1465 | * against simultaneous keypresses | |
1466 | */ | |
1467 | int vt_do_diacrit(unsigned int cmd, void __user *up, int perm) | |
1468 | { | |
1469 | struct kbdiacrs __user *a = up; | |
1470 | unsigned long flags; | |
1471 | int asize; | |
1472 | int ret = 0; | |
1473 | ||
1474 | switch (cmd) { | |
1475 | case KDGKBDIACR: | |
1476 | { | |
1477 | struct kbdiacr *diacr; | |
1478 | int i; | |
1479 | ||
1480 | diacr = kmalloc(MAX_DIACR * sizeof(struct kbdiacr), | |
1481 | GFP_KERNEL); | |
1482 | if (diacr == NULL) | |
1483 | return -ENOMEM; | |
1484 | ||
1485 | /* Lock the diacriticals table, make a copy and then | |
1486 | copy it after we unlock */ | |
1487 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1488 | ||
1489 | asize = accent_table_size; | |
1490 | for (i = 0; i < asize; i++) { | |
1491 | diacr[i].diacr = conv_uni_to_8bit( | |
1492 | accent_table[i].diacr); | |
1493 | diacr[i].base = conv_uni_to_8bit( | |
1494 | accent_table[i].base); | |
1495 | diacr[i].result = conv_uni_to_8bit( | |
1496 | accent_table[i].result); | |
1497 | } | |
1498 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1499 | ||
1500 | if (put_user(asize, &a->kb_cnt)) | |
1501 | ret = -EFAULT; | |
1502 | else if (copy_to_user(a->kbdiacr, diacr, | |
1503 | asize * sizeof(struct kbdiacr))) | |
1504 | ret = -EFAULT; | |
1505 | kfree(diacr); | |
1506 | return ret; | |
1507 | } | |
1508 | case KDGKBDIACRUC: | |
1509 | { | |
1510 | struct kbdiacrsuc __user *a = up; | |
1511 | void *buf; | |
1512 | ||
1513 | buf = kmalloc(MAX_DIACR * sizeof(struct kbdiacruc), | |
1514 | GFP_KERNEL); | |
1515 | if (buf == NULL) | |
1516 | return -ENOMEM; | |
1517 | ||
1518 | /* Lock the diacriticals table, make a copy and then | |
1519 | copy it after we unlock */ | |
1520 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1521 | ||
1522 | asize = accent_table_size; | |
1523 | memcpy(buf, accent_table, asize * sizeof(struct kbdiacruc)); | |
1524 | ||
1525 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1526 | ||
1527 | if (put_user(asize, &a->kb_cnt)) | |
1528 | ret = -EFAULT; | |
1529 | else if (copy_to_user(a->kbdiacruc, buf, | |
1530 | asize*sizeof(struct kbdiacruc))) | |
1531 | ret = -EFAULT; | |
1532 | kfree(buf); | |
1533 | return ret; | |
1534 | } | |
1535 | ||
1536 | case KDSKBDIACR: | |
1537 | { | |
1538 | struct kbdiacrs __user *a = up; | |
1539 | struct kbdiacr *diacr = NULL; | |
1540 | unsigned int ct; | |
1541 | int i; | |
1542 | ||
1543 | if (!perm) | |
1544 | return -EPERM; | |
1545 | if (get_user(ct, &a->kb_cnt)) | |
1546 | return -EFAULT; | |
1547 | if (ct >= MAX_DIACR) | |
1548 | return -EINVAL; | |
1549 | ||
1550 | if (ct) { | |
1551 | diacr = kmalloc(sizeof(struct kbdiacr) * ct, | |
1552 | GFP_KERNEL); | |
1553 | if (diacr == NULL) | |
1554 | return -ENOMEM; | |
1555 | ||
1556 | if (copy_from_user(diacr, a->kbdiacr, | |
1557 | sizeof(struct kbdiacr) * ct)) { | |
1558 | kfree(diacr); | |
1559 | return -EFAULT; | |
1560 | } | |
1561 | } | |
1562 | ||
1563 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1564 | accent_table_size = ct; | |
1565 | for (i = 0; i < ct; i++) { | |
1566 | accent_table[i].diacr = | |
1567 | conv_8bit_to_uni(diacr[i].diacr); | |
1568 | accent_table[i].base = | |
1569 | conv_8bit_to_uni(diacr[i].base); | |
1570 | accent_table[i].result = | |
1571 | conv_8bit_to_uni(diacr[i].result); | |
1572 | } | |
1573 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1574 | kfree(diacr); | |
1575 | return 0; | |
1576 | } | |
1577 | ||
1578 | case KDSKBDIACRUC: | |
1579 | { | |
1580 | struct kbdiacrsuc __user *a = up; | |
1581 | unsigned int ct; | |
1582 | void *buf = NULL; | |
1583 | ||
1584 | if (!perm) | |
1585 | return -EPERM; | |
1586 | ||
1587 | if (get_user(ct, &a->kb_cnt)) | |
1588 | return -EFAULT; | |
1589 | ||
1590 | if (ct >= MAX_DIACR) | |
1591 | return -EINVAL; | |
1592 | ||
1593 | if (ct) { | |
1594 | buf = kmalloc(ct * sizeof(struct kbdiacruc), | |
1595 | GFP_KERNEL); | |
1596 | if (buf == NULL) | |
1597 | return -ENOMEM; | |
1598 | ||
1599 | if (copy_from_user(buf, a->kbdiacruc, | |
1600 | ct * sizeof(struct kbdiacruc))) { | |
1601 | kfree(buf); | |
1602 | return -EFAULT; | |
1603 | } | |
1604 | } | |
1605 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1606 | if (ct) | |
1607 | memcpy(accent_table, buf, | |
1608 | ct * sizeof(struct kbdiacruc)); | |
1609 | accent_table_size = ct; | |
1610 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1611 | kfree(buf); | |
1612 | return 0; | |
1613 | } | |
1614 | } | |
1615 | return ret; | |
1616 | } |