rt2800: initialize BBP_R104 on proper subroutines
[linux/fpc-iii.git] / drivers / tty / vt / keyboard.c
bloba9af1b9ae160ec1b9bd47d4e9c1dfcabb27a2db9
1 /*
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.h>
30 #include <linux/tty.h>
31 #include <linux/tty_flip.h>
32 #include <linux/mm.h>
33 #include <linux/string.h>
34 #include <linux/init.h>
35 #include <linux/slab.h>
37 #include <linux/kbd_kern.h>
38 #include <linux/kbd_diacr.h>
39 #include <linux/vt_kern.h>
40 #include <linux/input.h>
41 #include <linux/reboot.h>
42 #include <linux/notifier.h>
43 #include <linux/jiffies.h>
44 #include <linux/uaccess.h>
46 #include <asm/irq_regs.h>
48 extern void ctrl_alt_del(void);
51 * Exported functions/variables
54 #define KBD_DEFMODE ((1 << VC_REPEAT) | (1 << VC_META))
56 #if defined(CONFIG_X86) || defined(CONFIG_PARISC)
57 #include <asm/kbdleds.h>
58 #else
59 static inline int kbd_defleds(void)
61 return 0;
63 #endif
65 #define KBD_DEFLOCK 0
68 * Handler Tables.
71 #define K_HANDLERS\
72 k_self, k_fn, k_spec, k_pad,\
73 k_dead, k_cons, k_cur, k_shift,\
74 k_meta, k_ascii, k_lock, k_lowercase,\
75 k_slock, k_dead2, k_brl, k_ignore
77 typedef void (k_handler_fn)(struct vc_data *vc, unsigned char value,
78 char up_flag);
79 static k_handler_fn K_HANDLERS;
80 static k_handler_fn *k_handler[16] = { K_HANDLERS };
82 #define FN_HANDLERS\
83 fn_null, fn_enter, fn_show_ptregs, fn_show_mem,\
84 fn_show_state, fn_send_intr, fn_lastcons, fn_caps_toggle,\
85 fn_num, fn_hold, fn_scroll_forw, fn_scroll_back,\
86 fn_boot_it, fn_caps_on, fn_compose, fn_SAK,\
87 fn_dec_console, fn_inc_console, fn_spawn_con, fn_bare_num
89 typedef void (fn_handler_fn)(struct vc_data *vc);
90 static fn_handler_fn FN_HANDLERS;
91 static fn_handler_fn *fn_handler[] = { FN_HANDLERS };
94 * Variables exported for vt_ioctl.c
97 struct vt_spawn_console vt_spawn_con = {
98 .lock = __SPIN_LOCK_UNLOCKED(vt_spawn_con.lock),
99 .pid = NULL,
100 .sig = 0,
105 * Internal Data.
108 static struct kbd_struct kbd_table[MAX_NR_CONSOLES];
109 static struct kbd_struct *kbd = kbd_table;
111 /* maximum values each key_handler can handle */
112 static const int max_vals[] = {
113 255, ARRAY_SIZE(func_table) - 1, ARRAY_SIZE(fn_handler) - 1, NR_PAD - 1,
114 NR_DEAD - 1, 255, 3, NR_SHIFT - 1, 255, NR_ASCII - 1, NR_LOCK - 1,
115 255, NR_LOCK - 1, 255, NR_BRL - 1
118 static const int NR_TYPES = ARRAY_SIZE(max_vals);
120 static struct input_handler kbd_handler;
121 static DEFINE_SPINLOCK(kbd_event_lock);
122 static DEFINE_SPINLOCK(led_lock);
123 static unsigned long key_down[BITS_TO_LONGS(KEY_CNT)]; /* keyboard key bitmap */
124 static unsigned char shift_down[NR_SHIFT]; /* shift state counters.. */
125 static bool dead_key_next;
126 static int npadch = -1; /* -1 or number assembled on pad */
127 static unsigned int diacr;
128 static char rep; /* flag telling character repeat */
130 static int shift_state = 0;
132 static unsigned char ledstate = 0xff; /* undefined */
133 static unsigned char ledioctl;
135 static struct ledptr {
136 unsigned int *addr;
137 unsigned int mask;
138 unsigned char valid:1;
139 } ledptrs[3];
142 * Notifier list for console keyboard events
144 static ATOMIC_NOTIFIER_HEAD(keyboard_notifier_list);
146 int register_keyboard_notifier(struct notifier_block *nb)
148 return atomic_notifier_chain_register(&keyboard_notifier_list, nb);
150 EXPORT_SYMBOL_GPL(register_keyboard_notifier);
152 int unregister_keyboard_notifier(struct notifier_block *nb)
154 return atomic_notifier_chain_unregister(&keyboard_notifier_list, nb);
156 EXPORT_SYMBOL_GPL(unregister_keyboard_notifier);
159 * Translation of scancodes to keycodes. We set them on only the first
160 * keyboard in the list that accepts the scancode and keycode.
161 * Explanation for not choosing the first attached keyboard anymore:
162 * USB keyboards for example have two event devices: one for all "normal"
163 * keys and one for extra function keys (like "volume up", "make coffee",
164 * etc.). So this means that scancodes for the extra function keys won't
165 * be valid for the first event device, but will be for the second.
168 struct getset_keycode_data {
169 struct input_keymap_entry ke;
170 int error;
173 static int getkeycode_helper(struct input_handle *handle, void *data)
175 struct getset_keycode_data *d = data;
177 d->error = input_get_keycode(handle->dev, &d->ke);
179 return d->error == 0; /* stop as soon as we successfully get one */
182 static int getkeycode(unsigned int scancode)
184 struct getset_keycode_data d = {
185 .ke = {
186 .flags = 0,
187 .len = sizeof(scancode),
188 .keycode = 0,
190 .error = -ENODEV,
193 memcpy(d.ke.scancode, &scancode, sizeof(scancode));
195 input_handler_for_each_handle(&kbd_handler, &d, getkeycode_helper);
197 return d.error ?: d.ke.keycode;
200 static int setkeycode_helper(struct input_handle *handle, void *data)
202 struct getset_keycode_data *d = data;
204 d->error = input_set_keycode(handle->dev, &d->ke);
206 return d->error == 0; /* stop as soon as we successfully set one */
209 static int setkeycode(unsigned int scancode, unsigned int keycode)
211 struct getset_keycode_data d = {
212 .ke = {
213 .flags = 0,
214 .len = sizeof(scancode),
215 .keycode = keycode,
217 .error = -ENODEV,
220 memcpy(d.ke.scancode, &scancode, sizeof(scancode));
222 input_handler_for_each_handle(&kbd_handler, &d, setkeycode_helper);
224 return d.error;
228 * Making beeps and bells. Note that we prefer beeps to bells, but when
229 * shutting the sound off we do both.
232 static int kd_sound_helper(struct input_handle *handle, void *data)
234 unsigned int *hz = data;
235 struct input_dev *dev = handle->dev;
237 if (test_bit(EV_SND, dev->evbit)) {
238 if (test_bit(SND_TONE, dev->sndbit)) {
239 input_inject_event(handle, EV_SND, SND_TONE, *hz);
240 if (*hz)
241 return 0;
243 if (test_bit(SND_BELL, dev->sndbit))
244 input_inject_event(handle, EV_SND, SND_BELL, *hz ? 1 : 0);
247 return 0;
250 static void kd_nosound(unsigned long ignored)
252 static unsigned int zero;
254 input_handler_for_each_handle(&kbd_handler, &zero, kd_sound_helper);
257 static DEFINE_TIMER(kd_mksound_timer, kd_nosound, 0, 0);
259 void kd_mksound(unsigned int hz, unsigned int ticks)
261 del_timer_sync(&kd_mksound_timer);
263 input_handler_for_each_handle(&kbd_handler, &hz, kd_sound_helper);
265 if (hz && ticks)
266 mod_timer(&kd_mksound_timer, jiffies + ticks);
268 EXPORT_SYMBOL(kd_mksound);
271 * Setting the keyboard rate.
274 static int kbd_rate_helper(struct input_handle *handle, void *data)
276 struct input_dev *dev = handle->dev;
277 struct kbd_repeat *rep = data;
279 if (test_bit(EV_REP, dev->evbit)) {
281 if (rep[0].delay > 0)
282 input_inject_event(handle,
283 EV_REP, REP_DELAY, rep[0].delay);
284 if (rep[0].period > 0)
285 input_inject_event(handle,
286 EV_REP, REP_PERIOD, rep[0].period);
288 rep[1].delay = dev->rep[REP_DELAY];
289 rep[1].period = dev->rep[REP_PERIOD];
292 return 0;
295 int kbd_rate(struct kbd_repeat *rep)
297 struct kbd_repeat data[2] = { *rep };
299 input_handler_for_each_handle(&kbd_handler, data, kbd_rate_helper);
300 *rep = data[1]; /* Copy currently used settings */
302 return 0;
306 * Helper Functions.
308 static void put_queue(struct vc_data *vc, int ch)
310 tty_insert_flip_char(&vc->port, ch, 0);
311 tty_schedule_flip(&vc->port);
314 static void puts_queue(struct vc_data *vc, char *cp)
316 while (*cp) {
317 tty_insert_flip_char(&vc->port, *cp, 0);
318 cp++;
320 tty_schedule_flip(&vc->port);
323 static void applkey(struct vc_data *vc, int key, char mode)
325 static char buf[] = { 0x1b, 'O', 0x00, 0x00 };
327 buf[1] = (mode ? 'O' : '[');
328 buf[2] = key;
329 puts_queue(vc, buf);
333 * Many other routines do put_queue, but I think either
334 * they produce ASCII, or they produce some user-assigned
335 * string, and in both cases we might assume that it is
336 * in utf-8 already.
338 static void to_utf8(struct vc_data *vc, uint c)
340 if (c < 0x80)
341 /* 0******* */
342 put_queue(vc, c);
343 else if (c < 0x800) {
344 /* 110***** 10****** */
345 put_queue(vc, 0xc0 | (c >> 6));
346 put_queue(vc, 0x80 | (c & 0x3f));
347 } else if (c < 0x10000) {
348 if (c >= 0xD800 && c < 0xE000)
349 return;
350 if (c == 0xFFFF)
351 return;
352 /* 1110**** 10****** 10****** */
353 put_queue(vc, 0xe0 | (c >> 12));
354 put_queue(vc, 0x80 | ((c >> 6) & 0x3f));
355 put_queue(vc, 0x80 | (c & 0x3f));
356 } else if (c < 0x110000) {
357 /* 11110*** 10****** 10****** 10****** */
358 put_queue(vc, 0xf0 | (c >> 18));
359 put_queue(vc, 0x80 | ((c >> 12) & 0x3f));
360 put_queue(vc, 0x80 | ((c >> 6) & 0x3f));
361 put_queue(vc, 0x80 | (c & 0x3f));
366 * Called after returning from RAW mode or when changing consoles - recompute
367 * shift_down[] and shift_state from key_down[] maybe called when keymap is
368 * undefined, so that shiftkey release is seen. The caller must hold the
369 * kbd_event_lock.
372 static void do_compute_shiftstate(void)
374 unsigned int i, j, k, sym, val;
376 shift_state = 0;
377 memset(shift_down, 0, sizeof(shift_down));
379 for (i = 0; i < ARRAY_SIZE(key_down); i++) {
381 if (!key_down[i])
382 continue;
384 k = i * BITS_PER_LONG;
386 for (j = 0; j < BITS_PER_LONG; j++, k++) {
388 if (!test_bit(k, key_down))
389 continue;
391 sym = U(key_maps[0][k]);
392 if (KTYP(sym) != KT_SHIFT && KTYP(sym) != KT_SLOCK)
393 continue;
395 val = KVAL(sym);
396 if (val == KVAL(K_CAPSSHIFT))
397 val = KVAL(K_SHIFT);
399 shift_down[val]++;
400 shift_state |= (1 << val);
405 /* We still have to export this method to vt.c */
406 void compute_shiftstate(void)
408 unsigned long flags;
409 spin_lock_irqsave(&kbd_event_lock, flags);
410 do_compute_shiftstate();
411 spin_unlock_irqrestore(&kbd_event_lock, flags);
415 * We have a combining character DIACR here, followed by the character CH.
416 * If the combination occurs in the table, return the corresponding value.
417 * Otherwise, if CH is a space or equals DIACR, return DIACR.
418 * Otherwise, conclude that DIACR was not combining after all,
419 * queue it and return CH.
421 static unsigned int handle_diacr(struct vc_data *vc, unsigned int ch)
423 unsigned int d = diacr;
424 unsigned int i;
426 diacr = 0;
428 if ((d & ~0xff) == BRL_UC_ROW) {
429 if ((ch & ~0xff) == BRL_UC_ROW)
430 return d | ch;
431 } else {
432 for (i = 0; i < accent_table_size; i++)
433 if (accent_table[i].diacr == d && accent_table[i].base == ch)
434 return accent_table[i].result;
437 if (ch == ' ' || ch == (BRL_UC_ROW|0) || ch == d)
438 return d;
440 if (kbd->kbdmode == VC_UNICODE)
441 to_utf8(vc, d);
442 else {
443 int c = conv_uni_to_8bit(d);
444 if (c != -1)
445 put_queue(vc, c);
448 return ch;
452 * Special function handlers
454 static void fn_enter(struct vc_data *vc)
456 if (diacr) {
457 if (kbd->kbdmode == VC_UNICODE)
458 to_utf8(vc, diacr);
459 else {
460 int c = conv_uni_to_8bit(diacr);
461 if (c != -1)
462 put_queue(vc, c);
464 diacr = 0;
467 put_queue(vc, 13);
468 if (vc_kbd_mode(kbd, VC_CRLF))
469 put_queue(vc, 10);
472 static void fn_caps_toggle(struct vc_data *vc)
474 if (rep)
475 return;
477 chg_vc_kbd_led(kbd, VC_CAPSLOCK);
480 static void fn_caps_on(struct vc_data *vc)
482 if (rep)
483 return;
485 set_vc_kbd_led(kbd, VC_CAPSLOCK);
488 static void fn_show_ptregs(struct vc_data *vc)
490 struct pt_regs *regs = get_irq_regs();
492 if (regs)
493 show_regs(regs);
496 static void fn_hold(struct vc_data *vc)
498 struct tty_struct *tty = vc->port.tty;
500 if (rep || !tty)
501 return;
504 * Note: SCROLLOCK will be set (cleared) by stop_tty (start_tty);
505 * these routines are also activated by ^S/^Q.
506 * (And SCROLLOCK can also be set by the ioctl KDSKBLED.)
508 if (tty->stopped)
509 start_tty(tty);
510 else
511 stop_tty(tty);
514 static void fn_num(struct vc_data *vc)
516 if (vc_kbd_mode(kbd, VC_APPLIC))
517 applkey(vc, 'P', 1);
518 else
519 fn_bare_num(vc);
523 * Bind this to Shift-NumLock if you work in application keypad mode
524 * but want to be able to change the NumLock flag.
525 * Bind this to NumLock if you prefer that the NumLock key always
526 * changes the NumLock flag.
528 static void fn_bare_num(struct vc_data *vc)
530 if (!rep)
531 chg_vc_kbd_led(kbd, VC_NUMLOCK);
534 static void fn_lastcons(struct vc_data *vc)
536 /* switch to the last used console, ChN */
537 set_console(last_console);
540 static void fn_dec_console(struct vc_data *vc)
542 int i, cur = fg_console;
544 /* Currently switching? Queue this next switch relative to that. */
545 if (want_console != -1)
546 cur = want_console;
548 for (i = cur - 1; i != cur; i--) {
549 if (i == -1)
550 i = MAX_NR_CONSOLES - 1;
551 if (vc_cons_allocated(i))
552 break;
554 set_console(i);
557 static void fn_inc_console(struct vc_data *vc)
559 int i, cur = fg_console;
561 /* Currently switching? Queue this next switch relative to that. */
562 if (want_console != -1)
563 cur = want_console;
565 for (i = cur+1; i != cur; i++) {
566 if (i == MAX_NR_CONSOLES)
567 i = 0;
568 if (vc_cons_allocated(i))
569 break;
571 set_console(i);
574 static void fn_send_intr(struct vc_data *vc)
576 tty_insert_flip_char(&vc->port, 0, TTY_BREAK);
577 tty_schedule_flip(&vc->port);
580 static void fn_scroll_forw(struct vc_data *vc)
582 scrollfront(vc, 0);
585 static void fn_scroll_back(struct vc_data *vc)
587 scrollback(vc, 0);
590 static void fn_show_mem(struct vc_data *vc)
592 show_mem(0);
595 static void fn_show_state(struct vc_data *vc)
597 show_state();
600 static void fn_boot_it(struct vc_data *vc)
602 ctrl_alt_del();
605 static void fn_compose(struct vc_data *vc)
607 dead_key_next = true;
610 static void fn_spawn_con(struct vc_data *vc)
612 spin_lock(&vt_spawn_con.lock);
613 if (vt_spawn_con.pid)
614 if (kill_pid(vt_spawn_con.pid, vt_spawn_con.sig, 1)) {
615 put_pid(vt_spawn_con.pid);
616 vt_spawn_con.pid = NULL;
618 spin_unlock(&vt_spawn_con.lock);
621 static void fn_SAK(struct vc_data *vc)
623 struct work_struct *SAK_work = &vc_cons[fg_console].SAK_work;
624 schedule_work(SAK_work);
627 static void fn_null(struct vc_data *vc)
629 do_compute_shiftstate();
633 * Special key handlers
635 static void k_ignore(struct vc_data *vc, unsigned char value, char up_flag)
639 static void k_spec(struct vc_data *vc, unsigned char value, char up_flag)
641 if (up_flag)
642 return;
643 if (value >= ARRAY_SIZE(fn_handler))
644 return;
645 if ((kbd->kbdmode == VC_RAW ||
646 kbd->kbdmode == VC_MEDIUMRAW ||
647 kbd->kbdmode == VC_OFF) &&
648 value != KVAL(K_SAK))
649 return; /* SAK is allowed even in raw mode */
650 fn_handler[value](vc);
653 static void k_lowercase(struct vc_data *vc, unsigned char value, char up_flag)
655 pr_err("k_lowercase was called - impossible\n");
658 static void k_unicode(struct vc_data *vc, unsigned int value, char up_flag)
660 if (up_flag)
661 return; /* no action, if this is a key release */
663 if (diacr)
664 value = handle_diacr(vc, value);
666 if (dead_key_next) {
667 dead_key_next = false;
668 diacr = value;
669 return;
671 if (kbd->kbdmode == VC_UNICODE)
672 to_utf8(vc, value);
673 else {
674 int c = conv_uni_to_8bit(value);
675 if (c != -1)
676 put_queue(vc, c);
681 * Handle dead key. Note that we now may have several
682 * dead keys modifying the same character. Very useful
683 * for Vietnamese.
685 static void k_deadunicode(struct vc_data *vc, unsigned int value, char up_flag)
687 if (up_flag)
688 return;
690 diacr = (diacr ? handle_diacr(vc, value) : value);
693 static void k_self(struct vc_data *vc, unsigned char value, char up_flag)
695 k_unicode(vc, conv_8bit_to_uni(value), up_flag);
698 static void k_dead2(struct vc_data *vc, unsigned char value, char up_flag)
700 k_deadunicode(vc, value, up_flag);
704 * Obsolete - for backwards compatibility only
706 static void k_dead(struct vc_data *vc, unsigned char value, char up_flag)
708 static const unsigned char ret_diacr[NR_DEAD] = {'`', '\'', '^', '~', '"', ',' };
710 k_deadunicode(vc, ret_diacr[value], up_flag);
713 static void k_cons(struct vc_data *vc, unsigned char value, char up_flag)
715 if (up_flag)
716 return;
718 set_console(value);
721 static void k_fn(struct vc_data *vc, unsigned char value, char up_flag)
723 if (up_flag)
724 return;
726 if ((unsigned)value < ARRAY_SIZE(func_table)) {
727 if (func_table[value])
728 puts_queue(vc, func_table[value]);
729 } else
730 pr_err("k_fn called with value=%d\n", value);
733 static void k_cur(struct vc_data *vc, unsigned char value, char up_flag)
735 static const char cur_chars[] = "BDCA";
737 if (up_flag)
738 return;
740 applkey(vc, cur_chars[value], vc_kbd_mode(kbd, VC_CKMODE));
743 static void k_pad(struct vc_data *vc, unsigned char value, char up_flag)
745 static const char pad_chars[] = "0123456789+-*/\015,.?()#";
746 static const char app_map[] = "pqrstuvwxylSRQMnnmPQS";
748 if (up_flag)
749 return; /* no action, if this is a key release */
751 /* kludge... shift forces cursor/number keys */
752 if (vc_kbd_mode(kbd, VC_APPLIC) && !shift_down[KG_SHIFT]) {
753 applkey(vc, app_map[value], 1);
754 return;
757 if (!vc_kbd_led(kbd, VC_NUMLOCK)) {
759 switch (value) {
760 case KVAL(K_PCOMMA):
761 case KVAL(K_PDOT):
762 k_fn(vc, KVAL(K_REMOVE), 0);
763 return;
764 case KVAL(K_P0):
765 k_fn(vc, KVAL(K_INSERT), 0);
766 return;
767 case KVAL(K_P1):
768 k_fn(vc, KVAL(K_SELECT), 0);
769 return;
770 case KVAL(K_P2):
771 k_cur(vc, KVAL(K_DOWN), 0);
772 return;
773 case KVAL(K_P3):
774 k_fn(vc, KVAL(K_PGDN), 0);
775 return;
776 case KVAL(K_P4):
777 k_cur(vc, KVAL(K_LEFT), 0);
778 return;
779 case KVAL(K_P6):
780 k_cur(vc, KVAL(K_RIGHT), 0);
781 return;
782 case KVAL(K_P7):
783 k_fn(vc, KVAL(K_FIND), 0);
784 return;
785 case KVAL(K_P8):
786 k_cur(vc, KVAL(K_UP), 0);
787 return;
788 case KVAL(K_P9):
789 k_fn(vc, KVAL(K_PGUP), 0);
790 return;
791 case KVAL(K_P5):
792 applkey(vc, 'G', vc_kbd_mode(kbd, VC_APPLIC));
793 return;
797 put_queue(vc, pad_chars[value]);
798 if (value == KVAL(K_PENTER) && vc_kbd_mode(kbd, VC_CRLF))
799 put_queue(vc, 10);
802 static void k_shift(struct vc_data *vc, unsigned char value, char up_flag)
804 int old_state = shift_state;
806 if (rep)
807 return;
809 * Mimic typewriter:
810 * a CapsShift key acts like Shift but undoes CapsLock
812 if (value == KVAL(K_CAPSSHIFT)) {
813 value = KVAL(K_SHIFT);
814 if (!up_flag)
815 clr_vc_kbd_led(kbd, VC_CAPSLOCK);
818 if (up_flag) {
820 * handle the case that two shift or control
821 * keys are depressed simultaneously
823 if (shift_down[value])
824 shift_down[value]--;
825 } else
826 shift_down[value]++;
828 if (shift_down[value])
829 shift_state |= (1 << value);
830 else
831 shift_state &= ~(1 << value);
833 /* kludge */
834 if (up_flag && shift_state != old_state && npadch != -1) {
835 if (kbd->kbdmode == VC_UNICODE)
836 to_utf8(vc, npadch);
837 else
838 put_queue(vc, npadch & 0xff);
839 npadch = -1;
843 static void k_meta(struct vc_data *vc, unsigned char value, char up_flag)
845 if (up_flag)
846 return;
848 if (vc_kbd_mode(kbd, VC_META)) {
849 put_queue(vc, '\033');
850 put_queue(vc, value);
851 } else
852 put_queue(vc, value | 0x80);
855 static void k_ascii(struct vc_data *vc, unsigned char value, char up_flag)
857 int base;
859 if (up_flag)
860 return;
862 if (value < 10) {
863 /* decimal input of code, while Alt depressed */
864 base = 10;
865 } else {
866 /* hexadecimal input of code, while AltGr depressed */
867 value -= 10;
868 base = 16;
871 if (npadch == -1)
872 npadch = value;
873 else
874 npadch = npadch * base + value;
877 static void k_lock(struct vc_data *vc, unsigned char value, char up_flag)
879 if (up_flag || rep)
880 return;
882 chg_vc_kbd_lock(kbd, value);
885 static void k_slock(struct vc_data *vc, unsigned char value, char up_flag)
887 k_shift(vc, value, up_flag);
888 if (up_flag || rep)
889 return;
891 chg_vc_kbd_slock(kbd, value);
892 /* try to make Alt, oops, AltGr and such work */
893 if (!key_maps[kbd->lockstate ^ kbd->slockstate]) {
894 kbd->slockstate = 0;
895 chg_vc_kbd_slock(kbd, value);
899 /* by default, 300ms interval for combination release */
900 static unsigned brl_timeout = 300;
901 MODULE_PARM_DESC(brl_timeout, "Braille keys release delay in ms (0 for commit on first key release)");
902 module_param(brl_timeout, uint, 0644);
904 static unsigned brl_nbchords = 1;
905 MODULE_PARM_DESC(brl_nbchords, "Number of chords that produce a braille pattern (0 for dead chords)");
906 module_param(brl_nbchords, uint, 0644);
908 static void k_brlcommit(struct vc_data *vc, unsigned int pattern, char up_flag)
910 static unsigned long chords;
911 static unsigned committed;
913 if (!brl_nbchords)
914 k_deadunicode(vc, BRL_UC_ROW | pattern, up_flag);
915 else {
916 committed |= pattern;
917 chords++;
918 if (chords == brl_nbchords) {
919 k_unicode(vc, BRL_UC_ROW | committed, up_flag);
920 chords = 0;
921 committed = 0;
926 static void k_brl(struct vc_data *vc, unsigned char value, char up_flag)
928 static unsigned pressed, committing;
929 static unsigned long releasestart;
931 if (kbd->kbdmode != VC_UNICODE) {
932 if (!up_flag)
933 pr_warning("keyboard mode must be unicode for braille patterns\n");
934 return;
937 if (!value) {
938 k_unicode(vc, BRL_UC_ROW, up_flag);
939 return;
942 if (value > 8)
943 return;
945 if (!up_flag) {
946 pressed |= 1 << (value - 1);
947 if (!brl_timeout)
948 committing = pressed;
949 } else if (brl_timeout) {
950 if (!committing ||
951 time_after(jiffies,
952 releasestart + msecs_to_jiffies(brl_timeout))) {
953 committing = pressed;
954 releasestart = jiffies;
956 pressed &= ~(1 << (value - 1));
957 if (!pressed && committing) {
958 k_brlcommit(vc, committing, 0);
959 committing = 0;
961 } else {
962 if (committing) {
963 k_brlcommit(vc, committing, 0);
964 committing = 0;
966 pressed &= ~(1 << (value - 1));
971 * The leds display either (i) the status of NumLock, CapsLock, ScrollLock,
972 * or (ii) whatever pattern of lights people want to show using KDSETLED,
973 * or (iii) specified bits of specified words in kernel memory.
975 static unsigned char getledstate(void)
977 return ledstate;
980 void setledstate(struct kbd_struct *kbd, unsigned int led)
982 unsigned long flags;
983 spin_lock_irqsave(&led_lock, flags);
984 if (!(led & ~7)) {
985 ledioctl = led;
986 kbd->ledmode = LED_SHOW_IOCTL;
987 } else
988 kbd->ledmode = LED_SHOW_FLAGS;
990 set_leds();
991 spin_unlock_irqrestore(&led_lock, flags);
994 static inline unsigned char getleds(void)
996 struct kbd_struct *kbd = kbd_table + fg_console;
997 unsigned char leds;
998 int i;
1000 if (kbd->ledmode == LED_SHOW_IOCTL)
1001 return ledioctl;
1003 leds = kbd->ledflagstate;
1005 if (kbd->ledmode == LED_SHOW_MEM) {
1006 for (i = 0; i < 3; i++)
1007 if (ledptrs[i].valid) {
1008 if (*ledptrs[i].addr & ledptrs[i].mask)
1009 leds |= (1 << i);
1010 else
1011 leds &= ~(1 << i);
1014 return leds;
1017 static int kbd_update_leds_helper(struct input_handle *handle, void *data)
1019 unsigned char leds = *(unsigned char *)data;
1021 if (test_bit(EV_LED, handle->dev->evbit)) {
1022 input_inject_event(handle, EV_LED, LED_SCROLLL, !!(leds & 0x01));
1023 input_inject_event(handle, EV_LED, LED_NUML, !!(leds & 0x02));
1024 input_inject_event(handle, EV_LED, LED_CAPSL, !!(leds & 0x04));
1025 input_inject_event(handle, EV_SYN, SYN_REPORT, 0);
1028 return 0;
1032 * vt_get_leds - helper for braille console
1033 * @console: console to read
1034 * @flag: flag we want to check
1036 * Check the status of a keyboard led flag and report it back
1038 int vt_get_leds(int console, int flag)
1040 struct kbd_struct * kbd = kbd_table + console;
1041 int ret;
1042 unsigned long flags;
1044 spin_lock_irqsave(&led_lock, flags);
1045 ret = vc_kbd_led(kbd, flag);
1046 spin_unlock_irqrestore(&led_lock, flags);
1048 return ret;
1050 EXPORT_SYMBOL_GPL(vt_get_leds);
1053 * vt_set_led_state - set LED state of a console
1054 * @console: console to set
1055 * @leds: LED bits
1057 * Set the LEDs on a console. This is a wrapper for the VT layer
1058 * so that we can keep kbd knowledge internal
1060 void vt_set_led_state(int console, int leds)
1062 struct kbd_struct * kbd = kbd_table + console;
1063 setledstate(kbd, leds);
1067 * vt_kbd_con_start - Keyboard side of console start
1068 * @console: console
1070 * Handle console start. This is a wrapper for the VT layer
1071 * so that we can keep kbd knowledge internal
1073 * FIXME: We eventually need to hold the kbd lock here to protect
1074 * the LED updating. We can't do it yet because fn_hold calls stop_tty
1075 * and start_tty under the kbd_event_lock, while normal tty paths
1076 * don't hold the lock. We probably need to split out an LED lock
1077 * but not during an -rc release!
1079 void vt_kbd_con_start(int console)
1081 struct kbd_struct * kbd = kbd_table + console;
1082 unsigned long flags;
1083 spin_lock_irqsave(&led_lock, flags);
1084 clr_vc_kbd_led(kbd, VC_SCROLLOCK);
1085 set_leds();
1086 spin_unlock_irqrestore(&led_lock, flags);
1090 * vt_kbd_con_stop - Keyboard side of console stop
1091 * @console: console
1093 * Handle console stop. This is a wrapper for the VT layer
1094 * so that we can keep kbd knowledge internal
1096 void vt_kbd_con_stop(int console)
1098 struct kbd_struct * kbd = kbd_table + console;
1099 unsigned long flags;
1100 spin_lock_irqsave(&led_lock, flags);
1101 set_vc_kbd_led(kbd, VC_SCROLLOCK);
1102 set_leds();
1103 spin_unlock_irqrestore(&led_lock, flags);
1107 * This is the tasklet that updates LED state on all keyboards
1108 * attached to the box. The reason we use tasklet is that we
1109 * need to handle the scenario when keyboard handler is not
1110 * registered yet but we already getting updates from the VT to
1111 * update led state.
1113 static void kbd_bh(unsigned long dummy)
1115 unsigned char leds;
1116 unsigned long flags;
1118 spin_lock_irqsave(&led_lock, flags);
1119 leds = getleds();
1120 spin_unlock_irqrestore(&led_lock, flags);
1122 if (leds != ledstate) {
1123 input_handler_for_each_handle(&kbd_handler, &leds,
1124 kbd_update_leds_helper);
1125 ledstate = leds;
1129 DECLARE_TASKLET_DISABLED(keyboard_tasklet, kbd_bh, 0);
1131 #if defined(CONFIG_X86) || defined(CONFIG_IA64) || defined(CONFIG_ALPHA) ||\
1132 defined(CONFIG_MIPS) || defined(CONFIG_PPC) || defined(CONFIG_SPARC) ||\
1133 defined(CONFIG_PARISC) || defined(CONFIG_SUPERH) ||\
1134 (defined(CONFIG_ARM) && defined(CONFIG_KEYBOARD_ATKBD) && !defined(CONFIG_ARCH_RPC)) ||\
1135 defined(CONFIG_AVR32)
1137 #define HW_RAW(dev) (test_bit(EV_MSC, dev->evbit) && test_bit(MSC_RAW, dev->mscbit) &&\
1138 ((dev)->id.bustype == BUS_I8042) && ((dev)->id.vendor == 0x0001) && ((dev)->id.product == 0x0001))
1140 static const unsigned short x86_keycodes[256] =
1141 { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15,
1142 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31,
1143 32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47,
1144 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63,
1145 64, 65, 66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79,
1146 80, 81, 82, 83, 84,118, 86, 87, 88,115,120,119,121,112,123, 92,
1147 284,285,309, 0,312, 91,327,328,329,331,333,335,336,337,338,339,
1148 367,288,302,304,350, 89,334,326,267,126,268,269,125,347,348,349,
1149 360,261,262,263,268,376,100,101,321,316,373,286,289,102,351,355,
1150 103,104,105,275,287,279,258,106,274,107,294,364,358,363,362,361,
1151 291,108,381,281,290,272,292,305,280, 99,112,257,306,359,113,114,
1152 264,117,271,374,379,265,266, 93, 94, 95, 85,259,375,260, 90,116,
1153 377,109,111,277,278,282,283,295,296,297,299,300,301,293,303,307,
1154 308,310,313,314,315,317,318,319,320,357,322,323,324,325,276,330,
1155 332,340,365,342,343,344,345,346,356,270,341,368,369,370,371,372 };
1157 #ifdef CONFIG_SPARC
1158 static int sparc_l1_a_state;
1159 extern void sun_do_break(void);
1160 #endif
1162 static int emulate_raw(struct vc_data *vc, unsigned int keycode,
1163 unsigned char up_flag)
1165 int code;
1167 switch (keycode) {
1169 case KEY_PAUSE:
1170 put_queue(vc, 0xe1);
1171 put_queue(vc, 0x1d | up_flag);
1172 put_queue(vc, 0x45 | up_flag);
1173 break;
1175 case KEY_HANGEUL:
1176 if (!up_flag)
1177 put_queue(vc, 0xf2);
1178 break;
1180 case KEY_HANJA:
1181 if (!up_flag)
1182 put_queue(vc, 0xf1);
1183 break;
1185 case KEY_SYSRQ:
1187 * Real AT keyboards (that's what we're trying
1188 * to emulate here emit 0xe0 0x2a 0xe0 0x37 when
1189 * pressing PrtSc/SysRq alone, but simply 0x54
1190 * when pressing Alt+PrtSc/SysRq.
1192 if (test_bit(KEY_LEFTALT, key_down) ||
1193 test_bit(KEY_RIGHTALT, key_down)) {
1194 put_queue(vc, 0x54 | up_flag);
1195 } else {
1196 put_queue(vc, 0xe0);
1197 put_queue(vc, 0x2a | up_flag);
1198 put_queue(vc, 0xe0);
1199 put_queue(vc, 0x37 | up_flag);
1201 break;
1203 default:
1204 if (keycode > 255)
1205 return -1;
1207 code = x86_keycodes[keycode];
1208 if (!code)
1209 return -1;
1211 if (code & 0x100)
1212 put_queue(vc, 0xe0);
1213 put_queue(vc, (code & 0x7f) | up_flag);
1215 break;
1218 return 0;
1221 #else
1223 #define HW_RAW(dev) 0
1225 static int emulate_raw(struct vc_data *vc, unsigned int keycode, unsigned char up_flag)
1227 if (keycode > 127)
1228 return -1;
1230 put_queue(vc, keycode | up_flag);
1231 return 0;
1233 #endif
1235 static void kbd_rawcode(unsigned char data)
1237 struct vc_data *vc = vc_cons[fg_console].d;
1239 kbd = kbd_table + vc->vc_num;
1240 if (kbd->kbdmode == VC_RAW)
1241 put_queue(vc, data);
1244 static void kbd_keycode(unsigned int keycode, int down, int hw_raw)
1246 struct vc_data *vc = vc_cons[fg_console].d;
1247 unsigned short keysym, *key_map;
1248 unsigned char type;
1249 bool raw_mode;
1250 struct tty_struct *tty;
1251 int shift_final;
1252 struct keyboard_notifier_param param = { .vc = vc, .value = keycode, .down = down };
1253 int rc;
1255 tty = vc->port.tty;
1257 if (tty && (!tty->driver_data)) {
1258 /* No driver data? Strange. Okay we fix it then. */
1259 tty->driver_data = vc;
1262 kbd = kbd_table + vc->vc_num;
1264 #ifdef CONFIG_SPARC
1265 if (keycode == KEY_STOP)
1266 sparc_l1_a_state = down;
1267 #endif
1269 rep = (down == 2);
1271 raw_mode = (kbd->kbdmode == VC_RAW);
1272 if (raw_mode && !hw_raw)
1273 if (emulate_raw(vc, keycode, !down << 7))
1274 if (keycode < BTN_MISC && printk_ratelimit())
1275 pr_warning("can't emulate rawmode for keycode %d\n",
1276 keycode);
1278 #ifdef CONFIG_SPARC
1279 if (keycode == KEY_A && sparc_l1_a_state) {
1280 sparc_l1_a_state = false;
1281 sun_do_break();
1283 #endif
1285 if (kbd->kbdmode == VC_MEDIUMRAW) {
1287 * This is extended medium raw mode, with keys above 127
1288 * encoded as 0, high 7 bits, low 7 bits, with the 0 bearing
1289 * the 'up' flag if needed. 0 is reserved, so this shouldn't
1290 * interfere with anything else. The two bytes after 0 will
1291 * always have the up flag set not to interfere with older
1292 * applications. This allows for 16384 different keycodes,
1293 * which should be enough.
1295 if (keycode < 128) {
1296 put_queue(vc, keycode | (!down << 7));
1297 } else {
1298 put_queue(vc, !down << 7);
1299 put_queue(vc, (keycode >> 7) | 0x80);
1300 put_queue(vc, keycode | 0x80);
1302 raw_mode = true;
1305 if (down)
1306 set_bit(keycode, key_down);
1307 else
1308 clear_bit(keycode, key_down);
1310 if (rep &&
1311 (!vc_kbd_mode(kbd, VC_REPEAT) ||
1312 (tty && !L_ECHO(tty) && tty_chars_in_buffer(tty)))) {
1314 * Don't repeat a key if the input buffers are not empty and the
1315 * characters get aren't echoed locally. This makes key repeat
1316 * usable with slow applications and under heavy loads.
1318 return;
1321 param.shift = shift_final = (shift_state | kbd->slockstate) ^ kbd->lockstate;
1322 param.ledstate = kbd->ledflagstate;
1323 key_map = key_maps[shift_final];
1325 rc = atomic_notifier_call_chain(&keyboard_notifier_list,
1326 KBD_KEYCODE, &param);
1327 if (rc == NOTIFY_STOP || !key_map) {
1328 atomic_notifier_call_chain(&keyboard_notifier_list,
1329 KBD_UNBOUND_KEYCODE, &param);
1330 do_compute_shiftstate();
1331 kbd->slockstate = 0;
1332 return;
1335 if (keycode < NR_KEYS)
1336 keysym = key_map[keycode];
1337 else if (keycode >= KEY_BRL_DOT1 && keycode <= KEY_BRL_DOT8)
1338 keysym = U(K(KT_BRL, keycode - KEY_BRL_DOT1 + 1));
1339 else
1340 return;
1342 type = KTYP(keysym);
1344 if (type < 0xf0) {
1345 param.value = keysym;
1346 rc = atomic_notifier_call_chain(&keyboard_notifier_list,
1347 KBD_UNICODE, &param);
1348 if (rc != NOTIFY_STOP)
1349 if (down && !raw_mode)
1350 to_utf8(vc, keysym);
1351 return;
1354 type -= 0xf0;
1356 if (type == KT_LETTER) {
1357 type = KT_LATIN;
1358 if (vc_kbd_led(kbd, VC_CAPSLOCK)) {
1359 key_map = key_maps[shift_final ^ (1 << KG_SHIFT)];
1360 if (key_map)
1361 keysym = key_map[keycode];
1365 param.value = keysym;
1366 rc = atomic_notifier_call_chain(&keyboard_notifier_list,
1367 KBD_KEYSYM, &param);
1368 if (rc == NOTIFY_STOP)
1369 return;
1371 if ((raw_mode || kbd->kbdmode == VC_OFF) && type != KT_SPEC && type != KT_SHIFT)
1372 return;
1374 (*k_handler[type])(vc, keysym & 0xff, !down);
1376 param.ledstate = kbd->ledflagstate;
1377 atomic_notifier_call_chain(&keyboard_notifier_list, KBD_POST_KEYSYM, &param);
1379 if (type != KT_SLOCK)
1380 kbd->slockstate = 0;
1383 static void kbd_event(struct input_handle *handle, unsigned int event_type,
1384 unsigned int event_code, int value)
1386 /* We are called with interrupts disabled, just take the lock */
1387 spin_lock(&kbd_event_lock);
1389 if (event_type == EV_MSC && event_code == MSC_RAW && HW_RAW(handle->dev))
1390 kbd_rawcode(value);
1391 if (event_type == EV_KEY)
1392 kbd_keycode(event_code, value, HW_RAW(handle->dev));
1394 spin_unlock(&kbd_event_lock);
1396 tasklet_schedule(&keyboard_tasklet);
1397 do_poke_blanked_console = 1;
1398 schedule_console_callback();
1401 static bool kbd_match(struct input_handler *handler, struct input_dev *dev)
1403 int i;
1405 if (test_bit(EV_SND, dev->evbit))
1406 return true;
1408 if (test_bit(EV_KEY, dev->evbit)) {
1409 for (i = KEY_RESERVED; i < BTN_MISC; i++)
1410 if (test_bit(i, dev->keybit))
1411 return true;
1412 for (i = KEY_BRL_DOT1; i <= KEY_BRL_DOT10; i++)
1413 if (test_bit(i, dev->keybit))
1414 return true;
1417 return false;
1421 * When a keyboard (or other input device) is found, the kbd_connect
1422 * function is called. The function then looks at the device, and if it
1423 * likes it, it can open it and get events from it. In this (kbd_connect)
1424 * function, we should decide which VT to bind that keyboard to initially.
1426 static int kbd_connect(struct input_handler *handler, struct input_dev *dev,
1427 const struct input_device_id *id)
1429 struct input_handle *handle;
1430 int error;
1432 handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL);
1433 if (!handle)
1434 return -ENOMEM;
1436 handle->dev = dev;
1437 handle->handler = handler;
1438 handle->name = "kbd";
1440 error = input_register_handle(handle);
1441 if (error)
1442 goto err_free_handle;
1444 error = input_open_device(handle);
1445 if (error)
1446 goto err_unregister_handle;
1448 return 0;
1450 err_unregister_handle:
1451 input_unregister_handle(handle);
1452 err_free_handle:
1453 kfree(handle);
1454 return error;
1457 static void kbd_disconnect(struct input_handle *handle)
1459 input_close_device(handle);
1460 input_unregister_handle(handle);
1461 kfree(handle);
1465 * Start keyboard handler on the new keyboard by refreshing LED state to
1466 * match the rest of the system.
1468 static void kbd_start(struct input_handle *handle)
1470 tasklet_disable(&keyboard_tasklet);
1472 if (ledstate != 0xff)
1473 kbd_update_leds_helper(handle, &ledstate);
1475 tasklet_enable(&keyboard_tasklet);
1478 static const struct input_device_id kbd_ids[] = {
1480 .flags = INPUT_DEVICE_ID_MATCH_EVBIT,
1481 .evbit = { BIT_MASK(EV_KEY) },
1485 .flags = INPUT_DEVICE_ID_MATCH_EVBIT,
1486 .evbit = { BIT_MASK(EV_SND) },
1489 { }, /* Terminating entry */
1492 MODULE_DEVICE_TABLE(input, kbd_ids);
1494 static struct input_handler kbd_handler = {
1495 .event = kbd_event,
1496 .match = kbd_match,
1497 .connect = kbd_connect,
1498 .disconnect = kbd_disconnect,
1499 .start = kbd_start,
1500 .name = "kbd",
1501 .id_table = kbd_ids,
1504 int __init kbd_init(void)
1506 int i;
1507 int error;
1509 for (i = 0; i < MAX_NR_CONSOLES; i++) {
1510 kbd_table[i].ledflagstate = kbd_defleds();
1511 kbd_table[i].default_ledflagstate = kbd_defleds();
1512 kbd_table[i].ledmode = LED_SHOW_FLAGS;
1513 kbd_table[i].lockstate = KBD_DEFLOCK;
1514 kbd_table[i].slockstate = 0;
1515 kbd_table[i].modeflags = KBD_DEFMODE;
1516 kbd_table[i].kbdmode = default_utf8 ? VC_UNICODE : VC_XLATE;
1519 error = input_register_handler(&kbd_handler);
1520 if (error)
1521 return error;
1523 tasklet_enable(&keyboard_tasklet);
1524 tasklet_schedule(&keyboard_tasklet);
1526 return 0;
1529 /* Ioctl support code */
1532 * vt_do_diacrit - diacritical table updates
1533 * @cmd: ioctl request
1534 * @up: pointer to user data for ioctl
1535 * @perm: permissions check computed by caller
1537 * Update the diacritical tables atomically and safely. Lock them
1538 * against simultaneous keypresses
1540 int vt_do_diacrit(unsigned int cmd, void __user *up, int perm)
1542 struct kbdiacrs __user *a = up;
1543 unsigned long flags;
1544 int asize;
1545 int ret = 0;
1547 switch (cmd) {
1548 case KDGKBDIACR:
1550 struct kbdiacr *diacr;
1551 int i;
1553 diacr = kmalloc(MAX_DIACR * sizeof(struct kbdiacr),
1554 GFP_KERNEL);
1555 if (diacr == NULL)
1556 return -ENOMEM;
1558 /* Lock the diacriticals table, make a copy and then
1559 copy it after we unlock */
1560 spin_lock_irqsave(&kbd_event_lock, flags);
1562 asize = accent_table_size;
1563 for (i = 0; i < asize; i++) {
1564 diacr[i].diacr = conv_uni_to_8bit(
1565 accent_table[i].diacr);
1566 diacr[i].base = conv_uni_to_8bit(
1567 accent_table[i].base);
1568 diacr[i].result = conv_uni_to_8bit(
1569 accent_table[i].result);
1571 spin_unlock_irqrestore(&kbd_event_lock, flags);
1573 if (put_user(asize, &a->kb_cnt))
1574 ret = -EFAULT;
1575 else if (copy_to_user(a->kbdiacr, diacr,
1576 asize * sizeof(struct kbdiacr)))
1577 ret = -EFAULT;
1578 kfree(diacr);
1579 return ret;
1581 case KDGKBDIACRUC:
1583 struct kbdiacrsuc __user *a = up;
1584 void *buf;
1586 buf = kmalloc(MAX_DIACR * sizeof(struct kbdiacruc),
1587 GFP_KERNEL);
1588 if (buf == NULL)
1589 return -ENOMEM;
1591 /* Lock the diacriticals table, make a copy and then
1592 copy it after we unlock */
1593 spin_lock_irqsave(&kbd_event_lock, flags);
1595 asize = accent_table_size;
1596 memcpy(buf, accent_table, asize * sizeof(struct kbdiacruc));
1598 spin_unlock_irqrestore(&kbd_event_lock, flags);
1600 if (put_user(asize, &a->kb_cnt))
1601 ret = -EFAULT;
1602 else if (copy_to_user(a->kbdiacruc, buf,
1603 asize*sizeof(struct kbdiacruc)))
1604 ret = -EFAULT;
1605 kfree(buf);
1606 return ret;
1609 case KDSKBDIACR:
1611 struct kbdiacrs __user *a = up;
1612 struct kbdiacr *diacr = NULL;
1613 unsigned int ct;
1614 int i;
1616 if (!perm)
1617 return -EPERM;
1618 if (get_user(ct, &a->kb_cnt))
1619 return -EFAULT;
1620 if (ct >= MAX_DIACR)
1621 return -EINVAL;
1623 if (ct) {
1624 diacr = kmalloc(sizeof(struct kbdiacr) * ct,
1625 GFP_KERNEL);
1626 if (diacr == NULL)
1627 return -ENOMEM;
1629 if (copy_from_user(diacr, a->kbdiacr,
1630 sizeof(struct kbdiacr) * ct)) {
1631 kfree(diacr);
1632 return -EFAULT;
1636 spin_lock_irqsave(&kbd_event_lock, flags);
1637 accent_table_size = ct;
1638 for (i = 0; i < ct; i++) {
1639 accent_table[i].diacr =
1640 conv_8bit_to_uni(diacr[i].diacr);
1641 accent_table[i].base =
1642 conv_8bit_to_uni(diacr[i].base);
1643 accent_table[i].result =
1644 conv_8bit_to_uni(diacr[i].result);
1646 spin_unlock_irqrestore(&kbd_event_lock, flags);
1647 kfree(diacr);
1648 return 0;
1651 case KDSKBDIACRUC:
1653 struct kbdiacrsuc __user *a = up;
1654 unsigned int ct;
1655 void *buf = NULL;
1657 if (!perm)
1658 return -EPERM;
1660 if (get_user(ct, &a->kb_cnt))
1661 return -EFAULT;
1663 if (ct >= MAX_DIACR)
1664 return -EINVAL;
1666 if (ct) {
1667 buf = kmalloc(ct * sizeof(struct kbdiacruc),
1668 GFP_KERNEL);
1669 if (buf == NULL)
1670 return -ENOMEM;
1672 if (copy_from_user(buf, a->kbdiacruc,
1673 ct * sizeof(struct kbdiacruc))) {
1674 kfree(buf);
1675 return -EFAULT;
1678 spin_lock_irqsave(&kbd_event_lock, flags);
1679 if (ct)
1680 memcpy(accent_table, buf,
1681 ct * sizeof(struct kbdiacruc));
1682 accent_table_size = ct;
1683 spin_unlock_irqrestore(&kbd_event_lock, flags);
1684 kfree(buf);
1685 return 0;
1688 return ret;
1692 * vt_do_kdskbmode - set keyboard mode ioctl
1693 * @console: the console to use
1694 * @arg: the requested mode
1696 * Update the keyboard mode bits while holding the correct locks.
1697 * Return 0 for success or an error code.
1699 int vt_do_kdskbmode(int console, unsigned int arg)
1701 struct kbd_struct * kbd = kbd_table + console;
1702 int ret = 0;
1703 unsigned long flags;
1705 spin_lock_irqsave(&kbd_event_lock, flags);
1706 switch(arg) {
1707 case K_RAW:
1708 kbd->kbdmode = VC_RAW;
1709 break;
1710 case K_MEDIUMRAW:
1711 kbd->kbdmode = VC_MEDIUMRAW;
1712 break;
1713 case K_XLATE:
1714 kbd->kbdmode = VC_XLATE;
1715 do_compute_shiftstate();
1716 break;
1717 case K_UNICODE:
1718 kbd->kbdmode = VC_UNICODE;
1719 do_compute_shiftstate();
1720 break;
1721 case K_OFF:
1722 kbd->kbdmode = VC_OFF;
1723 break;
1724 default:
1725 ret = -EINVAL;
1727 spin_unlock_irqrestore(&kbd_event_lock, flags);
1728 return ret;
1732 * vt_do_kdskbmeta - set keyboard meta state
1733 * @console: the console to use
1734 * @arg: the requested meta state
1736 * Update the keyboard meta bits while holding the correct locks.
1737 * Return 0 for success or an error code.
1739 int vt_do_kdskbmeta(int console, unsigned int arg)
1741 struct kbd_struct * kbd = kbd_table + console;
1742 int ret = 0;
1743 unsigned long flags;
1745 spin_lock_irqsave(&kbd_event_lock, flags);
1746 switch(arg) {
1747 case K_METABIT:
1748 clr_vc_kbd_mode(kbd, VC_META);
1749 break;
1750 case K_ESCPREFIX:
1751 set_vc_kbd_mode(kbd, VC_META);
1752 break;
1753 default:
1754 ret = -EINVAL;
1756 spin_unlock_irqrestore(&kbd_event_lock, flags);
1757 return ret;
1760 int vt_do_kbkeycode_ioctl(int cmd, struct kbkeycode __user *user_kbkc,
1761 int perm)
1763 struct kbkeycode tmp;
1764 int kc = 0;
1766 if (copy_from_user(&tmp, user_kbkc, sizeof(struct kbkeycode)))
1767 return -EFAULT;
1768 switch (cmd) {
1769 case KDGETKEYCODE:
1770 kc = getkeycode(tmp.scancode);
1771 if (kc >= 0)
1772 kc = put_user(kc, &user_kbkc->keycode);
1773 break;
1774 case KDSETKEYCODE:
1775 if (!perm)
1776 return -EPERM;
1777 kc = setkeycode(tmp.scancode, tmp.keycode);
1778 break;
1780 return kc;
1783 #define i (tmp.kb_index)
1784 #define s (tmp.kb_table)
1785 #define v (tmp.kb_value)
1787 int vt_do_kdsk_ioctl(int cmd, struct kbentry __user *user_kbe, int perm,
1788 int console)
1790 struct kbd_struct * kbd = kbd_table + console;
1791 struct kbentry tmp;
1792 ushort *key_map, *new_map, val, ov;
1793 unsigned long flags;
1795 if (copy_from_user(&tmp, user_kbe, sizeof(struct kbentry)))
1796 return -EFAULT;
1798 if (!capable(CAP_SYS_TTY_CONFIG))
1799 perm = 0;
1801 switch (cmd) {
1802 case KDGKBENT:
1803 /* Ensure another thread doesn't free it under us */
1804 spin_lock_irqsave(&kbd_event_lock, flags);
1805 key_map = key_maps[s];
1806 if (key_map) {
1807 val = U(key_map[i]);
1808 if (kbd->kbdmode != VC_UNICODE && KTYP(val) >= NR_TYPES)
1809 val = K_HOLE;
1810 } else
1811 val = (i ? K_HOLE : K_NOSUCHMAP);
1812 spin_unlock_irqrestore(&kbd_event_lock, flags);
1813 return put_user(val, &user_kbe->kb_value);
1814 case KDSKBENT:
1815 if (!perm)
1816 return -EPERM;
1817 if (!i && v == K_NOSUCHMAP) {
1818 spin_lock_irqsave(&kbd_event_lock, flags);
1819 /* deallocate map */
1820 key_map = key_maps[s];
1821 if (s && key_map) {
1822 key_maps[s] = NULL;
1823 if (key_map[0] == U(K_ALLOCATED)) {
1824 kfree(key_map);
1825 keymap_count--;
1828 spin_unlock_irqrestore(&kbd_event_lock, flags);
1829 break;
1832 if (KTYP(v) < NR_TYPES) {
1833 if (KVAL(v) > max_vals[KTYP(v)])
1834 return -EINVAL;
1835 } else
1836 if (kbd->kbdmode != VC_UNICODE)
1837 return -EINVAL;
1839 /* ++Geert: non-PC keyboards may generate keycode zero */
1840 #if !defined(__mc68000__) && !defined(__powerpc__)
1841 /* assignment to entry 0 only tests validity of args */
1842 if (!i)
1843 break;
1844 #endif
1846 new_map = kmalloc(sizeof(plain_map), GFP_KERNEL);
1847 if (!new_map)
1848 return -ENOMEM;
1849 spin_lock_irqsave(&kbd_event_lock, flags);
1850 key_map = key_maps[s];
1851 if (key_map == NULL) {
1852 int j;
1854 if (keymap_count >= MAX_NR_OF_USER_KEYMAPS &&
1855 !capable(CAP_SYS_RESOURCE)) {
1856 spin_unlock_irqrestore(&kbd_event_lock, flags);
1857 kfree(new_map);
1858 return -EPERM;
1860 key_maps[s] = new_map;
1861 key_map = new_map;
1862 key_map[0] = U(K_ALLOCATED);
1863 for (j = 1; j < NR_KEYS; j++)
1864 key_map[j] = U(K_HOLE);
1865 keymap_count++;
1866 } else
1867 kfree(new_map);
1869 ov = U(key_map[i]);
1870 if (v == ov)
1871 goto out;
1873 * Attention Key.
1875 if (((ov == K_SAK) || (v == K_SAK)) && !capable(CAP_SYS_ADMIN)) {
1876 spin_unlock_irqrestore(&kbd_event_lock, flags);
1877 return -EPERM;
1879 key_map[i] = U(v);
1880 if (!s && (KTYP(ov) == KT_SHIFT || KTYP(v) == KT_SHIFT))
1881 do_compute_shiftstate();
1882 out:
1883 spin_unlock_irqrestore(&kbd_event_lock, flags);
1884 break;
1886 return 0;
1888 #undef i
1889 #undef s
1890 #undef v
1892 /* FIXME: This one needs untangling and locking */
1893 int vt_do_kdgkb_ioctl(int cmd, struct kbsentry __user *user_kdgkb, int perm)
1895 struct kbsentry *kbs;
1896 char *p;
1897 u_char *q;
1898 u_char __user *up;
1899 int sz;
1900 int delta;
1901 char *first_free, *fj, *fnw;
1902 int i, j, k;
1903 int ret;
1905 if (!capable(CAP_SYS_TTY_CONFIG))
1906 perm = 0;
1908 kbs = kmalloc(sizeof(*kbs), GFP_KERNEL);
1909 if (!kbs) {
1910 ret = -ENOMEM;
1911 goto reterr;
1914 /* we mostly copy too much here (512bytes), but who cares ;) */
1915 if (copy_from_user(kbs, user_kdgkb, sizeof(struct kbsentry))) {
1916 ret = -EFAULT;
1917 goto reterr;
1919 kbs->kb_string[sizeof(kbs->kb_string)-1] = '\0';
1920 i = kbs->kb_func;
1922 switch (cmd) {
1923 case KDGKBSENT:
1924 sz = sizeof(kbs->kb_string) - 1; /* sz should have been
1925 a struct member */
1926 up = user_kdgkb->kb_string;
1927 p = func_table[i];
1928 if(p)
1929 for ( ; *p && sz; p++, sz--)
1930 if (put_user(*p, up++)) {
1931 ret = -EFAULT;
1932 goto reterr;
1934 if (put_user('\0', up)) {
1935 ret = -EFAULT;
1936 goto reterr;
1938 kfree(kbs);
1939 return ((p && *p) ? -EOVERFLOW : 0);
1940 case KDSKBSENT:
1941 if (!perm) {
1942 ret = -EPERM;
1943 goto reterr;
1946 q = func_table[i];
1947 first_free = funcbufptr + (funcbufsize - funcbufleft);
1948 for (j = i+1; j < MAX_NR_FUNC && !func_table[j]; j++)
1950 if (j < MAX_NR_FUNC)
1951 fj = func_table[j];
1952 else
1953 fj = first_free;
1955 delta = (q ? -strlen(q) : 1) + strlen(kbs->kb_string);
1956 if (delta <= funcbufleft) { /* it fits in current buf */
1957 if (j < MAX_NR_FUNC) {
1958 memmove(fj + delta, fj, first_free - fj);
1959 for (k = j; k < MAX_NR_FUNC; k++)
1960 if (func_table[k])
1961 func_table[k] += delta;
1963 if (!q)
1964 func_table[i] = fj;
1965 funcbufleft -= delta;
1966 } else { /* allocate a larger buffer */
1967 sz = 256;
1968 while (sz < funcbufsize - funcbufleft + delta)
1969 sz <<= 1;
1970 fnw = kmalloc(sz, GFP_KERNEL);
1971 if(!fnw) {
1972 ret = -ENOMEM;
1973 goto reterr;
1976 if (!q)
1977 func_table[i] = fj;
1978 if (fj > funcbufptr)
1979 memmove(fnw, funcbufptr, fj - funcbufptr);
1980 for (k = 0; k < j; k++)
1981 if (func_table[k])
1982 func_table[k] = fnw + (func_table[k] - funcbufptr);
1984 if (first_free > fj) {
1985 memmove(fnw + (fj - funcbufptr) + delta, fj, first_free - fj);
1986 for (k = j; k < MAX_NR_FUNC; k++)
1987 if (func_table[k])
1988 func_table[k] = fnw + (func_table[k] - funcbufptr) + delta;
1990 if (funcbufptr != func_buf)
1991 kfree(funcbufptr);
1992 funcbufptr = fnw;
1993 funcbufleft = funcbufleft - delta + sz - funcbufsize;
1994 funcbufsize = sz;
1996 strcpy(func_table[i], kbs->kb_string);
1997 break;
1999 ret = 0;
2000 reterr:
2001 kfree(kbs);
2002 return ret;
2005 int vt_do_kdskled(int console, int cmd, unsigned long arg, int perm)
2007 struct kbd_struct * kbd = kbd_table + console;
2008 unsigned long flags;
2009 unsigned char ucval;
2011 switch(cmd) {
2012 /* the ioctls below read/set the flags usually shown in the leds */
2013 /* don't use them - they will go away without warning */
2014 case KDGKBLED:
2015 spin_lock_irqsave(&kbd_event_lock, flags);
2016 ucval = kbd->ledflagstate | (kbd->default_ledflagstate << 4);
2017 spin_unlock_irqrestore(&kbd_event_lock, flags);
2018 return put_user(ucval, (char __user *)arg);
2020 case KDSKBLED:
2021 if (!perm)
2022 return -EPERM;
2023 if (arg & ~0x77)
2024 return -EINVAL;
2025 spin_lock_irqsave(&led_lock, flags);
2026 kbd->ledflagstate = (arg & 7);
2027 kbd->default_ledflagstate = ((arg >> 4) & 7);
2028 set_leds();
2029 spin_unlock_irqrestore(&led_lock, flags);
2030 return 0;
2032 /* the ioctls below only set the lights, not the functions */
2033 /* for those, see KDGKBLED and KDSKBLED above */
2034 case KDGETLED:
2035 ucval = getledstate();
2036 return put_user(ucval, (char __user *)arg);
2038 case KDSETLED:
2039 if (!perm)
2040 return -EPERM;
2041 setledstate(kbd, arg);
2042 return 0;
2044 return -ENOIOCTLCMD;
2047 int vt_do_kdgkbmode(int console)
2049 struct kbd_struct * kbd = kbd_table + console;
2050 /* This is a spot read so needs no locking */
2051 switch (kbd->kbdmode) {
2052 case VC_RAW:
2053 return K_RAW;
2054 case VC_MEDIUMRAW:
2055 return K_MEDIUMRAW;
2056 case VC_UNICODE:
2057 return K_UNICODE;
2058 case VC_OFF:
2059 return K_OFF;
2060 default:
2061 return K_XLATE;
2066 * vt_do_kdgkbmeta - report meta status
2067 * @console: console to report
2069 * Report the meta flag status of this console
2071 int vt_do_kdgkbmeta(int console)
2073 struct kbd_struct * kbd = kbd_table + console;
2074 /* Again a spot read so no locking */
2075 return vc_kbd_mode(kbd, VC_META) ? K_ESCPREFIX : K_METABIT;
2079 * vt_reset_unicode - reset the unicode status
2080 * @console: console being reset
2082 * Restore the unicode console state to its default
2084 void vt_reset_unicode(int console)
2086 unsigned long flags;
2088 spin_lock_irqsave(&kbd_event_lock, flags);
2089 kbd_table[console].kbdmode = default_utf8 ? VC_UNICODE : VC_XLATE;
2090 spin_unlock_irqrestore(&kbd_event_lock, flags);
2094 * vt_get_shiftstate - shift bit state
2096 * Report the shift bits from the keyboard state. We have to export
2097 * this to support some oddities in the vt layer.
2099 int vt_get_shift_state(void)
2101 /* Don't lock as this is a transient report */
2102 return shift_state;
2106 * vt_reset_keyboard - reset keyboard state
2107 * @console: console to reset
2109 * Reset the keyboard bits for a console as part of a general console
2110 * reset event
2112 void vt_reset_keyboard(int console)
2114 struct kbd_struct * kbd = kbd_table + console;
2115 unsigned long flags;
2117 spin_lock_irqsave(&kbd_event_lock, flags);
2118 set_vc_kbd_mode(kbd, VC_REPEAT);
2119 clr_vc_kbd_mode(kbd, VC_CKMODE);
2120 clr_vc_kbd_mode(kbd, VC_APPLIC);
2121 clr_vc_kbd_mode(kbd, VC_CRLF);
2122 kbd->lockstate = 0;
2123 kbd->slockstate = 0;
2124 spin_lock(&led_lock);
2125 kbd->ledmode = LED_SHOW_FLAGS;
2126 kbd->ledflagstate = kbd->default_ledflagstate;
2127 spin_unlock(&led_lock);
2128 /* do not do set_leds here because this causes an endless tasklet loop
2129 when the keyboard hasn't been initialized yet */
2130 spin_unlock_irqrestore(&kbd_event_lock, flags);
2134 * vt_get_kbd_mode_bit - read keyboard status bits
2135 * @console: console to read from
2136 * @bit: mode bit to read
2138 * Report back a vt mode bit. We do this without locking so the
2139 * caller must be sure that there are no synchronization needs
2142 int vt_get_kbd_mode_bit(int console, int bit)
2144 struct kbd_struct * kbd = kbd_table + console;
2145 return vc_kbd_mode(kbd, bit);
2149 * vt_set_kbd_mode_bit - read keyboard status bits
2150 * @console: console to read from
2151 * @bit: mode bit to read
2153 * Set a vt mode bit. We do this without locking so the
2154 * caller must be sure that there are no synchronization needs
2157 void vt_set_kbd_mode_bit(int console, int bit)
2159 struct kbd_struct * kbd = kbd_table + console;
2160 unsigned long flags;
2162 spin_lock_irqsave(&kbd_event_lock, flags);
2163 set_vc_kbd_mode(kbd, bit);
2164 spin_unlock_irqrestore(&kbd_event_lock, flags);
2168 * vt_clr_kbd_mode_bit - read keyboard status bits
2169 * @console: console to read from
2170 * @bit: mode bit to read
2172 * Report back a vt mode bit. We do this without locking so the
2173 * caller must be sure that there are no synchronization needs
2176 void vt_clr_kbd_mode_bit(int console, int bit)
2178 struct kbd_struct * kbd = kbd_table + console;
2179 unsigned long flags;
2181 spin_lock_irqsave(&kbd_event_lock, flags);
2182 clr_vc_kbd_mode(kbd, bit);
2183 spin_unlock_irqrestore(&kbd_event_lock, flags);