2 * Written for linux by Johan Myreen as a translation from
3 * the assembly version by Linus (with diacriticals added)
5 * Some additional features added by Christoph Niemann (ChN), March 1993
7 * Loadable keymaps by Risto Kankkunen, May 1993
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.
14 * 11-11-96: SAK should now work in the raw mode (Martin Mares)
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
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)
25 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
27 #include <linux/consolemap.h>
28 #include <linux/module.h>
29 #include <linux/sched/signal.h>
30 #include <linux/sched/debug.h>
31 #include <linux/tty.h>
32 #include <linux/tty_flip.h>
34 #include <linux/string.h>
35 #include <linux/init.h>
36 #include <linux/slab.h>
37 #include <linux/leds.h>
39 #include <linux/kbd_kern.h>
40 #include <linux/kbd_diacr.h>
41 #include <linux/vt_kern.h>
42 #include <linux/input.h>
43 #include <linux/reboot.h>
44 #include <linux/notifier.h>
45 #include <linux/jiffies.h>
46 #include <linux/uaccess.h>
48 #include <asm/irq_regs.h>
50 extern void ctrl_alt_del(void);
53 * Exported functions/variables
56 #define KBD_DEFMODE ((1 << VC_REPEAT) | (1 << VC_META))
58 #if defined(CONFIG_X86) || defined(CONFIG_PARISC)
59 #include <asm/kbdleds.h>
61 static inline int kbd_defleds(void)
74 k_self, k_fn, k_spec, k_pad,\
75 k_dead, k_cons, k_cur, k_shift,\
76 k_meta, k_ascii, k_lock, k_lowercase,\
77 k_slock, k_dead2, k_brl, k_ignore
79 typedef void (k_handler_fn)(struct vc_data *vc, unsigned char value,
81 static k_handler_fn K_HANDLERS;
82 static k_handler_fn *k_handler[16] = { K_HANDLERS };
85 fn_null, fn_enter, fn_show_ptregs, fn_show_mem,\
86 fn_show_state, fn_send_intr, fn_lastcons, fn_caps_toggle,\
87 fn_num, fn_hold, fn_scroll_forw, fn_scroll_back,\
88 fn_boot_it, fn_caps_on, fn_compose, fn_SAK,\
89 fn_dec_console, fn_inc_console, fn_spawn_con, fn_bare_num
91 typedef void (fn_handler_fn)(struct vc_data *vc);
92 static fn_handler_fn FN_HANDLERS;
93 static fn_handler_fn *fn_handler[] = { FN_HANDLERS };
96 * Variables exported for vt_ioctl.c
99 struct vt_spawn_console vt_spawn_con = {
100 .lock = __SPIN_LOCK_UNLOCKED(vt_spawn_con.lock),
110 static struct kbd_struct kbd_table[MAX_NR_CONSOLES];
111 static struct kbd_struct *kbd = kbd_table;
113 /* maximum values each key_handler can handle */
114 static const int max_vals[] = {
115 255, ARRAY_SIZE(func_table) - 1, ARRAY_SIZE(fn_handler) - 1, NR_PAD - 1,
116 NR_DEAD - 1, 255, 3, NR_SHIFT - 1, 255, NR_ASCII - 1, NR_LOCK - 1,
117 255, NR_LOCK - 1, 255, NR_BRL - 1
120 static const int NR_TYPES = ARRAY_SIZE(max_vals);
122 static struct input_handler kbd_handler;
123 static DEFINE_SPINLOCK(kbd_event_lock);
124 static DEFINE_SPINLOCK(led_lock);
125 static unsigned long key_down[BITS_TO_LONGS(KEY_CNT)]; /* keyboard key bitmap */
126 static unsigned char shift_down[NR_SHIFT]; /* shift state counters.. */
127 static bool dead_key_next;
128 static int npadch = -1; /* -1 or number assembled on pad */
129 static unsigned int diacr;
130 static char rep; /* flag telling character repeat */
132 static int shift_state = 0;
134 static unsigned int ledstate = -1U; /* undefined */
135 static unsigned char ledioctl;
138 * Notifier list for console keyboard events
140 static ATOMIC_NOTIFIER_HEAD(keyboard_notifier_list);
142 int register_keyboard_notifier(struct notifier_block *nb)
144 return atomic_notifier_chain_register(&keyboard_notifier_list, nb);
146 EXPORT_SYMBOL_GPL(register_keyboard_notifier);
148 int unregister_keyboard_notifier(struct notifier_block *nb)
150 return atomic_notifier_chain_unregister(&keyboard_notifier_list, nb);
152 EXPORT_SYMBOL_GPL(unregister_keyboard_notifier);
155 * Translation of scancodes to keycodes. We set them on only the first
156 * keyboard in the list that accepts the scancode and keycode.
157 * Explanation for not choosing the first attached keyboard anymore:
158 * USB keyboards for example have two event devices: one for all "normal"
159 * keys and one for extra function keys (like "volume up", "make coffee",
160 * etc.). So this means that scancodes for the extra function keys won't
161 * be valid for the first event device, but will be for the second.
164 struct getset_keycode_data {
165 struct input_keymap_entry ke;
169 static int getkeycode_helper(struct input_handle *handle, void *data)
171 struct getset_keycode_data *d = data;
173 d->error = input_get_keycode(handle->dev, &d->ke);
175 return d->error == 0; /* stop as soon as we successfully get one */
178 static int getkeycode(unsigned int scancode)
180 struct getset_keycode_data d = {
183 .len = sizeof(scancode),
189 memcpy(d.ke.scancode, &scancode, sizeof(scancode));
191 input_handler_for_each_handle(&kbd_handler, &d, getkeycode_helper);
193 return d.error ?: d.ke.keycode;
196 static int setkeycode_helper(struct input_handle *handle, void *data)
198 struct getset_keycode_data *d = data;
200 d->error = input_set_keycode(handle->dev, &d->ke);
202 return d->error == 0; /* stop as soon as we successfully set one */
205 static int setkeycode(unsigned int scancode, unsigned int keycode)
207 struct getset_keycode_data d = {
210 .len = sizeof(scancode),
216 memcpy(d.ke.scancode, &scancode, sizeof(scancode));
218 input_handler_for_each_handle(&kbd_handler, &d, setkeycode_helper);
224 * Making beeps and bells. Note that we prefer beeps to bells, but when
225 * shutting the sound off we do both.
228 static int kd_sound_helper(struct input_handle *handle, void *data)
230 unsigned int *hz = data;
231 struct input_dev *dev = handle->dev;
233 if (test_bit(EV_SND, dev->evbit)) {
234 if (test_bit(SND_TONE, dev->sndbit)) {
235 input_inject_event(handle, EV_SND, SND_TONE, *hz);
239 if (test_bit(SND_BELL, dev->sndbit))
240 input_inject_event(handle, EV_SND, SND_BELL, *hz ? 1 : 0);
246 static void kd_nosound(unsigned long ignored)
248 static unsigned int zero;
250 input_handler_for_each_handle(&kbd_handler, &zero, kd_sound_helper);
253 static DEFINE_TIMER(kd_mksound_timer, kd_nosound, 0, 0);
255 void kd_mksound(unsigned int hz, unsigned int ticks)
257 del_timer_sync(&kd_mksound_timer);
259 input_handler_for_each_handle(&kbd_handler, &hz, kd_sound_helper);
262 mod_timer(&kd_mksound_timer, jiffies + ticks);
264 EXPORT_SYMBOL(kd_mksound);
267 * Setting the keyboard rate.
270 static int kbd_rate_helper(struct input_handle *handle, void *data)
272 struct input_dev *dev = handle->dev;
273 struct kbd_repeat *rpt = data;
275 if (test_bit(EV_REP, dev->evbit)) {
277 if (rpt[0].delay > 0)
278 input_inject_event(handle,
279 EV_REP, REP_DELAY, rpt[0].delay);
280 if (rpt[0].period > 0)
281 input_inject_event(handle,
282 EV_REP, REP_PERIOD, rpt[0].period);
284 rpt[1].delay = dev->rep[REP_DELAY];
285 rpt[1].period = dev->rep[REP_PERIOD];
291 int kbd_rate(struct kbd_repeat *rpt)
293 struct kbd_repeat data[2] = { *rpt };
295 input_handler_for_each_handle(&kbd_handler, data, kbd_rate_helper);
296 *rpt = data[1]; /* Copy currently used settings */
304 static void put_queue(struct vc_data *vc, int ch)
306 tty_insert_flip_char(&vc->port, ch, 0);
307 tty_schedule_flip(&vc->port);
310 static void puts_queue(struct vc_data *vc, char *cp)
313 tty_insert_flip_char(&vc->port, *cp, 0);
316 tty_schedule_flip(&vc->port);
319 static void applkey(struct vc_data *vc, int key, char mode)
321 static char buf[] = { 0x1b, 'O', 0x00, 0x00 };
323 buf[1] = (mode ? 'O' : '[');
329 * Many other routines do put_queue, but I think either
330 * they produce ASCII, or they produce some user-assigned
331 * string, and in both cases we might assume that it is
334 static void to_utf8(struct vc_data *vc, uint c)
339 else if (c < 0x800) {
340 /* 110***** 10****** */
341 put_queue(vc, 0xc0 | (c >> 6));
342 put_queue(vc, 0x80 | (c & 0x3f));
343 } else if (c < 0x10000) {
344 if (c >= 0xD800 && c < 0xE000)
348 /* 1110**** 10****** 10****** */
349 put_queue(vc, 0xe0 | (c >> 12));
350 put_queue(vc, 0x80 | ((c >> 6) & 0x3f));
351 put_queue(vc, 0x80 | (c & 0x3f));
352 } else if (c < 0x110000) {
353 /* 11110*** 10****** 10****** 10****** */
354 put_queue(vc, 0xf0 | (c >> 18));
355 put_queue(vc, 0x80 | ((c >> 12) & 0x3f));
356 put_queue(vc, 0x80 | ((c >> 6) & 0x3f));
357 put_queue(vc, 0x80 | (c & 0x3f));
362 * Called after returning from RAW mode or when changing consoles - recompute
363 * shift_down[] and shift_state from key_down[] maybe called when keymap is
364 * undefined, so that shiftkey release is seen. The caller must hold the
368 static void do_compute_shiftstate(void)
370 unsigned int k, sym, val;
373 memset(shift_down, 0, sizeof(shift_down));
375 for_each_set_bit(k, key_down, min(NR_KEYS, KEY_CNT)) {
376 sym = U(key_maps[0][k]);
377 if (KTYP(sym) != KT_SHIFT && KTYP(sym) != KT_SLOCK)
381 if (val == KVAL(K_CAPSSHIFT))
385 shift_state |= BIT(val);
389 /* We still have to export this method to vt.c */
390 void compute_shiftstate(void)
393 spin_lock_irqsave(&kbd_event_lock, flags);
394 do_compute_shiftstate();
395 spin_unlock_irqrestore(&kbd_event_lock, flags);
399 * We have a combining character DIACR here, followed by the character CH.
400 * If the combination occurs in the table, return the corresponding value.
401 * Otherwise, if CH is a space or equals DIACR, return DIACR.
402 * Otherwise, conclude that DIACR was not combining after all,
403 * queue it and return CH.
405 static unsigned int handle_diacr(struct vc_data *vc, unsigned int ch)
407 unsigned int d = diacr;
412 if ((d & ~0xff) == BRL_UC_ROW) {
413 if ((ch & ~0xff) == BRL_UC_ROW)
416 for (i = 0; i < accent_table_size; i++)
417 if (accent_table[i].diacr == d && accent_table[i].base == ch)
418 return accent_table[i].result;
421 if (ch == ' ' || ch == (BRL_UC_ROW|0) || ch == d)
424 if (kbd->kbdmode == VC_UNICODE)
427 int c = conv_uni_to_8bit(d);
436 * Special function handlers
438 static void fn_enter(struct vc_data *vc)
441 if (kbd->kbdmode == VC_UNICODE)
444 int c = conv_uni_to_8bit(diacr);
452 if (vc_kbd_mode(kbd, VC_CRLF))
456 static void fn_caps_toggle(struct vc_data *vc)
461 chg_vc_kbd_led(kbd, VC_CAPSLOCK);
464 static void fn_caps_on(struct vc_data *vc)
469 set_vc_kbd_led(kbd, VC_CAPSLOCK);
472 static void fn_show_ptregs(struct vc_data *vc)
474 struct pt_regs *regs = get_irq_regs();
480 static void fn_hold(struct vc_data *vc)
482 struct tty_struct *tty = vc->port.tty;
488 * Note: SCROLLOCK will be set (cleared) by stop_tty (start_tty);
489 * these routines are also activated by ^S/^Q.
490 * (And SCROLLOCK can also be set by the ioctl KDSKBLED.)
498 static void fn_num(struct vc_data *vc)
500 if (vc_kbd_mode(kbd, VC_APPLIC))
507 * Bind this to Shift-NumLock if you work in application keypad mode
508 * but want to be able to change the NumLock flag.
509 * Bind this to NumLock if you prefer that the NumLock key always
510 * changes the NumLock flag.
512 static void fn_bare_num(struct vc_data *vc)
515 chg_vc_kbd_led(kbd, VC_NUMLOCK);
518 static void fn_lastcons(struct vc_data *vc)
520 /* switch to the last used console, ChN */
521 set_console(last_console);
524 static void fn_dec_console(struct vc_data *vc)
526 int i, cur = fg_console;
528 /* Currently switching? Queue this next switch relative to that. */
529 if (want_console != -1)
532 for (i = cur - 1; i != cur; i--) {
534 i = MAX_NR_CONSOLES - 1;
535 if (vc_cons_allocated(i))
541 static void fn_inc_console(struct vc_data *vc)
543 int i, cur = fg_console;
545 /* Currently switching? Queue this next switch relative to that. */
546 if (want_console != -1)
549 for (i = cur+1; i != cur; i++) {
550 if (i == MAX_NR_CONSOLES)
552 if (vc_cons_allocated(i))
558 static void fn_send_intr(struct vc_data *vc)
560 tty_insert_flip_char(&vc->port, 0, TTY_BREAK);
561 tty_schedule_flip(&vc->port);
564 static void fn_scroll_forw(struct vc_data *vc)
569 static void fn_scroll_back(struct vc_data *vc)
574 static void fn_show_mem(struct vc_data *vc)
579 static void fn_show_state(struct vc_data *vc)
584 static void fn_boot_it(struct vc_data *vc)
589 static void fn_compose(struct vc_data *vc)
591 dead_key_next = true;
594 static void fn_spawn_con(struct vc_data *vc)
596 spin_lock(&vt_spawn_con.lock);
597 if (vt_spawn_con.pid)
598 if (kill_pid(vt_spawn_con.pid, vt_spawn_con.sig, 1)) {
599 put_pid(vt_spawn_con.pid);
600 vt_spawn_con.pid = NULL;
602 spin_unlock(&vt_spawn_con.lock);
605 static void fn_SAK(struct vc_data *vc)
607 struct work_struct *SAK_work = &vc_cons[fg_console].SAK_work;
608 schedule_work(SAK_work);
611 static void fn_null(struct vc_data *vc)
613 do_compute_shiftstate();
617 * Special key handlers
619 static void k_ignore(struct vc_data *vc, unsigned char value, char up_flag)
623 static void k_spec(struct vc_data *vc, unsigned char value, char up_flag)
627 if (value >= ARRAY_SIZE(fn_handler))
629 if ((kbd->kbdmode == VC_RAW ||
630 kbd->kbdmode == VC_MEDIUMRAW ||
631 kbd->kbdmode == VC_OFF) &&
632 value != KVAL(K_SAK))
633 return; /* SAK is allowed even in raw mode */
634 fn_handler[value](vc);
637 static void k_lowercase(struct vc_data *vc, unsigned char value, char up_flag)
639 pr_err("k_lowercase was called - impossible\n");
642 static void k_unicode(struct vc_data *vc, unsigned int value, char up_flag)
645 return; /* no action, if this is a key release */
648 value = handle_diacr(vc, value);
651 dead_key_next = false;
655 if (kbd->kbdmode == VC_UNICODE)
658 int c = conv_uni_to_8bit(value);
665 * Handle dead key. Note that we now may have several
666 * dead keys modifying the same character. Very useful
669 static void k_deadunicode(struct vc_data *vc, unsigned int value, char up_flag)
674 diacr = (diacr ? handle_diacr(vc, value) : value);
677 static void k_self(struct vc_data *vc, unsigned char value, char up_flag)
679 k_unicode(vc, conv_8bit_to_uni(value), up_flag);
682 static void k_dead2(struct vc_data *vc, unsigned char value, char up_flag)
684 k_deadunicode(vc, value, up_flag);
688 * Obsolete - for backwards compatibility only
690 static void k_dead(struct vc_data *vc, unsigned char value, char up_flag)
692 static const unsigned char ret_diacr[NR_DEAD] = {'`', '\'', '^', '~', '"', ',' };
694 k_deadunicode(vc, ret_diacr[value], up_flag);
697 static void k_cons(struct vc_data *vc, unsigned char value, char up_flag)
705 static void k_fn(struct vc_data *vc, unsigned char value, char up_flag)
710 if ((unsigned)value < ARRAY_SIZE(func_table)) {
711 if (func_table[value])
712 puts_queue(vc, func_table[value]);
714 pr_err("k_fn called with value=%d\n", value);
717 static void k_cur(struct vc_data *vc, unsigned char value, char up_flag)
719 static const char cur_chars[] = "BDCA";
724 applkey(vc, cur_chars[value], vc_kbd_mode(kbd, VC_CKMODE));
727 static void k_pad(struct vc_data *vc, unsigned char value, char up_flag)
729 static const char pad_chars[] = "0123456789+-*/\015,.?()#";
730 static const char app_map[] = "pqrstuvwxylSRQMnnmPQS";
733 return; /* no action, if this is a key release */
735 /* kludge... shift forces cursor/number keys */
736 if (vc_kbd_mode(kbd, VC_APPLIC) && !shift_down[KG_SHIFT]) {
737 applkey(vc, app_map[value], 1);
741 if (!vc_kbd_led(kbd, VC_NUMLOCK)) {
746 k_fn(vc, KVAL(K_REMOVE), 0);
749 k_fn(vc, KVAL(K_INSERT), 0);
752 k_fn(vc, KVAL(K_SELECT), 0);
755 k_cur(vc, KVAL(K_DOWN), 0);
758 k_fn(vc, KVAL(K_PGDN), 0);
761 k_cur(vc, KVAL(K_LEFT), 0);
764 k_cur(vc, KVAL(K_RIGHT), 0);
767 k_fn(vc, KVAL(K_FIND), 0);
770 k_cur(vc, KVAL(K_UP), 0);
773 k_fn(vc, KVAL(K_PGUP), 0);
776 applkey(vc, 'G', vc_kbd_mode(kbd, VC_APPLIC));
781 put_queue(vc, pad_chars[value]);
782 if (value == KVAL(K_PENTER) && vc_kbd_mode(kbd, VC_CRLF))
786 static void k_shift(struct vc_data *vc, unsigned char value, char up_flag)
788 int old_state = shift_state;
794 * a CapsShift key acts like Shift but undoes CapsLock
796 if (value == KVAL(K_CAPSSHIFT)) {
797 value = KVAL(K_SHIFT);
799 clr_vc_kbd_led(kbd, VC_CAPSLOCK);
804 * handle the case that two shift or control
805 * keys are depressed simultaneously
807 if (shift_down[value])
812 if (shift_down[value])
813 shift_state |= (1 << value);
815 shift_state &= ~(1 << value);
818 if (up_flag && shift_state != old_state && npadch != -1) {
819 if (kbd->kbdmode == VC_UNICODE)
822 put_queue(vc, npadch & 0xff);
827 static void k_meta(struct vc_data *vc, unsigned char value, char up_flag)
832 if (vc_kbd_mode(kbd, VC_META)) {
833 put_queue(vc, '\033');
834 put_queue(vc, value);
836 put_queue(vc, value | 0x80);
839 static void k_ascii(struct vc_data *vc, unsigned char value, char up_flag)
847 /* decimal input of code, while Alt depressed */
850 /* hexadecimal input of code, while AltGr depressed */
858 npadch = npadch * base + value;
861 static void k_lock(struct vc_data *vc, unsigned char value, char up_flag)
866 chg_vc_kbd_lock(kbd, value);
869 static void k_slock(struct vc_data *vc, unsigned char value, char up_flag)
871 k_shift(vc, value, up_flag);
875 chg_vc_kbd_slock(kbd, value);
876 /* try to make Alt, oops, AltGr and such work */
877 if (!key_maps[kbd->lockstate ^ kbd->slockstate]) {
879 chg_vc_kbd_slock(kbd, value);
883 /* by default, 300ms interval for combination release */
884 static unsigned brl_timeout = 300;
885 MODULE_PARM_DESC(brl_timeout, "Braille keys release delay in ms (0 for commit on first key release)");
886 module_param(brl_timeout, uint, 0644);
888 static unsigned brl_nbchords = 1;
889 MODULE_PARM_DESC(brl_nbchords, "Number of chords that produce a braille pattern (0 for dead chords)");
890 module_param(brl_nbchords, uint, 0644);
892 static void k_brlcommit(struct vc_data *vc, unsigned int pattern, char up_flag)
894 static unsigned long chords;
895 static unsigned committed;
898 k_deadunicode(vc, BRL_UC_ROW | pattern, up_flag);
900 committed |= pattern;
902 if (chords == brl_nbchords) {
903 k_unicode(vc, BRL_UC_ROW | committed, up_flag);
910 static void k_brl(struct vc_data *vc, unsigned char value, char up_flag)
912 static unsigned pressed, committing;
913 static unsigned long releasestart;
915 if (kbd->kbdmode != VC_UNICODE) {
917 pr_warn("keyboard mode must be unicode for braille patterns\n");
922 k_unicode(vc, BRL_UC_ROW, up_flag);
930 pressed |= 1 << (value - 1);
932 committing = pressed;
933 } else if (brl_timeout) {
936 releasestart + msecs_to_jiffies(brl_timeout))) {
937 committing = pressed;
938 releasestart = jiffies;
940 pressed &= ~(1 << (value - 1));
941 if (!pressed && committing) {
942 k_brlcommit(vc, committing, 0);
947 k_brlcommit(vc, committing, 0);
950 pressed &= ~(1 << (value - 1));
954 #if IS_ENABLED(CONFIG_INPUT_LEDS) && IS_ENABLED(CONFIG_LEDS_TRIGGERS)
956 struct kbd_led_trigger {
957 struct led_trigger trigger;
961 static void kbd_led_trigger_activate(struct led_classdev *cdev)
963 struct kbd_led_trigger *trigger =
964 container_of(cdev->trigger, struct kbd_led_trigger, trigger);
966 tasklet_disable(&keyboard_tasklet);
968 led_trigger_event(&trigger->trigger,
969 ledstate & trigger->mask ?
971 tasklet_enable(&keyboard_tasklet);
974 #define KBD_LED_TRIGGER(_led_bit, _name) { \
977 .activate = kbd_led_trigger_activate, \
979 .mask = BIT(_led_bit), \
982 #define KBD_LOCKSTATE_TRIGGER(_led_bit, _name) \
983 KBD_LED_TRIGGER((_led_bit) + 8, _name)
985 static struct kbd_led_trigger kbd_led_triggers[] = {
986 KBD_LED_TRIGGER(VC_SCROLLOCK, "kbd-scrolllock"),
987 KBD_LED_TRIGGER(VC_NUMLOCK, "kbd-numlock"),
988 KBD_LED_TRIGGER(VC_CAPSLOCK, "kbd-capslock"),
989 KBD_LED_TRIGGER(VC_KANALOCK, "kbd-kanalock"),
991 KBD_LOCKSTATE_TRIGGER(VC_SHIFTLOCK, "kbd-shiftlock"),
992 KBD_LOCKSTATE_TRIGGER(VC_ALTGRLOCK, "kbd-altgrlock"),
993 KBD_LOCKSTATE_TRIGGER(VC_CTRLLOCK, "kbd-ctrllock"),
994 KBD_LOCKSTATE_TRIGGER(VC_ALTLOCK, "kbd-altlock"),
995 KBD_LOCKSTATE_TRIGGER(VC_SHIFTLLOCK, "kbd-shiftllock"),
996 KBD_LOCKSTATE_TRIGGER(VC_SHIFTRLOCK, "kbd-shiftrlock"),
997 KBD_LOCKSTATE_TRIGGER(VC_CTRLLLOCK, "kbd-ctrlllock"),
998 KBD_LOCKSTATE_TRIGGER(VC_CTRLRLOCK, "kbd-ctrlrlock"),
1001 static void kbd_propagate_led_state(unsigned int old_state,
1002 unsigned int new_state)
1004 struct kbd_led_trigger *trigger;
1005 unsigned int changed = old_state ^ new_state;
1008 for (i = 0; i < ARRAY_SIZE(kbd_led_triggers); i++) {
1009 trigger = &kbd_led_triggers[i];
1011 if (changed & trigger->mask)
1012 led_trigger_event(&trigger->trigger,
1013 new_state & trigger->mask ?
1014 LED_FULL : LED_OFF);
1018 static int kbd_update_leds_helper(struct input_handle *handle, void *data)
1020 unsigned int led_state = *(unsigned int *)data;
1022 if (test_bit(EV_LED, handle->dev->evbit))
1023 kbd_propagate_led_state(~led_state, led_state);
1028 static void kbd_init_leds(void)
1033 for (i = 0; i < ARRAY_SIZE(kbd_led_triggers); i++) {
1034 error = led_trigger_register(&kbd_led_triggers[i].trigger);
1036 pr_err("error %d while registering trigger %s\n",
1037 error, kbd_led_triggers[i].trigger.name);
1043 static int kbd_update_leds_helper(struct input_handle *handle, void *data)
1045 unsigned int leds = *(unsigned int *)data;
1047 if (test_bit(EV_LED, handle->dev->evbit)) {
1048 input_inject_event(handle, EV_LED, LED_SCROLLL, !!(leds & 0x01));
1049 input_inject_event(handle, EV_LED, LED_NUML, !!(leds & 0x02));
1050 input_inject_event(handle, EV_LED, LED_CAPSL, !!(leds & 0x04));
1051 input_inject_event(handle, EV_SYN, SYN_REPORT, 0);
1057 static void kbd_propagate_led_state(unsigned int old_state,
1058 unsigned int new_state)
1060 input_handler_for_each_handle(&kbd_handler, &new_state,
1061 kbd_update_leds_helper);
1064 static void kbd_init_leds(void)
1071 * The leds display either (i) the status of NumLock, CapsLock, ScrollLock,
1072 * or (ii) whatever pattern of lights people want to show using KDSETLED,
1073 * or (iii) specified bits of specified words in kernel memory.
1075 static unsigned char getledstate(void)
1077 return ledstate & 0xff;
1080 void setledstate(struct kbd_struct *kb, unsigned int led)
1082 unsigned long flags;
1083 spin_lock_irqsave(&led_lock, flags);
1086 kb->ledmode = LED_SHOW_IOCTL;
1088 kb->ledmode = LED_SHOW_FLAGS;
1091 spin_unlock_irqrestore(&led_lock, flags);
1094 static inline unsigned char getleds(void)
1096 struct kbd_struct *kb = kbd_table + fg_console;
1098 if (kb->ledmode == LED_SHOW_IOCTL)
1101 return kb->ledflagstate;
1105 * vt_get_leds - helper for braille console
1106 * @console: console to read
1107 * @flag: flag we want to check
1109 * Check the status of a keyboard led flag and report it back
1111 int vt_get_leds(int console, int flag)
1113 struct kbd_struct *kb = kbd_table + console;
1115 unsigned long flags;
1117 spin_lock_irqsave(&led_lock, flags);
1118 ret = vc_kbd_led(kb, flag);
1119 spin_unlock_irqrestore(&led_lock, flags);
1123 EXPORT_SYMBOL_GPL(vt_get_leds);
1126 * vt_set_led_state - set LED state of a console
1127 * @console: console to set
1130 * Set the LEDs on a console. This is a wrapper for the VT layer
1131 * so that we can keep kbd knowledge internal
1133 void vt_set_led_state(int console, int leds)
1135 struct kbd_struct *kb = kbd_table + console;
1136 setledstate(kb, leds);
1140 * vt_kbd_con_start - Keyboard side of console start
1143 * Handle console start. This is a wrapper for the VT layer
1144 * so that we can keep kbd knowledge internal
1146 * FIXME: We eventually need to hold the kbd lock here to protect
1147 * the LED updating. We can't do it yet because fn_hold calls stop_tty
1148 * and start_tty under the kbd_event_lock, while normal tty paths
1149 * don't hold the lock. We probably need to split out an LED lock
1150 * but not during an -rc release!
1152 void vt_kbd_con_start(int console)
1154 struct kbd_struct *kb = kbd_table + console;
1155 unsigned long flags;
1156 spin_lock_irqsave(&led_lock, flags);
1157 clr_vc_kbd_led(kb, VC_SCROLLOCK);
1159 spin_unlock_irqrestore(&led_lock, flags);
1163 * vt_kbd_con_stop - Keyboard side of console stop
1166 * Handle console stop. This is a wrapper for the VT layer
1167 * so that we can keep kbd knowledge internal
1169 void vt_kbd_con_stop(int console)
1171 struct kbd_struct *kb = kbd_table + console;
1172 unsigned long flags;
1173 spin_lock_irqsave(&led_lock, flags);
1174 set_vc_kbd_led(kb, VC_SCROLLOCK);
1176 spin_unlock_irqrestore(&led_lock, flags);
1180 * This is the tasklet that updates LED state of LEDs using standard
1181 * keyboard triggers. The reason we use tasklet is that we need to
1182 * handle the scenario when keyboard handler is not registered yet
1183 * but we already getting updates from the VT to update led state.
1185 static void kbd_bh(unsigned long dummy)
1188 unsigned long flags;
1190 spin_lock_irqsave(&led_lock, flags);
1192 leds |= (unsigned int)kbd->lockstate << 8;
1193 spin_unlock_irqrestore(&led_lock, flags);
1195 if (leds != ledstate) {
1196 kbd_propagate_led_state(ledstate, leds);
1201 DECLARE_TASKLET_DISABLED(keyboard_tasklet, kbd_bh, 0);
1203 #if defined(CONFIG_X86) || defined(CONFIG_IA64) || defined(CONFIG_ALPHA) ||\
1204 defined(CONFIG_MIPS) || defined(CONFIG_PPC) || defined(CONFIG_SPARC) ||\
1205 defined(CONFIG_PARISC) || defined(CONFIG_SUPERH) ||\
1206 (defined(CONFIG_ARM) && defined(CONFIG_KEYBOARD_ATKBD) && !defined(CONFIG_ARCH_RPC)) ||\
1207 defined(CONFIG_AVR32)
1209 #define HW_RAW(dev) (test_bit(EV_MSC, dev->evbit) && test_bit(MSC_RAW, dev->mscbit) &&\
1210 ((dev)->id.bustype == BUS_I8042) && ((dev)->id.vendor == 0x0001) && ((dev)->id.product == 0x0001))
1212 static const unsigned short x86_keycodes[256] =
1213 { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15,
1214 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31,
1215 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47,
1216 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63,
1217 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79,
1218 80, 81, 82, 83, 84,118, 86, 87, 88,115,120,119,121,112,123, 92,
1219 284,285,309, 0,312, 91,327,328,329,331,333,335,336,337,338,339,
1220 367,288,302,304,350, 89,334,326,267,126,268,269,125,347,348,349,
1221 360,261,262,263,268,376,100,101,321,316,373,286,289,102,351,355,
1222 103,104,105,275,287,279,258,106,274,107,294,364,358,363,362,361,
1223 291,108,381,281,290,272,292,305,280, 99,112,257,306,359,113,114,
1224 264,117,271,374,379,265,266, 93, 94, 95, 85,259,375,260, 90,116,
1225 377,109,111,277,278,282,283,295,296,297,299,300,301,293,303,307,
1226 308,310,313,314,315,317,318,319,320,357,322,323,324,325,276,330,
1227 332,340,365,342,343,344,345,346,356,270,341,368,369,370,371,372 };
1230 static int sparc_l1_a_state;
1231 extern void sun_do_break(void);
1234 static int emulate_raw(struct vc_data *vc, unsigned int keycode,
1235 unsigned char up_flag)
1242 put_queue(vc, 0xe1);
1243 put_queue(vc, 0x1d | up_flag);
1244 put_queue(vc, 0x45 | up_flag);
1249 put_queue(vc, 0xf2);
1254 put_queue(vc, 0xf1);
1259 * Real AT keyboards (that's what we're trying
1260 * to emulate here) emit 0xe0 0x2a 0xe0 0x37 when
1261 * pressing PrtSc/SysRq alone, but simply 0x54
1262 * when pressing Alt+PrtSc/SysRq.
1264 if (test_bit(KEY_LEFTALT, key_down) ||
1265 test_bit(KEY_RIGHTALT, key_down)) {
1266 put_queue(vc, 0x54 | up_flag);
1268 put_queue(vc, 0xe0);
1269 put_queue(vc, 0x2a | up_flag);
1270 put_queue(vc, 0xe0);
1271 put_queue(vc, 0x37 | up_flag);
1279 code = x86_keycodes[keycode];
1284 put_queue(vc, 0xe0);
1285 put_queue(vc, (code & 0x7f) | up_flag);
1295 #define HW_RAW(dev) 0
1297 static int emulate_raw(struct vc_data *vc, unsigned int keycode, unsigned char up_flag)
1302 put_queue(vc, keycode | up_flag);
1307 static void kbd_rawcode(unsigned char data)
1309 struct vc_data *vc = vc_cons[fg_console].d;
1311 kbd = kbd_table + vc->vc_num;
1312 if (kbd->kbdmode == VC_RAW)
1313 put_queue(vc, data);
1316 static void kbd_keycode(unsigned int keycode, int down, int hw_raw)
1318 struct vc_data *vc = vc_cons[fg_console].d;
1319 unsigned short keysym, *key_map;
1322 struct tty_struct *tty;
1324 struct keyboard_notifier_param param = { .vc = vc, .value = keycode, .down = down };
1329 if (tty && (!tty->driver_data)) {
1330 /* No driver data? Strange. Okay we fix it then. */
1331 tty->driver_data = vc;
1334 kbd = kbd_table + vc->vc_num;
1337 if (keycode == KEY_STOP)
1338 sparc_l1_a_state = down;
1343 raw_mode = (kbd->kbdmode == VC_RAW);
1344 if (raw_mode && !hw_raw)
1345 if (emulate_raw(vc, keycode, !down << 7))
1346 if (keycode < BTN_MISC && printk_ratelimit())
1347 pr_warn("can't emulate rawmode for keycode %d\n",
1351 if (keycode == KEY_A && sparc_l1_a_state) {
1352 sparc_l1_a_state = false;
1357 if (kbd->kbdmode == VC_MEDIUMRAW) {
1359 * This is extended medium raw mode, with keys above 127
1360 * encoded as 0, high 7 bits, low 7 bits, with the 0 bearing
1361 * the 'up' flag if needed. 0 is reserved, so this shouldn't
1362 * interfere with anything else. The two bytes after 0 will
1363 * always have the up flag set not to interfere with older
1364 * applications. This allows for 16384 different keycodes,
1365 * which should be enough.
1367 if (keycode < 128) {
1368 put_queue(vc, keycode | (!down << 7));
1370 put_queue(vc, !down << 7);
1371 put_queue(vc, (keycode >> 7) | 0x80);
1372 put_queue(vc, keycode | 0x80);
1378 set_bit(keycode, key_down);
1380 clear_bit(keycode, key_down);
1383 (!vc_kbd_mode(kbd, VC_REPEAT) ||
1384 (tty && !L_ECHO(tty) && tty_chars_in_buffer(tty)))) {
1386 * Don't repeat a key if the input buffers are not empty and the
1387 * characters get aren't echoed locally. This makes key repeat
1388 * usable with slow applications and under heavy loads.
1393 param.shift = shift_final = (shift_state | kbd->slockstate) ^ kbd->lockstate;
1394 param.ledstate = kbd->ledflagstate;
1395 key_map = key_maps[shift_final];
1397 rc = atomic_notifier_call_chain(&keyboard_notifier_list,
1398 KBD_KEYCODE, ¶m);
1399 if (rc == NOTIFY_STOP || !key_map) {
1400 atomic_notifier_call_chain(&keyboard_notifier_list,
1401 KBD_UNBOUND_KEYCODE, ¶m);
1402 do_compute_shiftstate();
1403 kbd->slockstate = 0;
1407 if (keycode < NR_KEYS)
1408 keysym = key_map[keycode];
1409 else if (keycode >= KEY_BRL_DOT1 && keycode <= KEY_BRL_DOT8)
1410 keysym = U(K(KT_BRL, keycode - KEY_BRL_DOT1 + 1));
1414 type = KTYP(keysym);
1417 param.value = keysym;
1418 rc = atomic_notifier_call_chain(&keyboard_notifier_list,
1419 KBD_UNICODE, ¶m);
1420 if (rc != NOTIFY_STOP)
1421 if (down && !raw_mode)
1422 to_utf8(vc, keysym);
1428 if (type == KT_LETTER) {
1430 if (vc_kbd_led(kbd, VC_CAPSLOCK)) {
1431 key_map = key_maps[shift_final ^ (1 << KG_SHIFT)];
1433 keysym = key_map[keycode];
1437 param.value = keysym;
1438 rc = atomic_notifier_call_chain(&keyboard_notifier_list,
1439 KBD_KEYSYM, ¶m);
1440 if (rc == NOTIFY_STOP)
1443 if ((raw_mode || kbd->kbdmode == VC_OFF) && type != KT_SPEC && type != KT_SHIFT)
1446 (*k_handler[type])(vc, keysym & 0xff, !down);
1448 param.ledstate = kbd->ledflagstate;
1449 atomic_notifier_call_chain(&keyboard_notifier_list, KBD_POST_KEYSYM, ¶m);
1451 if (type != KT_SLOCK)
1452 kbd->slockstate = 0;
1455 static void kbd_event(struct input_handle *handle, unsigned int event_type,
1456 unsigned int event_code, int value)
1458 /* We are called with interrupts disabled, just take the lock */
1459 spin_lock(&kbd_event_lock);
1461 if (event_type == EV_MSC && event_code == MSC_RAW && HW_RAW(handle->dev))
1463 if (event_type == EV_KEY)
1464 kbd_keycode(event_code, value, HW_RAW(handle->dev));
1466 spin_unlock(&kbd_event_lock);
1468 tasklet_schedule(&keyboard_tasklet);
1469 do_poke_blanked_console = 1;
1470 schedule_console_callback();
1473 static bool kbd_match(struct input_handler *handler, struct input_dev *dev)
1477 if (test_bit(EV_SND, dev->evbit))
1480 if (test_bit(EV_KEY, dev->evbit)) {
1481 for (i = KEY_RESERVED; i < BTN_MISC; i++)
1482 if (test_bit(i, dev->keybit))
1484 for (i = KEY_BRL_DOT1; i <= KEY_BRL_DOT10; i++)
1485 if (test_bit(i, dev->keybit))
1493 * When a keyboard (or other input device) is found, the kbd_connect
1494 * function is called. The function then looks at the device, and if it
1495 * likes it, it can open it and get events from it. In this (kbd_connect)
1496 * function, we should decide which VT to bind that keyboard to initially.
1498 static int kbd_connect(struct input_handler *handler, struct input_dev *dev,
1499 const struct input_device_id *id)
1501 struct input_handle *handle;
1504 handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL);
1509 handle->handler = handler;
1510 handle->name = "kbd";
1512 error = input_register_handle(handle);
1514 goto err_free_handle;
1516 error = input_open_device(handle);
1518 goto err_unregister_handle;
1522 err_unregister_handle:
1523 input_unregister_handle(handle);
1529 static void kbd_disconnect(struct input_handle *handle)
1531 input_close_device(handle);
1532 input_unregister_handle(handle);
1537 * Start keyboard handler on the new keyboard by refreshing LED state to
1538 * match the rest of the system.
1540 static void kbd_start(struct input_handle *handle)
1542 tasklet_disable(&keyboard_tasklet);
1544 if (ledstate != -1U)
1545 kbd_update_leds_helper(handle, &ledstate);
1547 tasklet_enable(&keyboard_tasklet);
1550 static const struct input_device_id kbd_ids[] = {
1552 .flags = INPUT_DEVICE_ID_MATCH_EVBIT,
1553 .evbit = { BIT_MASK(EV_KEY) },
1557 .flags = INPUT_DEVICE_ID_MATCH_EVBIT,
1558 .evbit = { BIT_MASK(EV_SND) },
1561 { }, /* Terminating entry */
1564 MODULE_DEVICE_TABLE(input, kbd_ids);
1566 static struct input_handler kbd_handler = {
1569 .connect = kbd_connect,
1570 .disconnect = kbd_disconnect,
1573 .id_table = kbd_ids,
1576 int __init kbd_init(void)
1581 for (i = 0; i < MAX_NR_CONSOLES; i++) {
1582 kbd_table[i].ledflagstate = kbd_defleds();
1583 kbd_table[i].default_ledflagstate = kbd_defleds();
1584 kbd_table[i].ledmode = LED_SHOW_FLAGS;
1585 kbd_table[i].lockstate = KBD_DEFLOCK;
1586 kbd_table[i].slockstate = 0;
1587 kbd_table[i].modeflags = KBD_DEFMODE;
1588 kbd_table[i].kbdmode = default_utf8 ? VC_UNICODE : VC_XLATE;
1593 error = input_register_handler(&kbd_handler);
1597 tasklet_enable(&keyboard_tasklet);
1598 tasklet_schedule(&keyboard_tasklet);
1603 /* Ioctl support code */
1606 * vt_do_diacrit - diacritical table updates
1607 * @cmd: ioctl request
1608 * @udp: pointer to user data for ioctl
1609 * @perm: permissions check computed by caller
1611 * Update the diacritical tables atomically and safely. Lock them
1612 * against simultaneous keypresses
1614 int vt_do_diacrit(unsigned int cmd, void __user *udp, int perm)
1616 unsigned long flags;
1623 struct kbdiacrs __user *a = udp;
1624 struct kbdiacr *dia;
1627 dia = kmalloc(MAX_DIACR * sizeof(struct kbdiacr),
1632 /* Lock the diacriticals table, make a copy and then
1633 copy it after we unlock */
1634 spin_lock_irqsave(&kbd_event_lock, flags);
1636 asize = accent_table_size;
1637 for (i = 0; i < asize; i++) {
1638 dia[i].diacr = conv_uni_to_8bit(
1639 accent_table[i].diacr);
1640 dia[i].base = conv_uni_to_8bit(
1641 accent_table[i].base);
1642 dia[i].result = conv_uni_to_8bit(
1643 accent_table[i].result);
1645 spin_unlock_irqrestore(&kbd_event_lock, flags);
1647 if (put_user(asize, &a->kb_cnt))
1649 else if (copy_to_user(a->kbdiacr, dia,
1650 asize * sizeof(struct kbdiacr)))
1657 struct kbdiacrsuc __user *a = udp;
1660 buf = kmalloc(MAX_DIACR * sizeof(struct kbdiacruc),
1665 /* Lock the diacriticals table, make a copy and then
1666 copy it after we unlock */
1667 spin_lock_irqsave(&kbd_event_lock, flags);
1669 asize = accent_table_size;
1670 memcpy(buf, accent_table, asize * sizeof(struct kbdiacruc));
1672 spin_unlock_irqrestore(&kbd_event_lock, flags);
1674 if (put_user(asize, &a->kb_cnt))
1676 else if (copy_to_user(a->kbdiacruc, buf,
1677 asize*sizeof(struct kbdiacruc)))
1685 struct kbdiacrs __user *a = udp;
1686 struct kbdiacr *dia = NULL;
1692 if (get_user(ct, &a->kb_cnt))
1694 if (ct >= MAX_DIACR)
1699 dia = memdup_user(a->kbdiacr,
1700 sizeof(struct kbdiacr) * ct);
1702 return PTR_ERR(dia);
1706 spin_lock_irqsave(&kbd_event_lock, flags);
1707 accent_table_size = ct;
1708 for (i = 0; i < ct; i++) {
1709 accent_table[i].diacr =
1710 conv_8bit_to_uni(dia[i].diacr);
1711 accent_table[i].base =
1712 conv_8bit_to_uni(dia[i].base);
1713 accent_table[i].result =
1714 conv_8bit_to_uni(dia[i].result);
1716 spin_unlock_irqrestore(&kbd_event_lock, flags);
1723 struct kbdiacrsuc __user *a = udp;
1730 if (get_user(ct, &a->kb_cnt))
1733 if (ct >= MAX_DIACR)
1737 buf = memdup_user(a->kbdiacruc,
1738 ct * sizeof(struct kbdiacruc));
1740 return PTR_ERR(buf);
1742 spin_lock_irqsave(&kbd_event_lock, flags);
1744 memcpy(accent_table, buf,
1745 ct * sizeof(struct kbdiacruc));
1746 accent_table_size = ct;
1747 spin_unlock_irqrestore(&kbd_event_lock, flags);
1756 * vt_do_kdskbmode - set keyboard mode ioctl
1757 * @console: the console to use
1758 * @arg: the requested mode
1760 * Update the keyboard mode bits while holding the correct locks.
1761 * Return 0 for success or an error code.
1763 int vt_do_kdskbmode(int console, unsigned int arg)
1765 struct kbd_struct *kb = kbd_table + console;
1767 unsigned long flags;
1769 spin_lock_irqsave(&kbd_event_lock, flags);
1772 kb->kbdmode = VC_RAW;
1775 kb->kbdmode = VC_MEDIUMRAW;
1778 kb->kbdmode = VC_XLATE;
1779 do_compute_shiftstate();
1782 kb->kbdmode = VC_UNICODE;
1783 do_compute_shiftstate();
1786 kb->kbdmode = VC_OFF;
1791 spin_unlock_irqrestore(&kbd_event_lock, flags);
1796 * vt_do_kdskbmeta - set keyboard meta state
1797 * @console: the console to use
1798 * @arg: the requested meta state
1800 * Update the keyboard meta bits while holding the correct locks.
1801 * Return 0 for success or an error code.
1803 int vt_do_kdskbmeta(int console, unsigned int arg)
1805 struct kbd_struct *kb = kbd_table + console;
1807 unsigned long flags;
1809 spin_lock_irqsave(&kbd_event_lock, flags);
1812 clr_vc_kbd_mode(kb, VC_META);
1815 set_vc_kbd_mode(kb, VC_META);
1820 spin_unlock_irqrestore(&kbd_event_lock, flags);
1824 int vt_do_kbkeycode_ioctl(int cmd, struct kbkeycode __user *user_kbkc,
1827 struct kbkeycode tmp;
1830 if (copy_from_user(&tmp, user_kbkc, sizeof(struct kbkeycode)))
1834 kc = getkeycode(tmp.scancode);
1836 kc = put_user(kc, &user_kbkc->keycode);
1841 kc = setkeycode(tmp.scancode, tmp.keycode);
1847 #define i (tmp.kb_index)
1848 #define s (tmp.kb_table)
1849 #define v (tmp.kb_value)
1851 int vt_do_kdsk_ioctl(int cmd, struct kbentry __user *user_kbe, int perm,
1854 struct kbd_struct *kb = kbd_table + console;
1856 ushort *key_map, *new_map, val, ov;
1857 unsigned long flags;
1859 if (copy_from_user(&tmp, user_kbe, sizeof(struct kbentry)))
1862 if (!capable(CAP_SYS_TTY_CONFIG))
1867 /* Ensure another thread doesn't free it under us */
1868 spin_lock_irqsave(&kbd_event_lock, flags);
1869 key_map = key_maps[s];
1871 val = U(key_map[i]);
1872 if (kb->kbdmode != VC_UNICODE && KTYP(val) >= NR_TYPES)
1875 val = (i ? K_HOLE : K_NOSUCHMAP);
1876 spin_unlock_irqrestore(&kbd_event_lock, flags);
1877 return put_user(val, &user_kbe->kb_value);
1881 if (!i && v == K_NOSUCHMAP) {
1882 spin_lock_irqsave(&kbd_event_lock, flags);
1883 /* deallocate map */
1884 key_map = key_maps[s];
1887 if (key_map[0] == U(K_ALLOCATED)) {
1892 spin_unlock_irqrestore(&kbd_event_lock, flags);
1896 if (KTYP(v) < NR_TYPES) {
1897 if (KVAL(v) > max_vals[KTYP(v)])
1900 if (kb->kbdmode != VC_UNICODE)
1903 /* ++Geert: non-PC keyboards may generate keycode zero */
1904 #if !defined(__mc68000__) && !defined(__powerpc__)
1905 /* assignment to entry 0 only tests validity of args */
1910 new_map = kmalloc(sizeof(plain_map), GFP_KERNEL);
1913 spin_lock_irqsave(&kbd_event_lock, flags);
1914 key_map = key_maps[s];
1915 if (key_map == NULL) {
1918 if (keymap_count >= MAX_NR_OF_USER_KEYMAPS &&
1919 !capable(CAP_SYS_RESOURCE)) {
1920 spin_unlock_irqrestore(&kbd_event_lock, flags);
1924 key_maps[s] = new_map;
1926 key_map[0] = U(K_ALLOCATED);
1927 for (j = 1; j < NR_KEYS; j++)
1928 key_map[j] = U(K_HOLE);
1939 if (((ov == K_SAK) || (v == K_SAK)) && !capable(CAP_SYS_ADMIN)) {
1940 spin_unlock_irqrestore(&kbd_event_lock, flags);
1944 if (!s && (KTYP(ov) == KT_SHIFT || KTYP(v) == KT_SHIFT))
1945 do_compute_shiftstate();
1947 spin_unlock_irqrestore(&kbd_event_lock, flags);
1956 /* FIXME: This one needs untangling and locking */
1957 int vt_do_kdgkb_ioctl(int cmd, struct kbsentry __user *user_kdgkb, int perm)
1959 struct kbsentry *kbs;
1965 char *first_free, *fj, *fnw;
1969 if (!capable(CAP_SYS_TTY_CONFIG))
1972 kbs = kmalloc(sizeof(*kbs), GFP_KERNEL);
1978 /* we mostly copy too much here (512bytes), but who cares ;) */
1979 if (copy_from_user(kbs, user_kdgkb, sizeof(struct kbsentry))) {
1983 kbs->kb_string[sizeof(kbs->kb_string)-1] = '\0';
1988 sz = sizeof(kbs->kb_string) - 1; /* sz should have been
1990 up = user_kdgkb->kb_string;
1993 for ( ; *p && sz; p++, sz--)
1994 if (put_user(*p, up++)) {
1998 if (put_user('\0', up)) {
2003 return ((p && *p) ? -EOVERFLOW : 0);
2011 first_free = funcbufptr + (funcbufsize - funcbufleft);
2012 for (j = i+1; j < MAX_NR_FUNC && !func_table[j]; j++)
2014 if (j < MAX_NR_FUNC)
2019 delta = (q ? -strlen(q) : 1) + strlen(kbs->kb_string);
2020 if (delta <= funcbufleft) { /* it fits in current buf */
2021 if (j < MAX_NR_FUNC) {
2022 memmove(fj + delta, fj, first_free - fj);
2023 for (k = j; k < MAX_NR_FUNC; k++)
2025 func_table[k] += delta;
2029 funcbufleft -= delta;
2030 } else { /* allocate a larger buffer */
2032 while (sz < funcbufsize - funcbufleft + delta)
2034 fnw = kmalloc(sz, GFP_KERNEL);
2042 if (fj > funcbufptr)
2043 memmove(fnw, funcbufptr, fj - funcbufptr);
2044 for (k = 0; k < j; k++)
2046 func_table[k] = fnw + (func_table[k] - funcbufptr);
2048 if (first_free > fj) {
2049 memmove(fnw + (fj - funcbufptr) + delta, fj, first_free - fj);
2050 for (k = j; k < MAX_NR_FUNC; k++)
2052 func_table[k] = fnw + (func_table[k] - funcbufptr) + delta;
2054 if (funcbufptr != func_buf)
2057 funcbufleft = funcbufleft - delta + sz - funcbufsize;
2060 strcpy(func_table[i], kbs->kb_string);
2069 int vt_do_kdskled(int console, int cmd, unsigned long arg, int perm)
2071 struct kbd_struct *kb = kbd_table + console;
2072 unsigned long flags;
2073 unsigned char ucval;
2076 /* the ioctls below read/set the flags usually shown in the leds */
2077 /* don't use them - they will go away without warning */
2079 spin_lock_irqsave(&kbd_event_lock, flags);
2080 ucval = kb->ledflagstate | (kb->default_ledflagstate << 4);
2081 spin_unlock_irqrestore(&kbd_event_lock, flags);
2082 return put_user(ucval, (char __user *)arg);
2089 spin_lock_irqsave(&led_lock, flags);
2090 kb->ledflagstate = (arg & 7);
2091 kb->default_ledflagstate = ((arg >> 4) & 7);
2093 spin_unlock_irqrestore(&led_lock, flags);
2096 /* the ioctls below only set the lights, not the functions */
2097 /* for those, see KDGKBLED and KDSKBLED above */
2099 ucval = getledstate();
2100 return put_user(ucval, (char __user *)arg);
2105 setledstate(kb, arg);
2108 return -ENOIOCTLCMD;
2111 int vt_do_kdgkbmode(int console)
2113 struct kbd_struct *kb = kbd_table + console;
2114 /* This is a spot read so needs no locking */
2115 switch (kb->kbdmode) {
2130 * vt_do_kdgkbmeta - report meta status
2131 * @console: console to report
2133 * Report the meta flag status of this console
2135 int vt_do_kdgkbmeta(int console)
2137 struct kbd_struct *kb = kbd_table + console;
2138 /* Again a spot read so no locking */
2139 return vc_kbd_mode(kb, VC_META) ? K_ESCPREFIX : K_METABIT;
2143 * vt_reset_unicode - reset the unicode status
2144 * @console: console being reset
2146 * Restore the unicode console state to its default
2148 void vt_reset_unicode(int console)
2150 unsigned long flags;
2152 spin_lock_irqsave(&kbd_event_lock, flags);
2153 kbd_table[console].kbdmode = default_utf8 ? VC_UNICODE : VC_XLATE;
2154 spin_unlock_irqrestore(&kbd_event_lock, flags);
2158 * vt_get_shiftstate - shift bit state
2160 * Report the shift bits from the keyboard state. We have to export
2161 * this to support some oddities in the vt layer.
2163 int vt_get_shift_state(void)
2165 /* Don't lock as this is a transient report */
2170 * vt_reset_keyboard - reset keyboard state
2171 * @console: console to reset
2173 * Reset the keyboard bits for a console as part of a general console
2176 void vt_reset_keyboard(int console)
2178 struct kbd_struct *kb = kbd_table + console;
2179 unsigned long flags;
2181 spin_lock_irqsave(&kbd_event_lock, flags);
2182 set_vc_kbd_mode(kb, VC_REPEAT);
2183 clr_vc_kbd_mode(kb, VC_CKMODE);
2184 clr_vc_kbd_mode(kb, VC_APPLIC);
2185 clr_vc_kbd_mode(kb, VC_CRLF);
2188 spin_lock(&led_lock);
2189 kb->ledmode = LED_SHOW_FLAGS;
2190 kb->ledflagstate = kb->default_ledflagstate;
2191 spin_unlock(&led_lock);
2192 /* do not do set_leds here because this causes an endless tasklet loop
2193 when the keyboard hasn't been initialized yet */
2194 spin_unlock_irqrestore(&kbd_event_lock, flags);
2198 * vt_get_kbd_mode_bit - read keyboard status bits
2199 * @console: console to read from
2200 * @bit: mode bit to read
2202 * Report back a vt mode bit. We do this without locking so the
2203 * caller must be sure that there are no synchronization needs
2206 int vt_get_kbd_mode_bit(int console, int bit)
2208 struct kbd_struct *kb = kbd_table + console;
2209 return vc_kbd_mode(kb, bit);
2213 * vt_set_kbd_mode_bit - read keyboard status bits
2214 * @console: console to read from
2215 * @bit: mode bit to read
2217 * Set a vt mode bit. We do this without locking so the
2218 * caller must be sure that there are no synchronization needs
2221 void vt_set_kbd_mode_bit(int console, int bit)
2223 struct kbd_struct *kb = kbd_table + console;
2224 unsigned long flags;
2226 spin_lock_irqsave(&kbd_event_lock, flags);
2227 set_vc_kbd_mode(kb, bit);
2228 spin_unlock_irqrestore(&kbd_event_lock, flags);
2232 * vt_clr_kbd_mode_bit - read keyboard status bits
2233 * @console: console to read from
2234 * @bit: mode bit to read
2236 * Report back a vt mode bit. We do this without locking so the
2237 * caller must be sure that there are no synchronization needs
2240 void vt_clr_kbd_mode_bit(int console, int bit)
2242 struct kbd_struct *kb = kbd_table + console;
2243 unsigned long flags;
2245 spin_lock_irqsave(&kbd_event_lock, flags);
2246 clr_vc_kbd_mode(kb, bit);
2247 spin_unlock_irqrestore(&kbd_event_lock, flags);