Commit | Line | Data |
---|---|---|
e3b3d0f5 | 1 | // SPDX-License-Identifier: GPL-2.0 |
1da177e4 | 2 | /* |
1da177e4 LT |
3 | * Written for linux by Johan Myreen as a translation from |
4 | * the assembly version by Linus (with diacriticals added) | |
5 | * | |
6 | * Some additional features added by Christoph Niemann (ChN), March 1993 | |
7 | * | |
8 | * Loadable keymaps by Risto Kankkunen, May 1993 | |
9 | * | |
10 | * Diacriticals redone & other small changes, aeb@cwi.nl, June 1993 | |
11 | * Added decr/incr_console, dynamic keymaps, Unicode support, | |
12 | * dynamic function/string keys, led setting, Sept 1994 | |
13 | * `Sticky' modifier keys, 951006. | |
14 | * | |
15 | * 11-11-96: SAK should now work in the raw mode (Martin Mares) | |
fe1e8604 | 16 | * |
1da177e4 LT |
17 | * Modified to provide 'generic' keyboard support by Hamish Macdonald |
18 | * Merge with the m68k keyboard driver and split-off of the PC low-level | |
19 | * parts by Geert Uytterhoeven, May 1997 | |
20 | * | |
21 | * 27-05-97: Added support for the Magic SysRq Key (Martin Mares) | |
22 | * 30-07-98: Dead keys redone, aeb@cwi.nl. | |
23 | * 21-08-02: Converted to input API, major cleanup. (Vojtech Pavlik) | |
24 | */ | |
25 | ||
9272e9a2 DT |
26 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
27 | ||
759448f4 | 28 | #include <linux/consolemap.h> |
1da177e4 | 29 | #include <linux/module.h> |
3f07c014 | 30 | #include <linux/sched/signal.h> |
b17b0153 | 31 | #include <linux/sched/debug.h> |
1da177e4 LT |
32 | #include <linux/tty.h> |
33 | #include <linux/tty_flip.h> | |
34 | #include <linux/mm.h> | |
35 | #include <linux/string.h> | |
36 | #include <linux/init.h> | |
37 | #include <linux/slab.h> | |
52355522 | 38 | #include <linux/leds.h> |
1da177e4 LT |
39 | |
40 | #include <linux/kbd_kern.h> | |
41 | #include <linux/kbd_diacr.h> | |
42 | #include <linux/vt_kern.h> | |
1da177e4 | 43 | #include <linux/input.h> |
83cc5ed3 | 44 | #include <linux/reboot.h> |
41ab4396 | 45 | #include <linux/notifier.h> |
b39b0440 | 46 | #include <linux/jiffies.h> |
6623d640 | 47 | #include <linux/uaccess.h> |
1da177e4 | 48 | |
98c2b373 GU |
49 | #include <asm/irq_regs.h> |
50 | ||
1da177e4 LT |
51 | extern void ctrl_alt_del(void); |
52 | ||
53 | /* | |
54 | * Exported functions/variables | |
55 | */ | |
56 | ||
57 | #define KBD_DEFMODE ((1 << VC_REPEAT) | (1 << VC_META)) | |
58 | ||
b2d0b7a0 JC |
59 | #if defined(CONFIG_X86) || defined(CONFIG_PARISC) |
60 | #include <asm/kbdleds.h> | |
1da177e4 | 61 | #else |
b2d0b7a0 JC |
62 | static inline int kbd_defleds(void) |
63 | { | |
64 | return 0; | |
65 | } | |
1da177e4 LT |
66 | #endif |
67 | ||
68 | #define KBD_DEFLOCK 0 | |
69 | ||
1da177e4 LT |
70 | /* |
71 | * Handler Tables. | |
72 | */ | |
73 | ||
74 | #define K_HANDLERS\ | |
75 | k_self, k_fn, k_spec, k_pad,\ | |
76 | k_dead, k_cons, k_cur, k_shift,\ | |
77 | k_meta, k_ascii, k_lock, k_lowercase,\ | |
b9ec4e10 | 78 | k_slock, k_dead2, k_brl, k_ignore |
1da177e4 | 79 | |
fe1e8604 | 80 | typedef void (k_handler_fn)(struct vc_data *vc, unsigned char value, |
7d12e780 | 81 | char up_flag); |
1da177e4 | 82 | static k_handler_fn K_HANDLERS; |
97f5f0cd | 83 | static k_handler_fn *k_handler[16] = { K_HANDLERS }; |
1da177e4 LT |
84 | |
85 | #define FN_HANDLERS\ | |
fe1e8604 DT |
86 | fn_null, fn_enter, fn_show_ptregs, fn_show_mem,\ |
87 | fn_show_state, fn_send_intr, fn_lastcons, fn_caps_toggle,\ | |
88 | fn_num, fn_hold, fn_scroll_forw, fn_scroll_back,\ | |
89 | fn_boot_it, fn_caps_on, fn_compose, fn_SAK,\ | |
90 | fn_dec_console, fn_inc_console, fn_spawn_con, fn_bare_num | |
1da177e4 | 91 | |
7d12e780 | 92 | typedef void (fn_handler_fn)(struct vc_data *vc); |
1da177e4 LT |
93 | static fn_handler_fn FN_HANDLERS; |
94 | static fn_handler_fn *fn_handler[] = { FN_HANDLERS }; | |
95 | ||
96 | /* | |
97 | * Variables exported for vt_ioctl.c | |
98 | */ | |
99 | ||
81af8d67 | 100 | struct vt_spawn_console vt_spawn_con = { |
ccc94256 | 101 | .lock = __SPIN_LOCK_UNLOCKED(vt_spawn_con.lock), |
81af8d67 EB |
102 | .pid = NULL, |
103 | .sig = 0, | |
104 | }; | |
1da177e4 | 105 | |
1da177e4 LT |
106 | |
107 | /* | |
108 | * Internal Data. | |
109 | */ | |
110 | ||
079c9534 AC |
111 | static struct kbd_struct kbd_table[MAX_NR_CONSOLES]; |
112 | static struct kbd_struct *kbd = kbd_table; | |
113 | ||
114 | /* maximum values each key_handler can handle */ | |
115 | static const int max_vals[] = { | |
116 | 255, ARRAY_SIZE(func_table) - 1, ARRAY_SIZE(fn_handler) - 1, NR_PAD - 1, | |
117 | NR_DEAD - 1, 255, 3, NR_SHIFT - 1, 255, NR_ASCII - 1, NR_LOCK - 1, | |
118 | 255, NR_LOCK - 1, 255, NR_BRL - 1 | |
119 | }; | |
120 | ||
121 | static const int NR_TYPES = ARRAY_SIZE(max_vals); | |
122 | ||
1da177e4 | 123 | static struct input_handler kbd_handler; |
21cea58e | 124 | static DEFINE_SPINLOCK(kbd_event_lock); |
3db1ddb7 | 125 | static DEFINE_SPINLOCK(led_lock); |
46ca3f73 | 126 | static DEFINE_SPINLOCK(func_buf_lock); /* guard 'func_buf' and friends */ |
7b19ada2 | 127 | static unsigned long key_down[BITS_TO_LONGS(KEY_CNT)]; /* keyboard key bitmap */ |
1da177e4 | 128 | static unsigned char shift_down[NR_SHIFT]; /* shift state counters.. */ |
e0785572 | 129 | static bool dead_key_next; |
1da177e4 | 130 | static int npadch = -1; /* -1 or number assembled on pad */ |
b9ec4e10 | 131 | static unsigned int diacr; |
1da177e4 LT |
132 | static char rep; /* flag telling character repeat */ |
133 | ||
079c9534 AC |
134 | static int shift_state = 0; |
135 | ||
eeb64c14 | 136 | static unsigned int ledstate = -1U; /* undefined */ |
1da177e4 LT |
137 | static unsigned char ledioctl; |
138 | ||
41ab4396 ST |
139 | /* |
140 | * Notifier list for console keyboard events | |
141 | */ | |
142 | static ATOMIC_NOTIFIER_HEAD(keyboard_notifier_list); | |
143 | ||
144 | int register_keyboard_notifier(struct notifier_block *nb) | |
145 | { | |
146 | return atomic_notifier_chain_register(&keyboard_notifier_list, nb); | |
147 | } | |
148 | EXPORT_SYMBOL_GPL(register_keyboard_notifier); | |
149 | ||
150 | int unregister_keyboard_notifier(struct notifier_block *nb) | |
151 | { | |
152 | return atomic_notifier_chain_unregister(&keyboard_notifier_list, nb); | |
153 | } | |
154 | EXPORT_SYMBOL_GPL(unregister_keyboard_notifier); | |
155 | ||
1da177e4 | 156 | /* |
c8e4c772 MR |
157 | * Translation of scancodes to keycodes. We set them on only the first |
158 | * keyboard in the list that accepts the scancode and keycode. | |
159 | * Explanation for not choosing the first attached keyboard anymore: | |
160 | * USB keyboards for example have two event devices: one for all "normal" | |
161 | * keys and one for extra function keys (like "volume up", "make coffee", | |
162 | * etc.). So this means that scancodes for the extra function keys won't | |
163 | * be valid for the first event device, but will be for the second. | |
1da177e4 | 164 | */ |
66d2a595 DT |
165 | |
166 | struct getset_keycode_data { | |
8613e4c2 | 167 | struct input_keymap_entry ke; |
66d2a595 DT |
168 | int error; |
169 | }; | |
170 | ||
171 | static int getkeycode_helper(struct input_handle *handle, void *data) | |
172 | { | |
173 | struct getset_keycode_data *d = data; | |
174 | ||
8613e4c2 | 175 | d->error = input_get_keycode(handle->dev, &d->ke); |
66d2a595 DT |
176 | |
177 | return d->error == 0; /* stop as soon as we successfully get one */ | |
178 | } | |
179 | ||
079c9534 | 180 | static int getkeycode(unsigned int scancode) |
1da177e4 | 181 | { |
8613e4c2 MCC |
182 | struct getset_keycode_data d = { |
183 | .ke = { | |
184 | .flags = 0, | |
185 | .len = sizeof(scancode), | |
186 | .keycode = 0, | |
187 | }, | |
188 | .error = -ENODEV, | |
189 | }; | |
190 | ||
191 | memcpy(d.ke.scancode, &scancode, sizeof(scancode)); | |
c8e4c772 | 192 | |
66d2a595 | 193 | input_handler_for_each_handle(&kbd_handler, &d, getkeycode_helper); |
1da177e4 | 194 | |
8613e4c2 | 195 | return d.error ?: d.ke.keycode; |
66d2a595 DT |
196 | } |
197 | ||
198 | static int setkeycode_helper(struct input_handle *handle, void *data) | |
199 | { | |
200 | struct getset_keycode_data *d = data; | |
201 | ||
8613e4c2 | 202 | d->error = input_set_keycode(handle->dev, &d->ke); |
66d2a595 DT |
203 | |
204 | return d->error == 0; /* stop as soon as we successfully set one */ | |
1da177e4 LT |
205 | } |
206 | ||
079c9534 | 207 | static int setkeycode(unsigned int scancode, unsigned int keycode) |
1da177e4 | 208 | { |
8613e4c2 MCC |
209 | struct getset_keycode_data d = { |
210 | .ke = { | |
211 | .flags = 0, | |
212 | .len = sizeof(scancode), | |
213 | .keycode = keycode, | |
214 | }, | |
215 | .error = -ENODEV, | |
216 | }; | |
217 | ||
218 | memcpy(d.ke.scancode, &scancode, sizeof(scancode)); | |
c8e4c772 | 219 | |
66d2a595 | 220 | input_handler_for_each_handle(&kbd_handler, &d, setkeycode_helper); |
1da177e4 | 221 | |
66d2a595 | 222 | return d.error; |
1da177e4 LT |
223 | } |
224 | ||
225 | /* | |
18f7ad59 DT |
226 | * Making beeps and bells. Note that we prefer beeps to bells, but when |
227 | * shutting the sound off we do both. | |
1da177e4 | 228 | */ |
66d2a595 DT |
229 | |
230 | static int kd_sound_helper(struct input_handle *handle, void *data) | |
1da177e4 | 231 | { |
66d2a595 DT |
232 | unsigned int *hz = data; |
233 | struct input_dev *dev = handle->dev; | |
1da177e4 | 234 | |
66d2a595 | 235 | if (test_bit(EV_SND, dev->evbit)) { |
18f7ad59 | 236 | if (test_bit(SND_TONE, dev->sndbit)) { |
66d2a595 | 237 | input_inject_event(handle, EV_SND, SND_TONE, *hz); |
18f7ad59 DT |
238 | if (*hz) |
239 | return 0; | |
240 | } | |
241 | if (test_bit(SND_BELL, dev->sndbit)) | |
66d2a595 | 242 | input_inject_event(handle, EV_SND, SND_BELL, *hz ? 1 : 0); |
1da177e4 | 243 | } |
66d2a595 DT |
244 | |
245 | return 0; | |
246 | } | |
247 | ||
24ed960a | 248 | static void kd_nosound(struct timer_list *unused) |
66d2a595 DT |
249 | { |
250 | static unsigned int zero; | |
251 | ||
252 | input_handler_for_each_handle(&kbd_handler, &zero, kd_sound_helper); | |
1da177e4 LT |
253 | } |
254 | ||
1d27e3e2 | 255 | static DEFINE_TIMER(kd_mksound_timer, kd_nosound); |
1da177e4 LT |
256 | |
257 | void kd_mksound(unsigned int hz, unsigned int ticks) | |
258 | { | |
66d2a595 | 259 | del_timer_sync(&kd_mksound_timer); |
1da177e4 | 260 | |
66d2a595 | 261 | input_handler_for_each_handle(&kbd_handler, &hz, kd_sound_helper); |
1da177e4 | 262 | |
66d2a595 DT |
263 | if (hz && ticks) |
264 | mod_timer(&kd_mksound_timer, jiffies + ticks); | |
1da177e4 | 265 | } |
f7511d5f | 266 | EXPORT_SYMBOL(kd_mksound); |
1da177e4 LT |
267 | |
268 | /* | |
269 | * Setting the keyboard rate. | |
270 | */ | |
271 | ||
66d2a595 | 272 | static int kbd_rate_helper(struct input_handle *handle, void *data) |
1da177e4 | 273 | { |
66d2a595 | 274 | struct input_dev *dev = handle->dev; |
9d329c1c | 275 | struct kbd_repeat *rpt = data; |
66d2a595 DT |
276 | |
277 | if (test_bit(EV_REP, dev->evbit)) { | |
278 | ||
9d329c1c | 279 | if (rpt[0].delay > 0) |
66d2a595 | 280 | input_inject_event(handle, |
9d329c1c MR |
281 | EV_REP, REP_DELAY, rpt[0].delay); |
282 | if (rpt[0].period > 0) | |
66d2a595 | 283 | input_inject_event(handle, |
9d329c1c | 284 | EV_REP, REP_PERIOD, rpt[0].period); |
66d2a595 | 285 | |
9d329c1c MR |
286 | rpt[1].delay = dev->rep[REP_DELAY]; |
287 | rpt[1].period = dev->rep[REP_PERIOD]; | |
1da177e4 | 288 | } |
66d2a595 DT |
289 | |
290 | return 0; | |
291 | } | |
292 | ||
9d329c1c | 293 | int kbd_rate(struct kbd_repeat *rpt) |
66d2a595 | 294 | { |
9d329c1c | 295 | struct kbd_repeat data[2] = { *rpt }; |
66d2a595 DT |
296 | |
297 | input_handler_for_each_handle(&kbd_handler, data, kbd_rate_helper); | |
9d329c1c | 298 | *rpt = data[1]; /* Copy currently used settings */ |
66d2a595 | 299 | |
1da177e4 LT |
300 | return 0; |
301 | } | |
302 | ||
303 | /* | |
304 | * Helper Functions. | |
305 | */ | |
306 | static void put_queue(struct vc_data *vc, int ch) | |
307 | { | |
92a19f9c | 308 | tty_insert_flip_char(&vc->port, ch, 0); |
6732c8bb | 309 | tty_schedule_flip(&vc->port); |
1da177e4 LT |
310 | } |
311 | ||
312 | static void puts_queue(struct vc_data *vc, char *cp) | |
313 | { | |
1da177e4 | 314 | while (*cp) { |
92a19f9c | 315 | tty_insert_flip_char(&vc->port, *cp, 0); |
1da177e4 LT |
316 | cp++; |
317 | } | |
6732c8bb | 318 | tty_schedule_flip(&vc->port); |
1da177e4 LT |
319 | } |
320 | ||
321 | static void applkey(struct vc_data *vc, int key, char mode) | |
322 | { | |
323 | static char buf[] = { 0x1b, 'O', 0x00, 0x00 }; | |
324 | ||
325 | buf[1] = (mode ? 'O' : '['); | |
326 | buf[2] = key; | |
327 | puts_queue(vc, buf); | |
328 | } | |
329 | ||
330 | /* | |
331 | * Many other routines do put_queue, but I think either | |
332 | * they produce ASCII, or they produce some user-assigned | |
333 | * string, and in both cases we might assume that it is | |
759448f4 | 334 | * in utf-8 already. |
1da177e4 | 335 | */ |
759448f4 | 336 | static void to_utf8(struct vc_data *vc, uint c) |
1da177e4 LT |
337 | { |
338 | if (c < 0x80) | |
339 | /* 0******* */ | |
340 | put_queue(vc, c); | |
fe1e8604 | 341 | else if (c < 0x800) { |
1da177e4 | 342 | /* 110***** 10****** */ |
fe1e8604 | 343 | put_queue(vc, 0xc0 | (c >> 6)); |
1da177e4 | 344 | put_queue(vc, 0x80 | (c & 0x3f)); |
e0785572 DT |
345 | } else if (c < 0x10000) { |
346 | if (c >= 0xD800 && c < 0xE000) | |
759448f4 JE |
347 | return; |
348 | if (c == 0xFFFF) | |
349 | return; | |
1da177e4 LT |
350 | /* 1110**** 10****** 10****** */ |
351 | put_queue(vc, 0xe0 | (c >> 12)); | |
352 | put_queue(vc, 0x80 | ((c >> 6) & 0x3f)); | |
353 | put_queue(vc, 0x80 | (c & 0x3f)); | |
e0785572 | 354 | } else if (c < 0x110000) { |
759448f4 JE |
355 | /* 11110*** 10****** 10****** 10****** */ |
356 | put_queue(vc, 0xf0 | (c >> 18)); | |
357 | put_queue(vc, 0x80 | ((c >> 12) & 0x3f)); | |
358 | put_queue(vc, 0x80 | ((c >> 6) & 0x3f)); | |
359 | put_queue(vc, 0x80 | (c & 0x3f)); | |
fe1e8604 | 360 | } |
1da177e4 LT |
361 | } |
362 | ||
fe1e8604 | 363 | /* |
1da177e4 LT |
364 | * Called after returning from RAW mode or when changing consoles - recompute |
365 | * shift_down[] and shift_state from key_down[] maybe called when keymap is | |
079c9534 AC |
366 | * undefined, so that shiftkey release is seen. The caller must hold the |
367 | * kbd_event_lock. | |
1da177e4 | 368 | */ |
079c9534 AC |
369 | |
370 | static void do_compute_shiftstate(void) | |
1da177e4 | 371 | { |
510cccb5 | 372 | unsigned int k, sym, val; |
1da177e4 LT |
373 | |
374 | shift_state = 0; | |
375 | memset(shift_down, 0, sizeof(shift_down)); | |
fe1e8604 | 376 | |
510cccb5 DT |
377 | for_each_set_bit(k, key_down, min(NR_KEYS, KEY_CNT)) { |
378 | sym = U(key_maps[0][k]); | |
379 | if (KTYP(sym) != KT_SHIFT && KTYP(sym) != KT_SLOCK) | |
1da177e4 LT |
380 | continue; |
381 | ||
510cccb5 DT |
382 | val = KVAL(sym); |
383 | if (val == KVAL(K_CAPSSHIFT)) | |
384 | val = KVAL(K_SHIFT); | |
1da177e4 | 385 | |
510cccb5 DT |
386 | shift_down[val]++; |
387 | shift_state |= BIT(val); | |
1da177e4 LT |
388 | } |
389 | } | |
390 | ||
079c9534 AC |
391 | /* We still have to export this method to vt.c */ |
392 | void compute_shiftstate(void) | |
393 | { | |
394 | unsigned long flags; | |
395 | spin_lock_irqsave(&kbd_event_lock, flags); | |
396 | do_compute_shiftstate(); | |
397 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
398 | } | |
399 | ||
1da177e4 LT |
400 | /* |
401 | * We have a combining character DIACR here, followed by the character CH. | |
402 | * If the combination occurs in the table, return the corresponding value. | |
403 | * Otherwise, if CH is a space or equals DIACR, return DIACR. | |
404 | * Otherwise, conclude that DIACR was not combining after all, | |
405 | * queue it and return CH. | |
406 | */ | |
b9ec4e10 | 407 | static unsigned int handle_diacr(struct vc_data *vc, unsigned int ch) |
1da177e4 | 408 | { |
b9ec4e10 | 409 | unsigned int d = diacr; |
1da177e4 LT |
410 | unsigned int i; |
411 | ||
412 | diacr = 0; | |
413 | ||
b9ec4e10 ST |
414 | if ((d & ~0xff) == BRL_UC_ROW) { |
415 | if ((ch & ~0xff) == BRL_UC_ROW) | |
416 | return d | ch; | |
417 | } else { | |
418 | for (i = 0; i < accent_table_size; i++) | |
419 | if (accent_table[i].diacr == d && accent_table[i].base == ch) | |
420 | return accent_table[i].result; | |
1da177e4 LT |
421 | } |
422 | ||
b9ec4e10 | 423 | if (ch == ' ' || ch == (BRL_UC_ROW|0) || ch == d) |
1da177e4 LT |
424 | return d; |
425 | ||
b9ec4e10 | 426 | if (kbd->kbdmode == VC_UNICODE) |
04c71976 ST |
427 | to_utf8(vc, d); |
428 | else { | |
429 | int c = conv_uni_to_8bit(d); | |
430 | if (c != -1) | |
431 | put_queue(vc, c); | |
432 | } | |
b9ec4e10 | 433 | |
1da177e4 LT |
434 | return ch; |
435 | } | |
436 | ||
437 | /* | |
438 | * Special function handlers | |
439 | */ | |
7d12e780 | 440 | static void fn_enter(struct vc_data *vc) |
1da177e4 LT |
441 | { |
442 | if (diacr) { | |
b9ec4e10 | 443 | if (kbd->kbdmode == VC_UNICODE) |
04c71976 ST |
444 | to_utf8(vc, diacr); |
445 | else { | |
446 | int c = conv_uni_to_8bit(diacr); | |
447 | if (c != -1) | |
448 | put_queue(vc, c); | |
449 | } | |
1da177e4 LT |
450 | diacr = 0; |
451 | } | |
e0785572 | 452 | |
1da177e4 LT |
453 | put_queue(vc, 13); |
454 | if (vc_kbd_mode(kbd, VC_CRLF)) | |
455 | put_queue(vc, 10); | |
456 | } | |
457 | ||
7d12e780 | 458 | static void fn_caps_toggle(struct vc_data *vc) |
1da177e4 LT |
459 | { |
460 | if (rep) | |
461 | return; | |
e0785572 | 462 | |
1da177e4 LT |
463 | chg_vc_kbd_led(kbd, VC_CAPSLOCK); |
464 | } | |
465 | ||
7d12e780 | 466 | static void fn_caps_on(struct vc_data *vc) |
1da177e4 LT |
467 | { |
468 | if (rep) | |
469 | return; | |
e0785572 | 470 | |
1da177e4 LT |
471 | set_vc_kbd_led(kbd, VC_CAPSLOCK); |
472 | } | |
473 | ||
7d12e780 | 474 | static void fn_show_ptregs(struct vc_data *vc) |
1da177e4 | 475 | { |
7d12e780 | 476 | struct pt_regs *regs = get_irq_regs(); |
e0785572 | 477 | |
1da177e4 LT |
478 | if (regs) |
479 | show_regs(regs); | |
480 | } | |
481 | ||
7d12e780 | 482 | static void fn_hold(struct vc_data *vc) |
1da177e4 | 483 | { |
8ce73264 | 484 | struct tty_struct *tty = vc->port.tty; |
1da177e4 LT |
485 | |
486 | if (rep || !tty) | |
487 | return; | |
488 | ||
489 | /* | |
490 | * Note: SCROLLOCK will be set (cleared) by stop_tty (start_tty); | |
491 | * these routines are also activated by ^S/^Q. | |
492 | * (And SCROLLOCK can also be set by the ioctl KDSKBLED.) | |
493 | */ | |
494 | if (tty->stopped) | |
495 | start_tty(tty); | |
496 | else | |
497 | stop_tty(tty); | |
498 | } | |
499 | ||
7d12e780 | 500 | static void fn_num(struct vc_data *vc) |
1da177e4 | 501 | { |
e0785572 | 502 | if (vc_kbd_mode(kbd, VC_APPLIC)) |
1da177e4 LT |
503 | applkey(vc, 'P', 1); |
504 | else | |
7d12e780 | 505 | fn_bare_num(vc); |
1da177e4 LT |
506 | } |
507 | ||
508 | /* | |
509 | * Bind this to Shift-NumLock if you work in application keypad mode | |
510 | * but want to be able to change the NumLock flag. | |
511 | * Bind this to NumLock if you prefer that the NumLock key always | |
512 | * changes the NumLock flag. | |
513 | */ | |
7d12e780 | 514 | static void fn_bare_num(struct vc_data *vc) |
1da177e4 LT |
515 | { |
516 | if (!rep) | |
517 | chg_vc_kbd_led(kbd, VC_NUMLOCK); | |
518 | } | |
519 | ||
7d12e780 | 520 | static void fn_lastcons(struct vc_data *vc) |
1da177e4 LT |
521 | { |
522 | /* switch to the last used console, ChN */ | |
523 | set_console(last_console); | |
524 | } | |
525 | ||
7d12e780 | 526 | static void fn_dec_console(struct vc_data *vc) |
1da177e4 LT |
527 | { |
528 | int i, cur = fg_console; | |
529 | ||
530 | /* Currently switching? Queue this next switch relative to that. */ | |
531 | if (want_console != -1) | |
532 | cur = want_console; | |
533 | ||
fe1e8604 | 534 | for (i = cur - 1; i != cur; i--) { |
1da177e4 | 535 | if (i == -1) |
fe1e8604 | 536 | i = MAX_NR_CONSOLES - 1; |
1da177e4 LT |
537 | if (vc_cons_allocated(i)) |
538 | break; | |
539 | } | |
540 | set_console(i); | |
541 | } | |
542 | ||
7d12e780 | 543 | static void fn_inc_console(struct vc_data *vc) |
1da177e4 LT |
544 | { |
545 | int i, cur = fg_console; | |
546 | ||
547 | /* Currently switching? Queue this next switch relative to that. */ | |
548 | if (want_console != -1) | |
549 | cur = want_console; | |
550 | ||
551 | for (i = cur+1; i != cur; i++) { | |
552 | if (i == MAX_NR_CONSOLES) | |
553 | i = 0; | |
554 | if (vc_cons_allocated(i)) | |
555 | break; | |
556 | } | |
557 | set_console(i); | |
558 | } | |
559 | ||
7d12e780 | 560 | static void fn_send_intr(struct vc_data *vc) |
1da177e4 | 561 | { |
92a19f9c | 562 | tty_insert_flip_char(&vc->port, 0, TTY_BREAK); |
6732c8bb | 563 | tty_schedule_flip(&vc->port); |
1da177e4 LT |
564 | } |
565 | ||
7d12e780 | 566 | static void fn_scroll_forw(struct vc_data *vc) |
1da177e4 LT |
567 | { |
568 | scrollfront(vc, 0); | |
569 | } | |
570 | ||
7d12e780 | 571 | static void fn_scroll_back(struct vc_data *vc) |
1da177e4 | 572 | { |
1b0ec88a | 573 | scrollback(vc); |
1da177e4 LT |
574 | } |
575 | ||
7d12e780 | 576 | static void fn_show_mem(struct vc_data *vc) |
1da177e4 | 577 | { |
9af744d7 | 578 | show_mem(0, NULL); |
1da177e4 LT |
579 | } |
580 | ||
7d12e780 | 581 | static void fn_show_state(struct vc_data *vc) |
1da177e4 LT |
582 | { |
583 | show_state(); | |
584 | } | |
585 | ||
7d12e780 | 586 | static void fn_boot_it(struct vc_data *vc) |
1da177e4 LT |
587 | { |
588 | ctrl_alt_del(); | |
589 | } | |
590 | ||
7d12e780 | 591 | static void fn_compose(struct vc_data *vc) |
1da177e4 | 592 | { |
e0785572 | 593 | dead_key_next = true; |
1da177e4 LT |
594 | } |
595 | ||
7d12e780 | 596 | static void fn_spawn_con(struct vc_data *vc) |
1da177e4 | 597 | { |
81af8d67 EB |
598 | spin_lock(&vt_spawn_con.lock); |
599 | if (vt_spawn_con.pid) | |
600 | if (kill_pid(vt_spawn_con.pid, vt_spawn_con.sig, 1)) { | |
601 | put_pid(vt_spawn_con.pid); | |
602 | vt_spawn_con.pid = NULL; | |
603 | } | |
604 | spin_unlock(&vt_spawn_con.lock); | |
1da177e4 LT |
605 | } |
606 | ||
7d12e780 | 607 | static void fn_SAK(struct vc_data *vc) |
1da177e4 | 608 | { |
8b6312f4 | 609 | struct work_struct *SAK_work = &vc_cons[fg_console].SAK_work; |
8b6312f4 | 610 | schedule_work(SAK_work); |
1da177e4 LT |
611 | } |
612 | ||
7d12e780 | 613 | static void fn_null(struct vc_data *vc) |
1da177e4 | 614 | { |
079c9534 | 615 | do_compute_shiftstate(); |
1da177e4 LT |
616 | } |
617 | ||
618 | /* | |
619 | * Special key handlers | |
620 | */ | |
7d12e780 | 621 | static void k_ignore(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
622 | { |
623 | } | |
624 | ||
7d12e780 | 625 | static void k_spec(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
626 | { |
627 | if (up_flag) | |
628 | return; | |
629 | if (value >= ARRAY_SIZE(fn_handler)) | |
630 | return; | |
fe1e8604 | 631 | if ((kbd->kbdmode == VC_RAW || |
9fc3de9c AT |
632 | kbd->kbdmode == VC_MEDIUMRAW || |
633 | kbd->kbdmode == VC_OFF) && | |
1da177e4 LT |
634 | value != KVAL(K_SAK)) |
635 | return; /* SAK is allowed even in raw mode */ | |
7d12e780 | 636 | fn_handler[value](vc); |
1da177e4 LT |
637 | } |
638 | ||
7d12e780 | 639 | static void k_lowercase(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 | 640 | { |
9272e9a2 | 641 | pr_err("k_lowercase was called - impossible\n"); |
1da177e4 LT |
642 | } |
643 | ||
7d12e780 | 644 | static void k_unicode(struct vc_data *vc, unsigned int value, char up_flag) |
1da177e4 LT |
645 | { |
646 | if (up_flag) | |
647 | return; /* no action, if this is a key release */ | |
648 | ||
649 | if (diacr) | |
650 | value = handle_diacr(vc, value); | |
651 | ||
652 | if (dead_key_next) { | |
e0785572 | 653 | dead_key_next = false; |
1da177e4 LT |
654 | diacr = value; |
655 | return; | |
656 | } | |
b9ec4e10 | 657 | if (kbd->kbdmode == VC_UNICODE) |
04c71976 ST |
658 | to_utf8(vc, value); |
659 | else { | |
660 | int c = conv_uni_to_8bit(value); | |
661 | if (c != -1) | |
662 | put_queue(vc, c); | |
663 | } | |
1da177e4 LT |
664 | } |
665 | ||
666 | /* | |
667 | * Handle dead key. Note that we now may have several | |
668 | * dead keys modifying the same character. Very useful | |
669 | * for Vietnamese. | |
670 | */ | |
7d12e780 | 671 | static void k_deadunicode(struct vc_data *vc, unsigned int value, char up_flag) |
1da177e4 LT |
672 | { |
673 | if (up_flag) | |
674 | return; | |
e0785572 | 675 | |
1da177e4 LT |
676 | diacr = (diacr ? handle_diacr(vc, value) : value); |
677 | } | |
678 | ||
7d12e780 | 679 | static void k_self(struct vc_data *vc, unsigned char value, char up_flag) |
b9ec4e10 | 680 | { |
d2187ebd | 681 | k_unicode(vc, conv_8bit_to_uni(value), up_flag); |
b9ec4e10 ST |
682 | } |
683 | ||
7d12e780 | 684 | static void k_dead2(struct vc_data *vc, unsigned char value, char up_flag) |
b9ec4e10 | 685 | { |
7d12e780 | 686 | k_deadunicode(vc, value, up_flag); |
b9ec4e10 ST |
687 | } |
688 | ||
1da177e4 LT |
689 | /* |
690 | * Obsolete - for backwards compatibility only | |
691 | */ | |
7d12e780 | 692 | static void k_dead(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 | 693 | { |
16777ecd ST |
694 | static const unsigned char ret_diacr[NR_DEAD] = { |
695 | '`', /* dead_grave */ | |
696 | '\'', /* dead_acute */ | |
697 | '^', /* dead_circumflex */ | |
698 | '~', /* dead_tilda */ | |
699 | '"', /* dead_diaeresis */ | |
700 | ',', /* dead_cedilla */ | |
701 | '_', /* dead_macron */ | |
702 | 'U', /* dead_breve */ | |
703 | '.', /* dead_abovedot */ | |
704 | '*', /* dead_abovering */ | |
705 | '=', /* dead_doubleacute */ | |
706 | 'c', /* dead_caron */ | |
707 | 'k', /* dead_ogonek */ | |
708 | 'i', /* dead_iota */ | |
709 | '#', /* dead_voiced_sound */ | |
710 | 'o', /* dead_semivoiced_sound */ | |
711 | '!', /* dead_belowdot */ | |
712 | '?', /* dead_hook */ | |
713 | '+', /* dead_horn */ | |
714 | '-', /* dead_stroke */ | |
715 | ')', /* dead_abovecomma */ | |
716 | '(', /* dead_abovereversedcomma */ | |
717 | ':', /* dead_doublegrave */ | |
718 | 'n', /* dead_invertedbreve */ | |
719 | ';', /* dead_belowcomma */ | |
720 | '$', /* dead_currency */ | |
721 | '@', /* dead_greek */ | |
722 | }; | |
e0785572 DT |
723 | |
724 | k_deadunicode(vc, ret_diacr[value], up_flag); | |
1da177e4 LT |
725 | } |
726 | ||
7d12e780 | 727 | static void k_cons(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
728 | { |
729 | if (up_flag) | |
730 | return; | |
e0785572 | 731 | |
1da177e4 LT |
732 | set_console(value); |
733 | } | |
734 | ||
7d12e780 | 735 | static void k_fn(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 | 736 | { |
1da177e4 LT |
737 | if (up_flag) |
738 | return; | |
e0785572 DT |
739 | |
740 | if ((unsigned)value < ARRAY_SIZE(func_table)) { | |
1da177e4 LT |
741 | if (func_table[value]) |
742 | puts_queue(vc, func_table[value]); | |
743 | } else | |
9272e9a2 | 744 | pr_err("k_fn called with value=%d\n", value); |
1da177e4 LT |
745 | } |
746 | ||
7d12e780 | 747 | static void k_cur(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 | 748 | { |
e52b29c2 | 749 | static const char cur_chars[] = "BDCA"; |
1da177e4 LT |
750 | |
751 | if (up_flag) | |
752 | return; | |
e0785572 | 753 | |
1da177e4 LT |
754 | applkey(vc, cur_chars[value], vc_kbd_mode(kbd, VC_CKMODE)); |
755 | } | |
756 | ||
7d12e780 | 757 | static void k_pad(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 | 758 | { |
0f5e560e AM |
759 | static const char pad_chars[] = "0123456789+-*/\015,.?()#"; |
760 | static const char app_map[] = "pqrstuvwxylSRQMnnmPQS"; | |
1da177e4 LT |
761 | |
762 | if (up_flag) | |
763 | return; /* no action, if this is a key release */ | |
764 | ||
765 | /* kludge... shift forces cursor/number keys */ | |
766 | if (vc_kbd_mode(kbd, VC_APPLIC) && !shift_down[KG_SHIFT]) { | |
767 | applkey(vc, app_map[value], 1); | |
768 | return; | |
769 | } | |
770 | ||
e0785572 DT |
771 | if (!vc_kbd_led(kbd, VC_NUMLOCK)) { |
772 | ||
1da177e4 | 773 | switch (value) { |
e0785572 DT |
774 | case KVAL(K_PCOMMA): |
775 | case KVAL(K_PDOT): | |
776 | k_fn(vc, KVAL(K_REMOVE), 0); | |
777 | return; | |
778 | case KVAL(K_P0): | |
779 | k_fn(vc, KVAL(K_INSERT), 0); | |
780 | return; | |
781 | case KVAL(K_P1): | |
782 | k_fn(vc, KVAL(K_SELECT), 0); | |
783 | return; | |
784 | case KVAL(K_P2): | |
785 | k_cur(vc, KVAL(K_DOWN), 0); | |
786 | return; | |
787 | case KVAL(K_P3): | |
788 | k_fn(vc, KVAL(K_PGDN), 0); | |
789 | return; | |
790 | case KVAL(K_P4): | |
791 | k_cur(vc, KVAL(K_LEFT), 0); | |
792 | return; | |
793 | case KVAL(K_P6): | |
794 | k_cur(vc, KVAL(K_RIGHT), 0); | |
795 | return; | |
796 | case KVAL(K_P7): | |
797 | k_fn(vc, KVAL(K_FIND), 0); | |
798 | return; | |
799 | case KVAL(K_P8): | |
800 | k_cur(vc, KVAL(K_UP), 0); | |
801 | return; | |
802 | case KVAL(K_P9): | |
803 | k_fn(vc, KVAL(K_PGUP), 0); | |
804 | return; | |
805 | case KVAL(K_P5): | |
806 | applkey(vc, 'G', vc_kbd_mode(kbd, VC_APPLIC)); | |
807 | return; | |
1da177e4 | 808 | } |
e0785572 | 809 | } |
1da177e4 LT |
810 | |
811 | put_queue(vc, pad_chars[value]); | |
812 | if (value == KVAL(K_PENTER) && vc_kbd_mode(kbd, VC_CRLF)) | |
813 | put_queue(vc, 10); | |
814 | } | |
815 | ||
7d12e780 | 816 | static void k_shift(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
817 | { |
818 | int old_state = shift_state; | |
819 | ||
820 | if (rep) | |
821 | return; | |
822 | /* | |
823 | * Mimic typewriter: | |
824 | * a CapsShift key acts like Shift but undoes CapsLock | |
825 | */ | |
826 | if (value == KVAL(K_CAPSSHIFT)) { | |
827 | value = KVAL(K_SHIFT); | |
828 | if (!up_flag) | |
829 | clr_vc_kbd_led(kbd, VC_CAPSLOCK); | |
830 | } | |
831 | ||
832 | if (up_flag) { | |
833 | /* | |
834 | * handle the case that two shift or control | |
835 | * keys are depressed simultaneously | |
836 | */ | |
837 | if (shift_down[value]) | |
838 | shift_down[value]--; | |
839 | } else | |
840 | shift_down[value]++; | |
841 | ||
842 | if (shift_down[value]) | |
843 | shift_state |= (1 << value); | |
844 | else | |
845 | shift_state &= ~(1 << value); | |
846 | ||
847 | /* kludge */ | |
848 | if (up_flag && shift_state != old_state && npadch != -1) { | |
849 | if (kbd->kbdmode == VC_UNICODE) | |
759448f4 | 850 | to_utf8(vc, npadch); |
1da177e4 LT |
851 | else |
852 | put_queue(vc, npadch & 0xff); | |
853 | npadch = -1; | |
854 | } | |
855 | } | |
856 | ||
7d12e780 | 857 | static void k_meta(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
858 | { |
859 | if (up_flag) | |
860 | return; | |
861 | ||
862 | if (vc_kbd_mode(kbd, VC_META)) { | |
863 | put_queue(vc, '\033'); | |
864 | put_queue(vc, value); | |
865 | } else | |
866 | put_queue(vc, value | 0x80); | |
867 | } | |
868 | ||
7d12e780 | 869 | static void k_ascii(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
870 | { |
871 | int base; | |
872 | ||
873 | if (up_flag) | |
874 | return; | |
875 | ||
876 | if (value < 10) { | |
877 | /* decimal input of code, while Alt depressed */ | |
878 | base = 10; | |
879 | } else { | |
880 | /* hexadecimal input of code, while AltGr depressed */ | |
881 | value -= 10; | |
882 | base = 16; | |
883 | } | |
884 | ||
885 | if (npadch == -1) | |
886 | npadch = value; | |
887 | else | |
888 | npadch = npadch * base + value; | |
889 | } | |
890 | ||
7d12e780 | 891 | static void k_lock(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 LT |
892 | { |
893 | if (up_flag || rep) | |
894 | return; | |
e0785572 | 895 | |
1da177e4 LT |
896 | chg_vc_kbd_lock(kbd, value); |
897 | } | |
898 | ||
7d12e780 | 899 | static void k_slock(struct vc_data *vc, unsigned char value, char up_flag) |
1da177e4 | 900 | { |
7d12e780 | 901 | k_shift(vc, value, up_flag); |
1da177e4 LT |
902 | if (up_flag || rep) |
903 | return; | |
e0785572 | 904 | |
1da177e4 LT |
905 | chg_vc_kbd_slock(kbd, value); |
906 | /* try to make Alt, oops, AltGr and such work */ | |
907 | if (!key_maps[kbd->lockstate ^ kbd->slockstate]) { | |
908 | kbd->slockstate = 0; | |
909 | chg_vc_kbd_slock(kbd, value); | |
910 | } | |
911 | } | |
912 | ||
b9ec4e10 | 913 | /* by default, 300ms interval for combination release */ |
77426d72 ST |
914 | static unsigned brl_timeout = 300; |
915 | MODULE_PARM_DESC(brl_timeout, "Braille keys release delay in ms (0 for commit on first key release)"); | |
916 | module_param(brl_timeout, uint, 0644); | |
917 | ||
918 | static unsigned brl_nbchords = 1; | |
919 | MODULE_PARM_DESC(brl_nbchords, "Number of chords that produce a braille pattern (0 for dead chords)"); | |
920 | module_param(brl_nbchords, uint, 0644); | |
921 | ||
7d12e780 | 922 | static void k_brlcommit(struct vc_data *vc, unsigned int pattern, char up_flag) |
77426d72 ST |
923 | { |
924 | static unsigned long chords; | |
925 | static unsigned committed; | |
926 | ||
927 | if (!brl_nbchords) | |
7d12e780 | 928 | k_deadunicode(vc, BRL_UC_ROW | pattern, up_flag); |
77426d72 ST |
929 | else { |
930 | committed |= pattern; | |
931 | chords++; | |
932 | if (chords == brl_nbchords) { | |
7d12e780 | 933 | k_unicode(vc, BRL_UC_ROW | committed, up_flag); |
77426d72 ST |
934 | chords = 0; |
935 | committed = 0; | |
936 | } | |
937 | } | |
938 | } | |
939 | ||
7d12e780 | 940 | static void k_brl(struct vc_data *vc, unsigned char value, char up_flag) |
b9ec4e10 | 941 | { |
e0785572 | 942 | static unsigned pressed, committing; |
b9ec4e10 ST |
943 | static unsigned long releasestart; |
944 | ||
945 | if (kbd->kbdmode != VC_UNICODE) { | |
946 | if (!up_flag) | |
e620e548 | 947 | pr_warn("keyboard mode must be unicode for braille patterns\n"); |
b9ec4e10 ST |
948 | return; |
949 | } | |
950 | ||
951 | if (!value) { | |
7d12e780 | 952 | k_unicode(vc, BRL_UC_ROW, up_flag); |
b9ec4e10 ST |
953 | return; |
954 | } | |
955 | ||
956 | if (value > 8) | |
957 | return; | |
958 | ||
e0785572 | 959 | if (!up_flag) { |
b9ec4e10 ST |
960 | pressed |= 1 << (value - 1); |
961 | if (!brl_timeout) | |
962 | committing = pressed; | |
e0785572 DT |
963 | } else if (brl_timeout) { |
964 | if (!committing || | |
965 | time_after(jiffies, | |
966 | releasestart + msecs_to_jiffies(brl_timeout))) { | |
967 | committing = pressed; | |
968 | releasestart = jiffies; | |
969 | } | |
970 | pressed &= ~(1 << (value - 1)); | |
971 | if (!pressed && committing) { | |
972 | k_brlcommit(vc, committing, 0); | |
973 | committing = 0; | |
974 | } | |
975 | } else { | |
976 | if (committing) { | |
977 | k_brlcommit(vc, committing, 0); | |
978 | committing = 0; | |
979 | } | |
980 | pressed &= ~(1 << (value - 1)); | |
b9ec4e10 ST |
981 | } |
982 | } | |
983 | ||
52355522 ST |
984 | #if IS_ENABLED(CONFIG_INPUT_LEDS) && IS_ENABLED(CONFIG_LEDS_TRIGGERS) |
985 | ||
986 | struct kbd_led_trigger { | |
987 | struct led_trigger trigger; | |
988 | unsigned int mask; | |
989 | }; | |
990 | ||
2282e125 | 991 | static int kbd_led_trigger_activate(struct led_classdev *cdev) |
52355522 ST |
992 | { |
993 | struct kbd_led_trigger *trigger = | |
994 | container_of(cdev->trigger, struct kbd_led_trigger, trigger); | |
995 | ||
996 | tasklet_disable(&keyboard_tasklet); | |
eeb64c14 | 997 | if (ledstate != -1U) |
52355522 ST |
998 | led_trigger_event(&trigger->trigger, |
999 | ledstate & trigger->mask ? | |
1000 | LED_FULL : LED_OFF); | |
1001 | tasklet_enable(&keyboard_tasklet); | |
2282e125 UKK |
1002 | |
1003 | return 0; | |
52355522 ST |
1004 | } |
1005 | ||
1006 | #define KBD_LED_TRIGGER(_led_bit, _name) { \ | |
1007 | .trigger = { \ | |
1008 | .name = _name, \ | |
1009 | .activate = kbd_led_trigger_activate, \ | |
1010 | }, \ | |
1011 | .mask = BIT(_led_bit), \ | |
1012 | } | |
1013 | ||
eeb64c14 ST |
1014 | #define KBD_LOCKSTATE_TRIGGER(_led_bit, _name) \ |
1015 | KBD_LED_TRIGGER((_led_bit) + 8, _name) | |
1016 | ||
52355522 | 1017 | static struct kbd_led_trigger kbd_led_triggers[] = { |
31b5929d | 1018 | KBD_LED_TRIGGER(VC_SCROLLOCK, "kbd-scrolllock"), |
52355522 ST |
1019 | KBD_LED_TRIGGER(VC_NUMLOCK, "kbd-numlock"), |
1020 | KBD_LED_TRIGGER(VC_CAPSLOCK, "kbd-capslock"), | |
1021 | KBD_LED_TRIGGER(VC_KANALOCK, "kbd-kanalock"), | |
eeb64c14 ST |
1022 | |
1023 | KBD_LOCKSTATE_TRIGGER(VC_SHIFTLOCK, "kbd-shiftlock"), | |
1024 | KBD_LOCKSTATE_TRIGGER(VC_ALTGRLOCK, "kbd-altgrlock"), | |
1025 | KBD_LOCKSTATE_TRIGGER(VC_CTRLLOCK, "kbd-ctrllock"), | |
1026 | KBD_LOCKSTATE_TRIGGER(VC_ALTLOCK, "kbd-altlock"), | |
1027 | KBD_LOCKSTATE_TRIGGER(VC_SHIFTLLOCK, "kbd-shiftllock"), | |
1028 | KBD_LOCKSTATE_TRIGGER(VC_SHIFTRLOCK, "kbd-shiftrlock"), | |
1029 | KBD_LOCKSTATE_TRIGGER(VC_CTRLLLOCK, "kbd-ctrlllock"), | |
1030 | KBD_LOCKSTATE_TRIGGER(VC_CTRLRLOCK, "kbd-ctrlrlock"), | |
52355522 ST |
1031 | }; |
1032 | ||
1033 | static void kbd_propagate_led_state(unsigned int old_state, | |
1034 | unsigned int new_state) | |
1035 | { | |
1036 | struct kbd_led_trigger *trigger; | |
1037 | unsigned int changed = old_state ^ new_state; | |
1038 | int i; | |
1039 | ||
1040 | for (i = 0; i < ARRAY_SIZE(kbd_led_triggers); i++) { | |
1041 | trigger = &kbd_led_triggers[i]; | |
1042 | ||
1043 | if (changed & trigger->mask) | |
1044 | led_trigger_event(&trigger->trigger, | |
1045 | new_state & trigger->mask ? | |
1046 | LED_FULL : LED_OFF); | |
1047 | } | |
1048 | } | |
1049 | ||
1050 | static int kbd_update_leds_helper(struct input_handle *handle, void *data) | |
1051 | { | |
1052 | unsigned int led_state = *(unsigned int *)data; | |
1053 | ||
1054 | if (test_bit(EV_LED, handle->dev->evbit)) | |
1055 | kbd_propagate_led_state(~led_state, led_state); | |
1056 | ||
1057 | return 0; | |
1058 | } | |
1059 | ||
1060 | static void kbd_init_leds(void) | |
1061 | { | |
1062 | int error; | |
1063 | int i; | |
1064 | ||
1065 | for (i = 0; i < ARRAY_SIZE(kbd_led_triggers); i++) { | |
1066 | error = led_trigger_register(&kbd_led_triggers[i].trigger); | |
1067 | if (error) | |
1068 | pr_err("error %d while registering trigger %s\n", | |
1069 | error, kbd_led_triggers[i].trigger.name); | |
1070 | } | |
1071 | } | |
1072 | ||
1073 | #else | |
1074 | ||
1075 | static int kbd_update_leds_helper(struct input_handle *handle, void *data) | |
1076 | { | |
1077 | unsigned int leds = *(unsigned int *)data; | |
1078 | ||
1079 | if (test_bit(EV_LED, handle->dev->evbit)) { | |
1080 | input_inject_event(handle, EV_LED, LED_SCROLLL, !!(leds & 0x01)); | |
1081 | input_inject_event(handle, EV_LED, LED_NUML, !!(leds & 0x02)); | |
1082 | input_inject_event(handle, EV_LED, LED_CAPSL, !!(leds & 0x04)); | |
1083 | input_inject_event(handle, EV_SYN, SYN_REPORT, 0); | |
1084 | } | |
1085 | ||
1086 | return 0; | |
1087 | } | |
1088 | ||
1089 | static void kbd_propagate_led_state(unsigned int old_state, | |
1090 | unsigned int new_state) | |
1091 | { | |
1092 | input_handler_for_each_handle(&kbd_handler, &new_state, | |
1093 | kbd_update_leds_helper); | |
1094 | } | |
1095 | ||
1096 | static void kbd_init_leds(void) | |
1097 | { | |
1098 | } | |
1099 | ||
1100 | #endif | |
1101 | ||
1da177e4 LT |
1102 | /* |
1103 | * The leds display either (i) the status of NumLock, CapsLock, ScrollLock, | |
1104 | * or (ii) whatever pattern of lights people want to show using KDSETLED, | |
1105 | * or (iii) specified bits of specified words in kernel memory. | |
1106 | */ | |
3db1ddb7 | 1107 | static unsigned char getledstate(void) |
1da177e4 | 1108 | { |
eeb64c14 | 1109 | return ledstate & 0xff; |
1da177e4 LT |
1110 | } |
1111 | ||
9d329c1c | 1112 | void setledstate(struct kbd_struct *kb, unsigned int led) |
1da177e4 | 1113 | { |
079c9534 | 1114 | unsigned long flags; |
3db1ddb7 | 1115 | spin_lock_irqsave(&led_lock, flags); |
1da177e4 LT |
1116 | if (!(led & ~7)) { |
1117 | ledioctl = led; | |
9d329c1c | 1118 | kb->ledmode = LED_SHOW_IOCTL; |
1da177e4 | 1119 | } else |
9d329c1c | 1120 | kb->ledmode = LED_SHOW_FLAGS; |
e0785572 | 1121 | |
1da177e4 | 1122 | set_leds(); |
3db1ddb7 | 1123 | spin_unlock_irqrestore(&led_lock, flags); |
1da177e4 LT |
1124 | } |
1125 | ||
1126 | static inline unsigned char getleds(void) | |
1127 | { | |
9d329c1c | 1128 | struct kbd_struct *kb = kbd_table + fg_console; |
1da177e4 | 1129 | |
9d329c1c | 1130 | if (kb->ledmode == LED_SHOW_IOCTL) |
1da177e4 LT |
1131 | return ledioctl; |
1132 | ||
9d329c1c | 1133 | return kb->ledflagstate; |
1da177e4 LT |
1134 | } |
1135 | ||
079c9534 AC |
1136 | /** |
1137 | * vt_get_leds - helper for braille console | |
1138 | * @console: console to read | |
1139 | * @flag: flag we want to check | |
1140 | * | |
1141 | * Check the status of a keyboard led flag and report it back | |
1142 | */ | |
1143 | int vt_get_leds(int console, int flag) | |
1144 | { | |
9d329c1c | 1145 | struct kbd_struct *kb = kbd_table + console; |
079c9534 | 1146 | int ret; |
3db1ddb7 | 1147 | unsigned long flags; |
079c9534 | 1148 | |
3db1ddb7 | 1149 | spin_lock_irqsave(&led_lock, flags); |
9d329c1c | 1150 | ret = vc_kbd_led(kb, flag); |
3db1ddb7 | 1151 | spin_unlock_irqrestore(&led_lock, flags); |
079c9534 AC |
1152 | |
1153 | return ret; | |
1154 | } | |
1155 | EXPORT_SYMBOL_GPL(vt_get_leds); | |
1156 | ||
1157 | /** | |
1158 | * vt_set_led_state - set LED state of a console | |
1159 | * @console: console to set | |
1160 | * @leds: LED bits | |
1161 | * | |
1162 | * Set the LEDs on a console. This is a wrapper for the VT layer | |
1163 | * so that we can keep kbd knowledge internal | |
1164 | */ | |
1165 | void vt_set_led_state(int console, int leds) | |
1166 | { | |
9d329c1c MR |
1167 | struct kbd_struct *kb = kbd_table + console; |
1168 | setledstate(kb, leds); | |
079c9534 AC |
1169 | } |
1170 | ||
1171 | /** | |
1172 | * vt_kbd_con_start - Keyboard side of console start | |
1173 | * @console: console | |
1174 | * | |
1175 | * Handle console start. This is a wrapper for the VT layer | |
1176 | * so that we can keep kbd knowledge internal | |
84f904ec AC |
1177 | * |
1178 | * FIXME: We eventually need to hold the kbd lock here to protect | |
1179 | * the LED updating. We can't do it yet because fn_hold calls stop_tty | |
1180 | * and start_tty under the kbd_event_lock, while normal tty paths | |
1181 | * don't hold the lock. We probably need to split out an LED lock | |
1182 | * but not during an -rc release! | |
079c9534 AC |
1183 | */ |
1184 | void vt_kbd_con_start(int console) | |
1185 | { | |
9d329c1c | 1186 | struct kbd_struct *kb = kbd_table + console; |
3db1ddb7 AC |
1187 | unsigned long flags; |
1188 | spin_lock_irqsave(&led_lock, flags); | |
9d329c1c | 1189 | clr_vc_kbd_led(kb, VC_SCROLLOCK); |
079c9534 | 1190 | set_leds(); |
3db1ddb7 | 1191 | spin_unlock_irqrestore(&led_lock, flags); |
079c9534 AC |
1192 | } |
1193 | ||
1194 | /** | |
1195 | * vt_kbd_con_stop - Keyboard side of console stop | |
1196 | * @console: console | |
1197 | * | |
1198 | * Handle console stop. This is a wrapper for the VT layer | |
1199 | * so that we can keep kbd knowledge internal | |
1200 | */ | |
1201 | void vt_kbd_con_stop(int console) | |
1202 | { | |
9d329c1c | 1203 | struct kbd_struct *kb = kbd_table + console; |
3db1ddb7 AC |
1204 | unsigned long flags; |
1205 | spin_lock_irqsave(&led_lock, flags); | |
9d329c1c | 1206 | set_vc_kbd_led(kb, VC_SCROLLOCK); |
079c9534 | 1207 | set_leds(); |
3db1ddb7 | 1208 | spin_unlock_irqrestore(&led_lock, flags); |
079c9534 AC |
1209 | } |
1210 | ||
1da177e4 | 1211 | /* |
52355522 ST |
1212 | * This is the tasklet that updates LED state of LEDs using standard |
1213 | * keyboard triggers. The reason we use tasklet is that we need to | |
1214 | * handle the scenario when keyboard handler is not registered yet | |
1215 | * but we already getting updates from the VT to update led state. | |
1da177e4 | 1216 | */ |
1da177e4 LT |
1217 | static void kbd_bh(unsigned long dummy) |
1218 | { | |
eeb64c14 | 1219 | unsigned int leds; |
3db1ddb7 | 1220 | unsigned long flags; |
52355522 | 1221 | |
3db1ddb7 AC |
1222 | spin_lock_irqsave(&led_lock, flags); |
1223 | leds = getleds(); | |
eeb64c14 | 1224 | leds |= (unsigned int)kbd->lockstate << 8; |
3db1ddb7 | 1225 | spin_unlock_irqrestore(&led_lock, flags); |
1da177e4 LT |
1226 | |
1227 | if (leds != ledstate) { | |
52355522 | 1228 | kbd_propagate_led_state(ledstate, leds); |
66d2a595 | 1229 | ledstate = leds; |
1da177e4 | 1230 | } |
1da177e4 LT |
1231 | } |
1232 | ||
1233 | DECLARE_TASKLET_DISABLED(keyboard_tasklet, kbd_bh, 0); | |
1234 | ||
1da177e4 | 1235 | #if defined(CONFIG_X86) || defined(CONFIG_IA64) || defined(CONFIG_ALPHA) ||\ |
0b57ee9e AB |
1236 | defined(CONFIG_MIPS) || defined(CONFIG_PPC) || defined(CONFIG_SPARC) ||\ |
1237 | defined(CONFIG_PARISC) || defined(CONFIG_SUPERH) ||\ | |
7b6d5399 | 1238 | (defined(CONFIG_ARM) && defined(CONFIG_KEYBOARD_ATKBD) && !defined(CONFIG_ARCH_RPC)) |
1da177e4 LT |
1239 | |
1240 | #define HW_RAW(dev) (test_bit(EV_MSC, dev->evbit) && test_bit(MSC_RAW, dev->mscbit) &&\ | |
1241 | ((dev)->id.bustype == BUS_I8042) && ((dev)->id.vendor == 0x0001) && ((dev)->id.product == 0x0001)) | |
1242 | ||
0f5e560e | 1243 | static const unsigned short x86_keycodes[256] = |
1da177e4 LT |
1244 | { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, |
1245 | 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, | |
1246 | 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, | |
1247 | 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, | |
1248 | 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, | |
1249 | 80, 81, 82, 83, 84,118, 86, 87, 88,115,120,119,121,112,123, 92, | |
896cdc7b | 1250 | 284,285,309, 0,312, 91,327,328,329,331,333,335,336,337,338,339, |
1da177e4 LT |
1251 | 367,288,302,304,350, 89,334,326,267,126,268,269,125,347,348,349, |
1252 | 360,261,262,263,268,376,100,101,321,316,373,286,289,102,351,355, | |
72a42f24 HG |
1253 | 103,104,105,275,287,279,258,106,274,107,294,364,358,363,362,361, |
1254 | 291,108,381,281,290,272,292,305,280, 99,112,257,306,359,113,114, | |
1da177e4 LT |
1255 | 264,117,271,374,379,265,266, 93, 94, 95, 85,259,375,260, 90,116, |
1256 | 377,109,111,277,278,282,283,295,296,297,299,300,301,293,303,307, | |
1257 | 308,310,313,314,315,317,318,319,320,357,322,323,324,325,276,330, | |
1258 | 332,340,365,342,343,344,345,346,356,270,341,368,369,370,371,372 }; | |
1259 | ||
0b57ee9e | 1260 | #ifdef CONFIG_SPARC |
e0785572 | 1261 | static int sparc_l1_a_state; |
1da177e4 LT |
1262 | extern void sun_do_break(void); |
1263 | #endif | |
1264 | ||
fe1e8604 | 1265 | static int emulate_raw(struct vc_data *vc, unsigned int keycode, |
1da177e4 LT |
1266 | unsigned char up_flag) |
1267 | { | |
896cdc7b | 1268 | int code; |
1da177e4 LT |
1269 | |
1270 | switch (keycode) { | |
896cdc7b | 1271 | |
e0785572 DT |
1272 | case KEY_PAUSE: |
1273 | put_queue(vc, 0xe1); | |
1274 | put_queue(vc, 0x1d | up_flag); | |
1275 | put_queue(vc, 0x45 | up_flag); | |
1276 | break; | |
896cdc7b | 1277 | |
e0785572 DT |
1278 | case KEY_HANGEUL: |
1279 | if (!up_flag) | |
1280 | put_queue(vc, 0xf2); | |
1281 | break; | |
1da177e4 | 1282 | |
e0785572 DT |
1283 | case KEY_HANJA: |
1284 | if (!up_flag) | |
1285 | put_queue(vc, 0xf1); | |
1286 | break; | |
896cdc7b | 1287 | |
e0785572 DT |
1288 | case KEY_SYSRQ: |
1289 | /* | |
1290 | * Real AT keyboards (that's what we're trying | |
26ba68d2 | 1291 | * to emulate here) emit 0xe0 0x2a 0xe0 0x37 when |
e0785572 DT |
1292 | * pressing PrtSc/SysRq alone, but simply 0x54 |
1293 | * when pressing Alt+PrtSc/SysRq. | |
1294 | */ | |
1295 | if (test_bit(KEY_LEFTALT, key_down) || | |
1296 | test_bit(KEY_RIGHTALT, key_down)) { | |
1297 | put_queue(vc, 0x54 | up_flag); | |
1298 | } else { | |
1299 | put_queue(vc, 0xe0); | |
1300 | put_queue(vc, 0x2a | up_flag); | |
1301 | put_queue(vc, 0xe0); | |
1302 | put_queue(vc, 0x37 | up_flag); | |
1303 | } | |
1304 | break; | |
1da177e4 | 1305 | |
e0785572 DT |
1306 | default: |
1307 | if (keycode > 255) | |
1308 | return -1; | |
1da177e4 | 1309 | |
e0785572 DT |
1310 | code = x86_keycodes[keycode]; |
1311 | if (!code) | |
1312 | return -1; | |
1da177e4 | 1313 | |
e0785572 DT |
1314 | if (code & 0x100) |
1315 | put_queue(vc, 0xe0); | |
1316 | put_queue(vc, (code & 0x7f) | up_flag); | |
1317 | ||
1318 | break; | |
1da177e4 LT |
1319 | } |
1320 | ||
1321 | return 0; | |
1322 | } | |
1323 | ||
1324 | #else | |
1325 | ||
1326 | #define HW_RAW(dev) 0 | |
1327 | ||
1da177e4 LT |
1328 | static int emulate_raw(struct vc_data *vc, unsigned int keycode, unsigned char up_flag) |
1329 | { | |
1330 | if (keycode > 127) | |
1331 | return -1; | |
1332 | ||
1333 | put_queue(vc, keycode | up_flag); | |
1334 | return 0; | |
1335 | } | |
1336 | #endif | |
1337 | ||
1338 | static void kbd_rawcode(unsigned char data) | |
1339 | { | |
1340 | struct vc_data *vc = vc_cons[fg_console].d; | |
e0785572 | 1341 | |
0c09b2ac | 1342 | kbd = kbd_table + vc->vc_num; |
1da177e4 LT |
1343 | if (kbd->kbdmode == VC_RAW) |
1344 | put_queue(vc, data); | |
1345 | } | |
1346 | ||
7d12e780 | 1347 | static void kbd_keycode(unsigned int keycode, int down, int hw_raw) |
1da177e4 LT |
1348 | { |
1349 | struct vc_data *vc = vc_cons[fg_console].d; | |
1350 | unsigned short keysym, *key_map; | |
e0785572 DT |
1351 | unsigned char type; |
1352 | bool raw_mode; | |
1da177e4 LT |
1353 | struct tty_struct *tty; |
1354 | int shift_final; | |
41ab4396 | 1355 | struct keyboard_notifier_param param = { .vc = vc, .value = keycode, .down = down }; |
e0785572 | 1356 | int rc; |
1da177e4 | 1357 | |
8ce73264 | 1358 | tty = vc->port.tty; |
1da177e4 LT |
1359 | |
1360 | if (tty && (!tty->driver_data)) { | |
1361 | /* No driver data? Strange. Okay we fix it then. */ | |
1362 | tty->driver_data = vc; | |
1363 | } | |
1364 | ||
0c09b2ac | 1365 | kbd = kbd_table + vc->vc_num; |
1da177e4 | 1366 | |
0b57ee9e | 1367 | #ifdef CONFIG_SPARC |
1da177e4 LT |
1368 | if (keycode == KEY_STOP) |
1369 | sparc_l1_a_state = down; | |
1370 | #endif | |
1371 | ||
1372 | rep = (down == 2); | |
1373 | ||
e0785572 DT |
1374 | raw_mode = (kbd->kbdmode == VC_RAW); |
1375 | if (raw_mode && !hw_raw) | |
1da177e4 | 1376 | if (emulate_raw(vc, keycode, !down << 7)) |
9e35d206 | 1377 | if (keycode < BTN_MISC && printk_ratelimit()) |
e620e548 JP |
1378 | pr_warn("can't emulate rawmode for keycode %d\n", |
1379 | keycode); | |
1da177e4 | 1380 | |
0b57ee9e | 1381 | #ifdef CONFIG_SPARC |
1da177e4 | 1382 | if (keycode == KEY_A && sparc_l1_a_state) { |
e0785572 | 1383 | sparc_l1_a_state = false; |
1da177e4 LT |
1384 | sun_do_break(); |
1385 | } | |
1386 | #endif | |
1387 | ||
1388 | if (kbd->kbdmode == VC_MEDIUMRAW) { | |
1389 | /* | |
1390 | * This is extended medium raw mode, with keys above 127 | |
1391 | * encoded as 0, high 7 bits, low 7 bits, with the 0 bearing | |
1392 | * the 'up' flag if needed. 0 is reserved, so this shouldn't | |
1393 | * interfere with anything else. The two bytes after 0 will | |
1394 | * always have the up flag set not to interfere with older | |
1395 | * applications. This allows for 16384 different keycodes, | |
1396 | * which should be enough. | |
1397 | */ | |
1398 | if (keycode < 128) { | |
1399 | put_queue(vc, keycode | (!down << 7)); | |
1400 | } else { | |
1401 | put_queue(vc, !down << 7); | |
1402 | put_queue(vc, (keycode >> 7) | 0x80); | |
1403 | put_queue(vc, keycode | 0x80); | |
1404 | } | |
e0785572 | 1405 | raw_mode = true; |
1da177e4 LT |
1406 | } |
1407 | ||
1408 | if (down) | |
1409 | set_bit(keycode, key_down); | |
1410 | else | |
1411 | clear_bit(keycode, key_down); | |
1412 | ||
fe1e8604 DT |
1413 | if (rep && |
1414 | (!vc_kbd_mode(kbd, VC_REPEAT) || | |
f34d7a5b | 1415 | (tty && !L_ECHO(tty) && tty_chars_in_buffer(tty)))) { |
1da177e4 LT |
1416 | /* |
1417 | * Don't repeat a key if the input buffers are not empty and the | |
fe1e8604 | 1418 | * characters get aren't echoed locally. This makes key repeat |
1da177e4 LT |
1419 | * usable with slow applications and under heavy loads. |
1420 | */ | |
1421 | return; | |
1422 | } | |
1423 | ||
41ab4396 | 1424 | param.shift = shift_final = (shift_state | kbd->slockstate) ^ kbd->lockstate; |
0beb4f6f | 1425 | param.ledstate = kbd->ledflagstate; |
1da177e4 LT |
1426 | key_map = key_maps[shift_final]; |
1427 | ||
e0785572 DT |
1428 | rc = atomic_notifier_call_chain(&keyboard_notifier_list, |
1429 | KBD_KEYCODE, ¶m); | |
1430 | if (rc == NOTIFY_STOP || !key_map) { | |
1431 | atomic_notifier_call_chain(&keyboard_notifier_list, | |
1432 | KBD_UNBOUND_KEYCODE, ¶m); | |
079c9534 | 1433 | do_compute_shiftstate(); |
1da177e4 LT |
1434 | kbd->slockstate = 0; |
1435 | return; | |
1436 | } | |
1437 | ||
e0785572 | 1438 | if (keycode < NR_KEYS) |
b9ec4e10 | 1439 | keysym = key_map[keycode]; |
e0785572 DT |
1440 | else if (keycode >= KEY_BRL_DOT1 && keycode <= KEY_BRL_DOT8) |
1441 | keysym = U(K(KT_BRL, keycode - KEY_BRL_DOT1 + 1)); | |
1442 | else | |
1443 | return; | |
1da177e4 | 1444 | |
1da177e4 LT |
1445 | type = KTYP(keysym); |
1446 | ||
1447 | if (type < 0xf0) { | |
41ab4396 | 1448 | param.value = keysym; |
e0785572 DT |
1449 | rc = atomic_notifier_call_chain(&keyboard_notifier_list, |
1450 | KBD_UNICODE, ¶m); | |
1451 | if (rc != NOTIFY_STOP) | |
1452 | if (down && !raw_mode) | |
89bb1e1e | 1453 | k_unicode(vc, keysym, !down); |
1da177e4 LT |
1454 | return; |
1455 | } | |
1456 | ||
1457 | type -= 0xf0; | |
1458 | ||
1da177e4 LT |
1459 | if (type == KT_LETTER) { |
1460 | type = KT_LATIN; | |
1461 | if (vc_kbd_led(kbd, VC_CAPSLOCK)) { | |
1462 | key_map = key_maps[shift_final ^ (1 << KG_SHIFT)]; | |
1463 | if (key_map) | |
1464 | keysym = key_map[keycode]; | |
1465 | } | |
1466 | } | |
41ab4396 | 1467 | |
e0785572 DT |
1468 | param.value = keysym; |
1469 | rc = atomic_notifier_call_chain(&keyboard_notifier_list, | |
1470 | KBD_KEYSYM, ¶m); | |
1471 | if (rc == NOTIFY_STOP) | |
41ab4396 ST |
1472 | return; |
1473 | ||
9fc3de9c | 1474 | if ((raw_mode || kbd->kbdmode == VC_OFF) && type != KT_SPEC && type != KT_SHIFT) |
41ab4396 | 1475 | return; |
1da177e4 | 1476 | |
7d12e780 | 1477 | (*k_handler[type])(vc, keysym & 0xff, !down); |
1da177e4 | 1478 | |
0beb4f6f | 1479 | param.ledstate = kbd->ledflagstate; |
41ab4396 ST |
1480 | atomic_notifier_call_chain(&keyboard_notifier_list, KBD_POST_KEYSYM, ¶m); |
1481 | ||
1da177e4 LT |
1482 | if (type != KT_SLOCK) |
1483 | kbd->slockstate = 0; | |
1484 | } | |
1485 | ||
fe1e8604 | 1486 | static void kbd_event(struct input_handle *handle, unsigned int event_type, |
1da177e4 LT |
1487 | unsigned int event_code, int value) |
1488 | { | |
21cea58e DT |
1489 | /* We are called with interrupts disabled, just take the lock */ |
1490 | spin_lock(&kbd_event_lock); | |
1491 | ||
1da177e4 LT |
1492 | if (event_type == EV_MSC && event_code == MSC_RAW && HW_RAW(handle->dev)) |
1493 | kbd_rawcode(value); | |
1494 | if (event_type == EV_KEY) | |
7d12e780 | 1495 | kbd_keycode(event_code, value, HW_RAW(handle->dev)); |
21cea58e DT |
1496 | |
1497 | spin_unlock(&kbd_event_lock); | |
1498 | ||
1da177e4 LT |
1499 | tasklet_schedule(&keyboard_tasklet); |
1500 | do_poke_blanked_console = 1; | |
1501 | schedule_console_callback(); | |
1502 | } | |
1503 | ||
0b7024ac DT |
1504 | static bool kbd_match(struct input_handler *handler, struct input_dev *dev) |
1505 | { | |
1506 | int i; | |
1507 | ||
1508 | if (test_bit(EV_SND, dev->evbit)) | |
1509 | return true; | |
1510 | ||
53c1f764 | 1511 | if (test_bit(EV_KEY, dev->evbit)) { |
0b7024ac DT |
1512 | for (i = KEY_RESERVED; i < BTN_MISC; i++) |
1513 | if (test_bit(i, dev->keybit)) | |
1514 | return true; | |
53c1f764 ST |
1515 | for (i = KEY_BRL_DOT1; i <= KEY_BRL_DOT10; i++) |
1516 | if (test_bit(i, dev->keybit)) | |
1517 | return true; | |
1518 | } | |
0b7024ac DT |
1519 | |
1520 | return false; | |
1521 | } | |
1522 | ||
1da177e4 LT |
1523 | /* |
1524 | * When a keyboard (or other input device) is found, the kbd_connect | |
1525 | * function is called. The function then looks at the device, and if it | |
1526 | * likes it, it can open it and get events from it. In this (kbd_connect) | |
1527 | * function, we should decide which VT to bind that keyboard to initially. | |
1528 | */ | |
5b2a0826 DT |
1529 | static int kbd_connect(struct input_handler *handler, struct input_dev *dev, |
1530 | const struct input_device_id *id) | |
1da177e4 LT |
1531 | { |
1532 | struct input_handle *handle; | |
5b2a0826 | 1533 | int error; |
1da177e4 | 1534 | |
22479e1c DT |
1535 | handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL); |
1536 | if (!handle) | |
5b2a0826 | 1537 | return -ENOMEM; |
1da177e4 LT |
1538 | |
1539 | handle->dev = dev; | |
1540 | handle->handler = handler; | |
fe1e8604 | 1541 | handle->name = "kbd"; |
1da177e4 | 1542 | |
5b2a0826 DT |
1543 | error = input_register_handle(handle); |
1544 | if (error) | |
1545 | goto err_free_handle; | |
1da177e4 | 1546 | |
5b2a0826 DT |
1547 | error = input_open_device(handle); |
1548 | if (error) | |
1549 | goto err_unregister_handle; | |
1550 | ||
1551 | return 0; | |
1552 | ||
1553 | err_unregister_handle: | |
1554 | input_unregister_handle(handle); | |
1555 | err_free_handle: | |
1556 | kfree(handle); | |
1557 | return error; | |
1da177e4 LT |
1558 | } |
1559 | ||
1560 | static void kbd_disconnect(struct input_handle *handle) | |
1561 | { | |
1562 | input_close_device(handle); | |
5b2a0826 | 1563 | input_unregister_handle(handle); |
1da177e4 LT |
1564 | kfree(handle); |
1565 | } | |
1566 | ||
c7e8dc6e DT |
1567 | /* |
1568 | * Start keyboard handler on the new keyboard by refreshing LED state to | |
1569 | * match the rest of the system. | |
1570 | */ | |
1571 | static void kbd_start(struct input_handle *handle) | |
1572 | { | |
c7e8dc6e | 1573 | tasklet_disable(&keyboard_tasklet); |
66d2a595 | 1574 | |
eeb64c14 ST |
1575 | if (ledstate != -1U) |
1576 | kbd_update_leds_helper(handle, &ledstate); | |
66d2a595 | 1577 | |
c7e8dc6e DT |
1578 | tasklet_enable(&keyboard_tasklet); |
1579 | } | |
1580 | ||
66e66118 | 1581 | static const struct input_device_id kbd_ids[] = { |
1da177e4 | 1582 | { |
6aeed479 AC |
1583 | .flags = INPUT_DEVICE_ID_MATCH_EVBIT, |
1584 | .evbit = { BIT_MASK(EV_KEY) }, | |
1585 | }, | |
fe1e8604 | 1586 | |
1da177e4 | 1587 | { |
6aeed479 AC |
1588 | .flags = INPUT_DEVICE_ID_MATCH_EVBIT, |
1589 | .evbit = { BIT_MASK(EV_SND) }, | |
1590 | }, | |
1da177e4 LT |
1591 | |
1592 | { }, /* Terminating entry */ | |
1593 | }; | |
1594 | ||
1595 | MODULE_DEVICE_TABLE(input, kbd_ids); | |
1596 | ||
1597 | static struct input_handler kbd_handler = { | |
1598 | .event = kbd_event, | |
0b7024ac | 1599 | .match = kbd_match, |
1da177e4 LT |
1600 | .connect = kbd_connect, |
1601 | .disconnect = kbd_disconnect, | |
c7e8dc6e | 1602 | .start = kbd_start, |
1da177e4 LT |
1603 | .name = "kbd", |
1604 | .id_table = kbd_ids, | |
1605 | }; | |
1606 | ||
1607 | int __init kbd_init(void) | |
1608 | { | |
1609 | int i; | |
4263cf0f | 1610 | int error; |
1da177e4 | 1611 | |
6aeed479 | 1612 | for (i = 0; i < MAX_NR_CONSOLES; i++) { |
b2d0b7a0 JC |
1613 | kbd_table[i].ledflagstate = kbd_defleds(); |
1614 | kbd_table[i].default_ledflagstate = kbd_defleds(); | |
2b192908 DT |
1615 | kbd_table[i].ledmode = LED_SHOW_FLAGS; |
1616 | kbd_table[i].lockstate = KBD_DEFLOCK; | |
1617 | kbd_table[i].slockstate = 0; | |
1618 | kbd_table[i].modeflags = KBD_DEFMODE; | |
2e8ecb9d | 1619 | kbd_table[i].kbdmode = default_utf8 ? VC_UNICODE : VC_XLATE; |
2b192908 | 1620 | } |
1da177e4 | 1621 | |
52355522 ST |
1622 | kbd_init_leds(); |
1623 | ||
4263cf0f DT |
1624 | error = input_register_handler(&kbd_handler); |
1625 | if (error) | |
1626 | return error; | |
1da177e4 LT |
1627 | |
1628 | tasklet_enable(&keyboard_tasklet); | |
1629 | tasklet_schedule(&keyboard_tasklet); | |
1630 | ||
1631 | return 0; | |
1632 | } | |
247ff8e6 AC |
1633 | |
1634 | /* Ioctl support code */ | |
1635 | ||
1636 | /** | |
1637 | * vt_do_diacrit - diacritical table updates | |
1638 | * @cmd: ioctl request | |
9d329c1c | 1639 | * @udp: pointer to user data for ioctl |
247ff8e6 AC |
1640 | * @perm: permissions check computed by caller |
1641 | * | |
1642 | * Update the diacritical tables atomically and safely. Lock them | |
1643 | * against simultaneous keypresses | |
1644 | */ | |
9d329c1c | 1645 | int vt_do_diacrit(unsigned int cmd, void __user *udp, int perm) |
247ff8e6 | 1646 | { |
247ff8e6 AC |
1647 | unsigned long flags; |
1648 | int asize; | |
1649 | int ret = 0; | |
1650 | ||
1651 | switch (cmd) { | |
1652 | case KDGKBDIACR: | |
1653 | { | |
9d329c1c MR |
1654 | struct kbdiacrs __user *a = udp; |
1655 | struct kbdiacr *dia; | |
247ff8e6 AC |
1656 | int i; |
1657 | ||
6da2ec56 | 1658 | dia = kmalloc_array(MAX_DIACR, sizeof(struct kbdiacr), |
247ff8e6 | 1659 | GFP_KERNEL); |
9d329c1c | 1660 | if (!dia) |
247ff8e6 AC |
1661 | return -ENOMEM; |
1662 | ||
1663 | /* Lock the diacriticals table, make a copy and then | |
1664 | copy it after we unlock */ | |
1665 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1666 | ||
1667 | asize = accent_table_size; | |
1668 | for (i = 0; i < asize; i++) { | |
9d329c1c | 1669 | dia[i].diacr = conv_uni_to_8bit( |
247ff8e6 | 1670 | accent_table[i].diacr); |
9d329c1c | 1671 | dia[i].base = conv_uni_to_8bit( |
247ff8e6 | 1672 | accent_table[i].base); |
9d329c1c | 1673 | dia[i].result = conv_uni_to_8bit( |
247ff8e6 AC |
1674 | accent_table[i].result); |
1675 | } | |
1676 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1677 | ||
1678 | if (put_user(asize, &a->kb_cnt)) | |
1679 | ret = -EFAULT; | |
9d329c1c | 1680 | else if (copy_to_user(a->kbdiacr, dia, |
247ff8e6 AC |
1681 | asize * sizeof(struct kbdiacr))) |
1682 | ret = -EFAULT; | |
9d329c1c | 1683 | kfree(dia); |
247ff8e6 AC |
1684 | return ret; |
1685 | } | |
1686 | case KDGKBDIACRUC: | |
1687 | { | |
9d329c1c | 1688 | struct kbdiacrsuc __user *a = udp; |
247ff8e6 AC |
1689 | void *buf; |
1690 | ||
6da2ec56 | 1691 | buf = kmalloc_array(MAX_DIACR, sizeof(struct kbdiacruc), |
247ff8e6 AC |
1692 | GFP_KERNEL); |
1693 | if (buf == NULL) | |
1694 | return -ENOMEM; | |
1695 | ||
1696 | /* Lock the diacriticals table, make a copy and then | |
1697 | copy it after we unlock */ | |
1698 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1699 | ||
1700 | asize = accent_table_size; | |
1701 | memcpy(buf, accent_table, asize * sizeof(struct kbdiacruc)); | |
1702 | ||
1703 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1704 | ||
1705 | if (put_user(asize, &a->kb_cnt)) | |
1706 | ret = -EFAULT; | |
1707 | else if (copy_to_user(a->kbdiacruc, buf, | |
1708 | asize*sizeof(struct kbdiacruc))) | |
1709 | ret = -EFAULT; | |
1710 | kfree(buf); | |
1711 | return ret; | |
1712 | } | |
1713 | ||
1714 | case KDSKBDIACR: | |
1715 | { | |
9d329c1c MR |
1716 | struct kbdiacrs __user *a = udp; |
1717 | struct kbdiacr *dia = NULL; | |
247ff8e6 AC |
1718 | unsigned int ct; |
1719 | int i; | |
1720 | ||
1721 | if (!perm) | |
1722 | return -EPERM; | |
1723 | if (get_user(ct, &a->kb_cnt)) | |
1724 | return -EFAULT; | |
1725 | if (ct >= MAX_DIACR) | |
1726 | return -EINVAL; | |
1727 | ||
1728 | if (ct) { | |
1051937d SS |
1729 | |
1730 | dia = memdup_user(a->kbdiacr, | |
1731 | sizeof(struct kbdiacr) * ct); | |
1732 | if (IS_ERR(dia)) | |
1733 | return PTR_ERR(dia); | |
1734 | ||
247ff8e6 AC |
1735 | } |
1736 | ||
1737 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1738 | accent_table_size = ct; | |
1739 | for (i = 0; i < ct; i++) { | |
1740 | accent_table[i].diacr = | |
9d329c1c | 1741 | conv_8bit_to_uni(dia[i].diacr); |
247ff8e6 | 1742 | accent_table[i].base = |
9d329c1c | 1743 | conv_8bit_to_uni(dia[i].base); |
247ff8e6 | 1744 | accent_table[i].result = |
9d329c1c | 1745 | conv_8bit_to_uni(dia[i].result); |
247ff8e6 AC |
1746 | } |
1747 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
9d329c1c | 1748 | kfree(dia); |
247ff8e6 AC |
1749 | return 0; |
1750 | } | |
1751 | ||
1752 | case KDSKBDIACRUC: | |
1753 | { | |
9d329c1c | 1754 | struct kbdiacrsuc __user *a = udp; |
247ff8e6 AC |
1755 | unsigned int ct; |
1756 | void *buf = NULL; | |
1757 | ||
1758 | if (!perm) | |
1759 | return -EPERM; | |
1760 | ||
1761 | if (get_user(ct, &a->kb_cnt)) | |
1762 | return -EFAULT; | |
1763 | ||
1764 | if (ct >= MAX_DIACR) | |
1765 | return -EINVAL; | |
1766 | ||
1767 | if (ct) { | |
9b651900 MFW |
1768 | buf = memdup_user(a->kbdiacruc, |
1769 | ct * sizeof(struct kbdiacruc)); | |
1770 | if (IS_ERR(buf)) | |
1771 | return PTR_ERR(buf); | |
247ff8e6 AC |
1772 | } |
1773 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1774 | if (ct) | |
1775 | memcpy(accent_table, buf, | |
1776 | ct * sizeof(struct kbdiacruc)); | |
1777 | accent_table_size = ct; | |
1778 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1779 | kfree(buf); | |
1780 | return 0; | |
1781 | } | |
1782 | } | |
1783 | return ret; | |
1784 | } | |
079c9534 AC |
1785 | |
1786 | /** | |
1787 | * vt_do_kdskbmode - set keyboard mode ioctl | |
1788 | * @console: the console to use | |
1789 | * @arg: the requested mode | |
1790 | * | |
1791 | * Update the keyboard mode bits while holding the correct locks. | |
1792 | * Return 0 for success or an error code. | |
1793 | */ | |
1794 | int vt_do_kdskbmode(int console, unsigned int arg) | |
1795 | { | |
9d329c1c | 1796 | struct kbd_struct *kb = kbd_table + console; |
079c9534 AC |
1797 | int ret = 0; |
1798 | unsigned long flags; | |
1799 | ||
1800 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1801 | switch(arg) { | |
1802 | case K_RAW: | |
9d329c1c | 1803 | kb->kbdmode = VC_RAW; |
079c9534 AC |
1804 | break; |
1805 | case K_MEDIUMRAW: | |
9d329c1c | 1806 | kb->kbdmode = VC_MEDIUMRAW; |
079c9534 AC |
1807 | break; |
1808 | case K_XLATE: | |
9d329c1c | 1809 | kb->kbdmode = VC_XLATE; |
079c9534 AC |
1810 | do_compute_shiftstate(); |
1811 | break; | |
1812 | case K_UNICODE: | |
9d329c1c | 1813 | kb->kbdmode = VC_UNICODE; |
079c9534 AC |
1814 | do_compute_shiftstate(); |
1815 | break; | |
1816 | case K_OFF: | |
9d329c1c | 1817 | kb->kbdmode = VC_OFF; |
079c9534 AC |
1818 | break; |
1819 | default: | |
1820 | ret = -EINVAL; | |
1821 | } | |
1822 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1823 | return ret; | |
1824 | } | |
1825 | ||
1826 | /** | |
1827 | * vt_do_kdskbmeta - set keyboard meta state | |
1828 | * @console: the console to use | |
1829 | * @arg: the requested meta state | |
1830 | * | |
1831 | * Update the keyboard meta bits while holding the correct locks. | |
1832 | * Return 0 for success or an error code. | |
1833 | */ | |
1834 | int vt_do_kdskbmeta(int console, unsigned int arg) | |
1835 | { | |
9d329c1c | 1836 | struct kbd_struct *kb = kbd_table + console; |
079c9534 AC |
1837 | int ret = 0; |
1838 | unsigned long flags; | |
1839 | ||
1840 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1841 | switch(arg) { | |
1842 | case K_METABIT: | |
9d329c1c | 1843 | clr_vc_kbd_mode(kb, VC_META); |
079c9534 AC |
1844 | break; |
1845 | case K_ESCPREFIX: | |
9d329c1c | 1846 | set_vc_kbd_mode(kb, VC_META); |
079c9534 AC |
1847 | break; |
1848 | default: | |
1849 | ret = -EINVAL; | |
1850 | } | |
1851 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1852 | return ret; | |
1853 | } | |
1854 | ||
1855 | int vt_do_kbkeycode_ioctl(int cmd, struct kbkeycode __user *user_kbkc, | |
1856 | int perm) | |
1857 | { | |
1858 | struct kbkeycode tmp; | |
1859 | int kc = 0; | |
1860 | ||
1861 | if (copy_from_user(&tmp, user_kbkc, sizeof(struct kbkeycode))) | |
1862 | return -EFAULT; | |
1863 | switch (cmd) { | |
1864 | case KDGETKEYCODE: | |
1865 | kc = getkeycode(tmp.scancode); | |
1866 | if (kc >= 0) | |
1867 | kc = put_user(kc, &user_kbkc->keycode); | |
1868 | break; | |
1869 | case KDSETKEYCODE: | |
1870 | if (!perm) | |
1871 | return -EPERM; | |
1872 | kc = setkeycode(tmp.scancode, tmp.keycode); | |
1873 | break; | |
1874 | } | |
1875 | return kc; | |
1876 | } | |
1877 | ||
1878 | #define i (tmp.kb_index) | |
1879 | #define s (tmp.kb_table) | |
1880 | #define v (tmp.kb_value) | |
1881 | ||
1882 | int vt_do_kdsk_ioctl(int cmd, struct kbentry __user *user_kbe, int perm, | |
1883 | int console) | |
1884 | { | |
9d329c1c | 1885 | struct kbd_struct *kb = kbd_table + console; |
079c9534 AC |
1886 | struct kbentry tmp; |
1887 | ushort *key_map, *new_map, val, ov; | |
1888 | unsigned long flags; | |
1889 | ||
1890 | if (copy_from_user(&tmp, user_kbe, sizeof(struct kbentry))) | |
1891 | return -EFAULT; | |
1892 | ||
1893 | if (!capable(CAP_SYS_TTY_CONFIG)) | |
1894 | perm = 0; | |
1895 | ||
1896 | switch (cmd) { | |
1897 | case KDGKBENT: | |
1898 | /* Ensure another thread doesn't free it under us */ | |
1899 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1900 | key_map = key_maps[s]; | |
1901 | if (key_map) { | |
1902 | val = U(key_map[i]); | |
9d329c1c | 1903 | if (kb->kbdmode != VC_UNICODE && KTYP(val) >= NR_TYPES) |
079c9534 AC |
1904 | val = K_HOLE; |
1905 | } else | |
1906 | val = (i ? K_HOLE : K_NOSUCHMAP); | |
1907 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1908 | return put_user(val, &user_kbe->kb_value); | |
1909 | case KDSKBENT: | |
1910 | if (!perm) | |
1911 | return -EPERM; | |
1912 | if (!i && v == K_NOSUCHMAP) { | |
1913 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1914 | /* deallocate map */ | |
1915 | key_map = key_maps[s]; | |
1916 | if (s && key_map) { | |
1917 | key_maps[s] = NULL; | |
1918 | if (key_map[0] == U(K_ALLOCATED)) { | |
1919 | kfree(key_map); | |
1920 | keymap_count--; | |
1921 | } | |
1922 | } | |
1923 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1924 | break; | |
1925 | } | |
1926 | ||
1927 | if (KTYP(v) < NR_TYPES) { | |
1928 | if (KVAL(v) > max_vals[KTYP(v)]) | |
1929 | return -EINVAL; | |
1930 | } else | |
9d329c1c | 1931 | if (kb->kbdmode != VC_UNICODE) |
079c9534 AC |
1932 | return -EINVAL; |
1933 | ||
1934 | /* ++Geert: non-PC keyboards may generate keycode zero */ | |
1935 | #if !defined(__mc68000__) && !defined(__powerpc__) | |
1936 | /* assignment to entry 0 only tests validity of args */ | |
1937 | if (!i) | |
1938 | break; | |
1939 | #endif | |
1940 | ||
1941 | new_map = kmalloc(sizeof(plain_map), GFP_KERNEL); | |
1942 | if (!new_map) | |
1943 | return -ENOMEM; | |
1944 | spin_lock_irqsave(&kbd_event_lock, flags); | |
1945 | key_map = key_maps[s]; | |
1946 | if (key_map == NULL) { | |
1947 | int j; | |
1948 | ||
1949 | if (keymap_count >= MAX_NR_OF_USER_KEYMAPS && | |
1950 | !capable(CAP_SYS_RESOURCE)) { | |
1951 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1952 | kfree(new_map); | |
1953 | return -EPERM; | |
1954 | } | |
1955 | key_maps[s] = new_map; | |
82896210 | 1956 | key_map = new_map; |
079c9534 AC |
1957 | key_map[0] = U(K_ALLOCATED); |
1958 | for (j = 1; j < NR_KEYS; j++) | |
1959 | key_map[j] = U(K_HOLE); | |
1960 | keymap_count++; | |
1961 | } else | |
1962 | kfree(new_map); | |
1963 | ||
1964 | ov = U(key_map[i]); | |
1965 | if (v == ov) | |
1966 | goto out; | |
1967 | /* | |
1968 | * Attention Key. | |
1969 | */ | |
1970 | if (((ov == K_SAK) || (v == K_SAK)) && !capable(CAP_SYS_ADMIN)) { | |
1971 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1972 | return -EPERM; | |
1973 | } | |
1974 | key_map[i] = U(v); | |
1975 | if (!s && (KTYP(ov) == KT_SHIFT || KTYP(v) == KT_SHIFT)) | |
1976 | do_compute_shiftstate(); | |
1977 | out: | |
1978 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
1979 | break; | |
1980 | } | |
1981 | return 0; | |
1982 | } | |
1983 | #undef i | |
1984 | #undef s | |
1985 | #undef v | |
1986 | ||
1987 | /* FIXME: This one needs untangling and locking */ | |
1988 | int vt_do_kdgkb_ioctl(int cmd, struct kbsentry __user *user_kdgkb, int perm) | |
1989 | { | |
1990 | struct kbsentry *kbs; | |
1991 | char *p; | |
1992 | u_char *q; | |
1993 | u_char __user *up; | |
46ca3f73 | 1994 | int sz, fnw_sz; |
079c9534 AC |
1995 | int delta; |
1996 | char *first_free, *fj, *fnw; | |
1997 | int i, j, k; | |
1998 | int ret; | |
46ca3f73 | 1999 | unsigned long flags; |
079c9534 AC |
2000 | |
2001 | if (!capable(CAP_SYS_TTY_CONFIG)) | |
2002 | perm = 0; | |
2003 | ||
2004 | kbs = kmalloc(sizeof(*kbs), GFP_KERNEL); | |
2005 | if (!kbs) { | |
2006 | ret = -ENOMEM; | |
2007 | goto reterr; | |
2008 | } | |
2009 | ||
2010 | /* we mostly copy too much here (512bytes), but who cares ;) */ | |
2011 | if (copy_from_user(kbs, user_kdgkb, sizeof(struct kbsentry))) { | |
2012 | ret = -EFAULT; | |
2013 | goto reterr; | |
2014 | } | |
2015 | kbs->kb_string[sizeof(kbs->kb_string)-1] = '\0'; | |
2016 | i = kbs->kb_func; | |
2017 | ||
2018 | switch (cmd) { | |
2019 | case KDGKBSENT: | |
2020 | sz = sizeof(kbs->kb_string) - 1; /* sz should have been | |
2021 | a struct member */ | |
2022 | up = user_kdgkb->kb_string; | |
2023 | p = func_table[i]; | |
2024 | if(p) | |
2025 | for ( ; *p && sz; p++, sz--) | |
2026 | if (put_user(*p, up++)) { | |
2027 | ret = -EFAULT; | |
2028 | goto reterr; | |
2029 | } | |
2030 | if (put_user('\0', up)) { | |
2031 | ret = -EFAULT; | |
2032 | goto reterr; | |
2033 | } | |
2034 | kfree(kbs); | |
2035 | return ((p && *p) ? -EOVERFLOW : 0); | |
2036 | case KDSKBSENT: | |
2037 | if (!perm) { | |
2038 | ret = -EPERM; | |
2039 | goto reterr; | |
2040 | } | |
2041 | ||
46ca3f73 ST |
2042 | fnw = NULL; |
2043 | fnw_sz = 0; | |
2044 | /* race aginst other writers */ | |
2045 | again: | |
2046 | spin_lock_irqsave(&func_buf_lock, flags); | |
079c9534 | 2047 | q = func_table[i]; |
46ca3f73 ST |
2048 | |
2049 | /* fj pointer to next entry after 'q' */ | |
079c9534 AC |
2050 | first_free = funcbufptr + (funcbufsize - funcbufleft); |
2051 | for (j = i+1; j < MAX_NR_FUNC && !func_table[j]; j++) | |
2052 | ; | |
2053 | if (j < MAX_NR_FUNC) | |
2054 | fj = func_table[j]; | |
2055 | else | |
2056 | fj = first_free; | |
46ca3f73 | 2057 | /* buffer usage increase by new entry */ |
079c9534 | 2058 | delta = (q ? -strlen(q) : 1) + strlen(kbs->kb_string); |
46ca3f73 | 2059 | |
079c9534 AC |
2060 | if (delta <= funcbufleft) { /* it fits in current buf */ |
2061 | if (j < MAX_NR_FUNC) { | |
46ca3f73 | 2062 | /* make enough space for new entry at 'fj' */ |
079c9534 AC |
2063 | memmove(fj + delta, fj, first_free - fj); |
2064 | for (k = j; k < MAX_NR_FUNC; k++) | |
2065 | if (func_table[k]) | |
2066 | func_table[k] += delta; | |
2067 | } | |
2068 | if (!q) | |
2069 | func_table[i] = fj; | |
2070 | funcbufleft -= delta; | |
2071 | } else { /* allocate a larger buffer */ | |
2072 | sz = 256; | |
2073 | while (sz < funcbufsize - funcbufleft + delta) | |
2074 | sz <<= 1; | |
46ca3f73 ST |
2075 | if (fnw_sz != sz) { |
2076 | spin_unlock_irqrestore(&func_buf_lock, flags); | |
2077 | kfree(fnw); | |
2078 | fnw = kmalloc(sz, GFP_KERNEL); | |
2079 | fnw_sz = sz; | |
2080 | if (!fnw) { | |
2081 | ret = -ENOMEM; | |
2082 | goto reterr; | |
2083 | } | |
2084 | goto again; | |
079c9534 AC |
2085 | } |
2086 | ||
2087 | if (!q) | |
2088 | func_table[i] = fj; | |
46ca3f73 | 2089 | /* copy data before insertion point to new location */ |
079c9534 AC |
2090 | if (fj > funcbufptr) |
2091 | memmove(fnw, funcbufptr, fj - funcbufptr); | |
2092 | for (k = 0; k < j; k++) | |
2093 | if (func_table[k]) | |
2094 | func_table[k] = fnw + (func_table[k] - funcbufptr); | |
2095 | ||
46ca3f73 | 2096 | /* copy data after insertion point to new location */ |
079c9534 AC |
2097 | if (first_free > fj) { |
2098 | memmove(fnw + (fj - funcbufptr) + delta, fj, first_free - fj); | |
2099 | for (k = j; k < MAX_NR_FUNC; k++) | |
2100 | if (func_table[k]) | |
2101 | func_table[k] = fnw + (func_table[k] - funcbufptr) + delta; | |
2102 | } | |
2103 | if (funcbufptr != func_buf) | |
2104 | kfree(funcbufptr); | |
2105 | funcbufptr = fnw; | |
2106 | funcbufleft = funcbufleft - delta + sz - funcbufsize; | |
2107 | funcbufsize = sz; | |
2108 | } | |
46ca3f73 | 2109 | /* finally insert item itself */ |
079c9534 | 2110 | strcpy(func_table[i], kbs->kb_string); |
46ca3f73 | 2111 | spin_unlock_irqrestore(&func_buf_lock, flags); |
079c9534 AC |
2112 | break; |
2113 | } | |
2114 | ret = 0; | |
2115 | reterr: | |
2116 | kfree(kbs); | |
2117 | return ret; | |
2118 | } | |
2119 | ||
2120 | int vt_do_kdskled(int console, int cmd, unsigned long arg, int perm) | |
2121 | { | |
9d329c1c | 2122 | struct kbd_struct *kb = kbd_table + console; |
079c9534 AC |
2123 | unsigned long flags; |
2124 | unsigned char ucval; | |
2125 | ||
2126 | switch(cmd) { | |
2127 | /* the ioctls below read/set the flags usually shown in the leds */ | |
2128 | /* don't use them - they will go away without warning */ | |
2129 | case KDGKBLED: | |
2130 | spin_lock_irqsave(&kbd_event_lock, flags); | |
9d329c1c | 2131 | ucval = kb->ledflagstate | (kb->default_ledflagstate << 4); |
079c9534 AC |
2132 | spin_unlock_irqrestore(&kbd_event_lock, flags); |
2133 | return put_user(ucval, (char __user *)arg); | |
2134 | ||
2135 | case KDSKBLED: | |
2136 | if (!perm) | |
2137 | return -EPERM; | |
2138 | if (arg & ~0x77) | |
2139 | return -EINVAL; | |
3db1ddb7 | 2140 | spin_lock_irqsave(&led_lock, flags); |
9d329c1c MR |
2141 | kb->ledflagstate = (arg & 7); |
2142 | kb->default_ledflagstate = ((arg >> 4) & 7); | |
079c9534 | 2143 | set_leds(); |
3db1ddb7 | 2144 | spin_unlock_irqrestore(&led_lock, flags); |
eea41aee | 2145 | return 0; |
079c9534 AC |
2146 | |
2147 | /* the ioctls below only set the lights, not the functions */ | |
2148 | /* for those, see KDGKBLED and KDSKBLED above */ | |
2149 | case KDGETLED: | |
2150 | ucval = getledstate(); | |
2151 | return put_user(ucval, (char __user *)arg); | |
2152 | ||
2153 | case KDSETLED: | |
2154 | if (!perm) | |
2155 | return -EPERM; | |
9d329c1c | 2156 | setledstate(kb, arg); |
079c9534 AC |
2157 | return 0; |
2158 | } | |
2159 | return -ENOIOCTLCMD; | |
2160 | } | |
2161 | ||
2162 | int vt_do_kdgkbmode(int console) | |
2163 | { | |
9d329c1c | 2164 | struct kbd_struct *kb = kbd_table + console; |
079c9534 | 2165 | /* This is a spot read so needs no locking */ |
9d329c1c | 2166 | switch (kb->kbdmode) { |
079c9534 AC |
2167 | case VC_RAW: |
2168 | return K_RAW; | |
2169 | case VC_MEDIUMRAW: | |
2170 | return K_MEDIUMRAW; | |
2171 | case VC_UNICODE: | |
2172 | return K_UNICODE; | |
2173 | case VC_OFF: | |
2174 | return K_OFF; | |
2175 | default: | |
2176 | return K_XLATE; | |
2177 | } | |
2178 | } | |
2179 | ||
2180 | /** | |
2181 | * vt_do_kdgkbmeta - report meta status | |
2182 | * @console: console to report | |
2183 | * | |
2184 | * Report the meta flag status of this console | |
2185 | */ | |
2186 | int vt_do_kdgkbmeta(int console) | |
2187 | { | |
9d329c1c | 2188 | struct kbd_struct *kb = kbd_table + console; |
079c9534 | 2189 | /* Again a spot read so no locking */ |
9d329c1c | 2190 | return vc_kbd_mode(kb, VC_META) ? K_ESCPREFIX : K_METABIT; |
079c9534 AC |
2191 | } |
2192 | ||
2193 | /** | |
2194 | * vt_reset_unicode - reset the unicode status | |
2195 | * @console: console being reset | |
2196 | * | |
2197 | * Restore the unicode console state to its default | |
2198 | */ | |
2199 | void vt_reset_unicode(int console) | |
2200 | { | |
2201 | unsigned long flags; | |
2202 | ||
2203 | spin_lock_irqsave(&kbd_event_lock, flags); | |
2204 | kbd_table[console].kbdmode = default_utf8 ? VC_UNICODE : VC_XLATE; | |
2205 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
2206 | } | |
2207 | ||
2208 | /** | |
2209 | * vt_get_shiftstate - shift bit state | |
2210 | * | |
2211 | * Report the shift bits from the keyboard state. We have to export | |
2212 | * this to support some oddities in the vt layer. | |
2213 | */ | |
2214 | int vt_get_shift_state(void) | |
2215 | { | |
2216 | /* Don't lock as this is a transient report */ | |
2217 | return shift_state; | |
2218 | } | |
2219 | ||
2220 | /** | |
2221 | * vt_reset_keyboard - reset keyboard state | |
2222 | * @console: console to reset | |
2223 | * | |
2224 | * Reset the keyboard bits for a console as part of a general console | |
2225 | * reset event | |
2226 | */ | |
2227 | void vt_reset_keyboard(int console) | |
2228 | { | |
9d329c1c | 2229 | struct kbd_struct *kb = kbd_table + console; |
079c9534 AC |
2230 | unsigned long flags; |
2231 | ||
2232 | spin_lock_irqsave(&kbd_event_lock, flags); | |
9d329c1c MR |
2233 | set_vc_kbd_mode(kb, VC_REPEAT); |
2234 | clr_vc_kbd_mode(kb, VC_CKMODE); | |
2235 | clr_vc_kbd_mode(kb, VC_APPLIC); | |
2236 | clr_vc_kbd_mode(kb, VC_CRLF); | |
2237 | kb->lockstate = 0; | |
2238 | kb->slockstate = 0; | |
3db1ddb7 | 2239 | spin_lock(&led_lock); |
9d329c1c MR |
2240 | kb->ledmode = LED_SHOW_FLAGS; |
2241 | kb->ledflagstate = kb->default_ledflagstate; | |
3db1ddb7 | 2242 | spin_unlock(&led_lock); |
079c9534 AC |
2243 | /* do not do set_leds here because this causes an endless tasklet loop |
2244 | when the keyboard hasn't been initialized yet */ | |
2245 | spin_unlock_irqrestore(&kbd_event_lock, flags); | |
2246 | } | |
2247 | ||
2248 | /** | |
2249 | * vt_get_kbd_mode_bit - read keyboard status bits | |
2250 | * @console: console to read from | |
2251 | * @bit: mode bit to read | |
2252 | * | |
2253 | * Report back a vt mode bit. We do this without locking so the | |
2254 | * caller must be sure that there are no synchronization needs | |
2255 | */ | |
2256 | ||
2257 | int vt_get_kbd_mode_bit(int console, int bit) | |
2258 | { | |
9d329c1c MR |
2259 | struct kbd_struct *kb = kbd_table + console; |
2260 | return vc_kbd_mode(kb, bit); | |
079c9534 AC |
2261 | } |
2262 | ||
2263 | /** | |
2264 | * vt_set_kbd_mode_bit - read keyboard status bits | |
2265 | * @console: console to read from | |
2266 | * @bit: mode bit to read | |
2267 | * | |
2268 | * Set a vt mode bit. We do this without locking so the | |
2269 | * caller must be sure that there are no synchronization needs | |
2270 | */ | |
2271 | ||
2272 | void vt_set_kbd_mode_bit(int console, int bit) | |
2273 | { | |
9d329c1c | 2274 | struct kbd_struct *kb = kbd_table + console; |
079c9534 AC |
2275 | unsigned long flags; |
2276 | ||
2277 | spin_lock_irqsave(&kbd_event_lock, flags); | |
9d329c1c | 2278 | set_vc_kbd_mode(kb, bit); |
079c9534 AC |
2279 | spin_unlock_irqrestore(&kbd_event_lock, flags); |
2280 | } | |
2281 | ||
2282 | /** | |
2283 | * vt_clr_kbd_mode_bit - read keyboard status bits | |
2284 | * @console: console to read from | |
2285 | * @bit: mode bit to read | |
2286 | * | |
2287 | * Report back a vt mode bit. We do this without locking so the | |
2288 | * caller must be sure that there are no synchronization needs | |
2289 | */ | |
2290 | ||
2291 | void vt_clr_kbd_mode_bit(int console, int bit) | |
2292 | { | |
9d329c1c | 2293 | struct kbd_struct *kb = kbd_table + console; |
079c9534 AC |
2294 | unsigned long flags; |
2295 | ||
2296 | spin_lock_irqsave(&kbd_event_lock, flags); | |
9d329c1c | 2297 | clr_vc_kbd_mode(kb, bit); |
079c9534 AC |
2298 | spin_unlock_irqrestore(&kbd_event_lock, flags); |
2299 | } |