1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
26
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>
36
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>
45
46#include <asm/irq_regs.h>
47
48extern void ctrl_alt_del(void);
49
50
51
52
53
54#define KBD_DEFMODE ((1 << VC_REPEAT) | (1 << VC_META))
55
56#if defined(CONFIG_X86) || defined(CONFIG_PARISC)
57#include <asm/kbdleds.h>
58#else
59static inline int kbd_defleds(void)
60{
61 return 0;
62}
63#endif
64
65#define KBD_DEFLOCK 0
66
67
68
69
70
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
76
77typedef void (k_handler_fn)(struct vc_data *vc, unsigned char value,
78 char up_flag);
79static k_handler_fn K_HANDLERS;
80static k_handler_fn *k_handler[16] = { K_HANDLERS };
81
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
88
89typedef void (fn_handler_fn)(struct vc_data *vc);
90static fn_handler_fn FN_HANDLERS;
91static fn_handler_fn *fn_handler[] = { FN_HANDLERS };
92
93
94
95
96
97struct vt_spawn_console vt_spawn_con = {
98 .lock = __SPIN_LOCK_UNLOCKED(vt_spawn_con.lock),
99 .pid = NULL,
100 .sig = 0,
101};
102
103
104
105
106
107
108static struct kbd_struct kbd_table[MAX_NR_CONSOLES];
109static struct kbd_struct *kbd = kbd_table;
110
111
112static 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
116};
117
118static const int NR_TYPES = ARRAY_SIZE(max_vals);
119
120static struct input_handler kbd_handler;
121static DEFINE_SPINLOCK(kbd_event_lock);
122static DEFINE_SPINLOCK(led_lock);
123static unsigned long key_down[BITS_TO_LONGS(KEY_CNT)];
124static unsigned char shift_down[NR_SHIFT];
125static bool dead_key_next;
126static int npadch = -1;
127static unsigned int diacr;
128static char rep;
129
130static int shift_state = 0;
131
132static unsigned char ledstate = 0xff;
133static unsigned char ledioctl;
134
135static struct ledptr {
136 unsigned int *addr;
137 unsigned int mask;
138 unsigned char valid:1;
139} ledptrs[3];
140
141
142
143
144static ATOMIC_NOTIFIER_HEAD(keyboard_notifier_list);
145
146int register_keyboard_notifier(struct notifier_block *nb)
147{
148 return atomic_notifier_chain_register(&keyboard_notifier_list, nb);
149}
150EXPORT_SYMBOL_GPL(register_keyboard_notifier);
151
152int unregister_keyboard_notifier(struct notifier_block *nb)
153{
154 return atomic_notifier_chain_unregister(&keyboard_notifier_list, nb);
155}
156EXPORT_SYMBOL_GPL(unregister_keyboard_notifier);
157
158
159
160
161
162
163
164
165
166
167
168struct getset_keycode_data {
169 struct input_keymap_entry ke;
170 int error;
171};
172
173static int getkeycode_helper(struct input_handle *handle, void *data)
174{
175 struct getset_keycode_data *d = data;
176
177 d->error = input_get_keycode(handle->dev, &d->ke);
178
179 return d->error == 0;
180}
181
182static int getkeycode(unsigned int scancode)
183{
184 struct getset_keycode_data d = {
185 .ke = {
186 .flags = 0,
187 .len = sizeof(scancode),
188 .keycode = 0,
189 },
190 .error = -ENODEV,
191 };
192
193 memcpy(d.ke.scancode, &scancode, sizeof(scancode));
194
195 input_handler_for_each_handle(&kbd_handler, &d, getkeycode_helper);
196
197 return d.error ?: d.ke.keycode;
198}
199
200static int setkeycode_helper(struct input_handle *handle, void *data)
201{
202 struct getset_keycode_data *d = data;
203
204 d->error = input_set_keycode(handle->dev, &d->ke);
205
206 return d->error == 0;
207}
208
209static int setkeycode(unsigned int scancode, unsigned int keycode)
210{
211 struct getset_keycode_data d = {
212 .ke = {
213 .flags = 0,
214 .len = sizeof(scancode),
215 .keycode = keycode,
216 },
217 .error = -ENODEV,
218 };
219
220 memcpy(d.ke.scancode, &scancode, sizeof(scancode));
221
222 input_handler_for_each_handle(&kbd_handler, &d, setkeycode_helper);
223
224 return d.error;
225}
226
227
228
229
230
231
232static int kd_sound_helper(struct input_handle *handle, void *data)
233{
234 unsigned int *hz = data;
235 struct input_dev *dev = handle->dev;
236
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;
242 }
243 if (test_bit(SND_BELL, dev->sndbit))
244 input_inject_event(handle, EV_SND, SND_BELL, *hz ? 1 : 0);
245 }
246
247 return 0;
248}
249
250static void kd_nosound(unsigned long ignored)
251{
252 static unsigned int zero;
253
254 input_handler_for_each_handle(&kbd_handler, &zero, kd_sound_helper);
255}
256
257static DEFINE_TIMER(kd_mksound_timer, kd_nosound, 0, 0);
258
259void kd_mksound(unsigned int hz, unsigned int ticks)
260{
261 del_timer_sync(&kd_mksound_timer);
262
263 input_handler_for_each_handle(&kbd_handler, &hz, kd_sound_helper);
264
265 if (hz && ticks)
266 mod_timer(&kd_mksound_timer, jiffies + ticks);
267}
268EXPORT_SYMBOL(kd_mksound);
269
270
271
272
273
274static int kbd_rate_helper(struct input_handle *handle, void *data)
275{
276 struct input_dev *dev = handle->dev;
277 struct kbd_repeat *rep = data;
278
279 if (test_bit(EV_REP, dev->evbit)) {
280
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);
287
288 rep[1].delay = dev->rep[REP_DELAY];
289 rep[1].period = dev->rep[REP_PERIOD];
290 }
291
292 return 0;
293}
294
295int kbd_rate(struct kbd_repeat *rep)
296{
297 struct kbd_repeat data[2] = { *rep };
298
299 input_handler_for_each_handle(&kbd_handler, data, kbd_rate_helper);
300 *rep = data[1];
301
302 return 0;
303}
304
305
306
307
308static void put_queue(struct vc_data *vc, int ch)
309{
310 tty_insert_flip_char(&vc->port, ch, 0);
311 tty_schedule_flip(&vc->port);
312}
313
314static void puts_queue(struct vc_data *vc, char *cp)
315{
316 while (*cp) {
317 tty_insert_flip_char(&vc->port, *cp, 0);
318 cp++;
319 }
320 tty_schedule_flip(&vc->port);
321}
322
323static void applkey(struct vc_data *vc, int key, char mode)
324{
325 static char buf[] = { 0x1b, 'O', 0x00, 0x00 };
326
327 buf[1] = (mode ? 'O' : '[');
328 buf[2] = key;
329 puts_queue(vc, buf);
330}
331
332
333
334
335
336
337
338static void to_utf8(struct vc_data *vc, uint c)
339{
340 if (c < 0x80)
341
342 put_queue(vc, c);
343 else if (c < 0x800) {
344
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
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
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));
362 }
363}
364
365
366
367
368
369
370
371
372static void do_compute_shiftstate(void)
373{
374 unsigned int i, j, k, sym, val;
375
376 shift_state = 0;
377 memset(shift_down, 0, sizeof(shift_down));
378
379 for (i = 0; i < ARRAY_SIZE(key_down); i++) {
380
381 if (!key_down[i])
382 continue;
383
384 k = i * BITS_PER_LONG;
385
386 for (j = 0; j < BITS_PER_LONG; j++, k++) {
387
388 if (!test_bit(k, key_down))
389 continue;
390
391 sym = U(key_maps[0][k]);
392 if (KTYP(sym) != KT_SHIFT && KTYP(sym) != KT_SLOCK)
393 continue;
394
395 val = KVAL(sym);
396 if (val == KVAL(K_CAPSSHIFT))
397 val = KVAL(K_SHIFT);
398
399 shift_down[val]++;
400 shift_state |= (1 << val);
401 }
402 }
403}
404
405
406void compute_shiftstate(void)
407{
408 unsigned long flags;
409 spin_lock_irqsave(&kbd_event_lock, flags);
410 do_compute_shiftstate();
411 spin_unlock_irqrestore(&kbd_event_lock, flags);
412}
413
414
415
416
417
418
419
420
421static unsigned int handle_diacr(struct vc_data *vc, unsigned int ch)
422{
423 unsigned int d = diacr;
424 unsigned int i;
425
426 diacr = 0;
427
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;
435 }
436
437 if (ch == ' ' || ch == (BRL_UC_ROW|0) || ch == d)
438 return d;
439
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);
446 }
447
448 return ch;
449}
450
451
452
453
454static void fn_enter(struct vc_data *vc)
455{
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);
463 }
464 diacr = 0;
465 }
466
467 put_queue(vc, 13);
468 if (vc_kbd_mode(kbd, VC_CRLF))
469 put_queue(vc, 10);
470}
471
472static void fn_caps_toggle(struct vc_data *vc)
473{
474 if (rep)
475 return;
476
477 chg_vc_kbd_led(kbd, VC_CAPSLOCK);
478}
479
480static void fn_caps_on(struct vc_data *vc)
481{
482 if (rep)
483 return;
484
485 set_vc_kbd_led(kbd, VC_CAPSLOCK);
486}
487
488static void fn_show_ptregs(struct vc_data *vc)
489{
490 struct pt_regs *regs = get_irq_regs();
491
492 if (regs)
493 show_regs(regs);
494}
495
496static void fn_hold(struct vc_data *vc)
497{
498 struct tty_struct *tty = vc->port.tty;
499
500 if (rep || !tty)
501 return;
502
503
504
505
506
507
508 if (tty->stopped)
509 start_tty(tty);
510 else
511 stop_tty(tty);
512}
513
514static void fn_num(struct vc_data *vc)
515{
516 if (vc_kbd_mode(kbd, VC_APPLIC))
517 applkey(vc, 'P', 1);
518 else
519 fn_bare_num(vc);
520}
521
522
523
524
525
526
527
528static void fn_bare_num(struct vc_data *vc)
529{
530 if (!rep)
531 chg_vc_kbd_led(kbd, VC_NUMLOCK);
532}
533
534static void fn_lastcons(struct vc_data *vc)
535{
536
537 set_console(last_console);
538}
539
540static void fn_dec_console(struct vc_data *vc)
541{
542 int i, cur = fg_console;
543
544
545 if (want_console != -1)
546 cur = want_console;
547
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;
553 }
554 set_console(i);
555}
556
557static void fn_inc_console(struct vc_data *vc)
558{
559 int i, cur = fg_console;
560
561
562 if (want_console != -1)
563 cur = want_console;
564
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;
570 }
571 set_console(i);
572}
573
574static void fn_send_intr(struct vc_data *vc)
575{
576 tty_insert_flip_char(&vc->port, 0, TTY_BREAK);
577 tty_schedule_flip(&vc->port);
578}
579
580static void fn_scroll_forw(struct vc_data *vc)
581{
582 scrollfront(vc, 0);
583}
584
585static void fn_scroll_back(struct vc_data *vc)
586{
587 scrollback(vc, 0);
588}
589
590static void fn_show_mem(struct vc_data *vc)
591{
592 show_mem(0);
593}
594
595static void fn_show_state(struct vc_data *vc)
596{
597 show_state();
598}
599
600static void fn_boot_it(struct vc_data *vc)
601{
602 ctrl_alt_del();
603}
604
605static void fn_compose(struct vc_data *vc)
606{
607 dead_key_next = true;
608}
609
610static void fn_spawn_con(struct vc_data *vc)
611{
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;
617 }
618 spin_unlock(&vt_spawn_con.lock);
619}
620
621static void fn_SAK(struct vc_data *vc)
622{
623 struct work_struct *SAK_work = &vc_cons[fg_console].SAK_work;
624 schedule_work(SAK_work);
625}
626
627static void fn_null(struct vc_data *vc)
628{
629 do_compute_shiftstate();
630}
631
632
633
634
635static void k_ignore(struct vc_data *vc, unsigned char value, char up_flag)
636{
637}
638
639static void k_spec(struct vc_data *vc, unsigned char value, char up_flag)
640{
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;
650 fn_handler[value](vc);
651}
652
653static void k_lowercase(struct vc_data *vc, unsigned char value, char up_flag)
654{
655 pr_err("k_lowercase was called - impossible\n");
656}
657
658static void k_unicode(struct vc_data *vc, unsigned int value, char up_flag)
659{
660 if (up_flag)
661 return;
662
663 if (diacr)
664 value = handle_diacr(vc, value);
665
666 if (dead_key_next) {
667 dead_key_next = false;
668 diacr = value;
669 return;
670 }
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);
677 }
678}
679
680
681
682
683
684
685static void k_deadunicode(struct vc_data *vc, unsigned int value, char up_flag)
686{
687 if (up_flag)
688 return;
689
690 diacr = (diacr ? handle_diacr(vc, value) : value);
691}
692
693static void k_self(struct vc_data *vc, unsigned char value, char up_flag)
694{
695 k_unicode(vc, conv_8bit_to_uni(value), up_flag);
696}
697
698static void k_dead2(struct vc_data *vc, unsigned char value, char up_flag)
699{
700 k_deadunicode(vc, value, up_flag);
701}
702
703
704
705
706static void k_dead(struct vc_data *vc, unsigned char value, char up_flag)
707{
708 static const unsigned char ret_diacr[NR_DEAD] = {'`', '\'', '^', '~', '"', ',' };
709
710 k_deadunicode(vc, ret_diacr[value], up_flag);
711}
712
713static void k_cons(struct vc_data *vc, unsigned char value, char up_flag)
714{
715 if (up_flag)
716 return;
717
718 set_console(value);
719}
720
721static void k_fn(struct vc_data *vc, unsigned char value, char up_flag)
722{
723 if (up_flag)
724 return;
725
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);
731}
732
733static void k_cur(struct vc_data *vc, unsigned char value, char up_flag)
734{
735 static const char cur_chars[] = "BDCA";
736
737 if (up_flag)
738 return;
739
740 applkey(vc, cur_chars[value], vc_kbd_mode(kbd, VC_CKMODE));
741}
742
743static void k_pad(struct vc_data *vc, unsigned char value, char up_flag)
744{
745 static const char pad_chars[] = "0123456789+-*/\015,.?()#";
746 static const char app_map[] = "pqrstuvwxylSRQMnnmPQS";
747
748 if (up_flag)
749 return;
750
751
752 if (vc_kbd_mode(kbd, VC_APPLIC) && !shift_down[KG_SHIFT]) {
753 applkey(vc, app_map[value], 1);
754 return;
755 }
756
757 if (!vc_kbd_led(kbd, VC_NUMLOCK)) {
758
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;
794 }
795 }
796
797 put_queue(vc, pad_chars[value]);
798 if (value == KVAL(K_PENTER) && vc_kbd_mode(kbd, VC_CRLF))
799 put_queue(vc, 10);
800}
801
802static void k_shift(struct vc_data *vc, unsigned char value, char up_flag)
803{
804 int old_state = shift_state;
805
806 if (rep)
807 return;
808
809
810
811
812 if (value == KVAL(K_CAPSSHIFT)) {
813 value = KVAL(K_SHIFT);
814 if (!up_flag)
815 clr_vc_kbd_led(kbd, VC_CAPSLOCK);
816 }
817
818 if (up_flag) {
819
820
821
822
823 if (shift_down[value])
824 shift_down[value]--;
825 } else
826 shift_down[value]++;
827
828 if (shift_down[value])
829 shift_state |= (1 << value);
830 else
831 shift_state &= ~(1 << value);
832
833
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;
840 }
841}
842
843static void k_meta(struct vc_data *vc, unsigned char value, char up_flag)
844{
845 if (up_flag)
846 return;
847
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);
853}
854
855static void k_ascii(struct vc_data *vc, unsigned char value, char up_flag)
856{
857 int base;
858
859 if (up_flag)
860 return;
861
862 if (value < 10) {
863
864 base = 10;
865 } else {
866
867 value -= 10;
868 base = 16;
869 }
870
871 if (npadch == -1)
872 npadch = value;
873 else
874 npadch = npadch * base + value;
875}
876
877static void k_lock(struct vc_data *vc, unsigned char value, char up_flag)
878{
879 if (up_flag || rep)
880 return;
881
882 chg_vc_kbd_lock(kbd, value);
883}
884
885static void k_slock(struct vc_data *vc, unsigned char value, char up_flag)
886{
887 k_shift(vc, value, up_flag);
888 if (up_flag || rep)
889 return;
890
891 chg_vc_kbd_slock(kbd, value);
892
893 if (!key_maps[kbd->lockstate ^ kbd->slockstate]) {
894 kbd->slockstate = 0;
895 chg_vc_kbd_slock(kbd, value);
896 }
897}
898
899
900static unsigned brl_timeout = 300;
901MODULE_PARM_DESC(brl_timeout, "Braille keys release delay in ms (0 for commit on first key release)");
902module_param(brl_timeout, uint, 0644);
903
904static unsigned brl_nbchords = 1;
905MODULE_PARM_DESC(brl_nbchords, "Number of chords that produce a braille pattern (0 for dead chords)");
906module_param(brl_nbchords, uint, 0644);
907
908static void k_brlcommit(struct vc_data *vc, unsigned int pattern, char up_flag)
909{
910 static unsigned long chords;
911 static unsigned committed;
912
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;
922 }
923 }
924}
925
926static void k_brl(struct vc_data *vc, unsigned char value, char up_flag)
927{
928 static unsigned pressed, committing;
929 static unsigned long releasestart;
930
931 if (kbd->kbdmode != VC_UNICODE) {
932 if (!up_flag)
933 pr_warning("keyboard mode must be unicode for braille patterns\n");
934 return;
935 }
936
937 if (!value) {
938 k_unicode(vc, BRL_UC_ROW, up_flag);
939 return;
940 }
941
942 if (value > 8)
943 return;
944
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;
955 }
956 pressed &= ~(1 << (value - 1));
957 if (!pressed && committing) {
958 k_brlcommit(vc, committing, 0);
959 committing = 0;
960 }
961 } else {
962 if (committing) {
963 k_brlcommit(vc, committing, 0);
964 committing = 0;
965 }
966 pressed &= ~(1 << (value - 1));
967 }
968}
969
970
971
972
973
974
975static unsigned char getledstate(void)
976{
977 return ledstate;
978}
979
980void setledstate(struct kbd_struct *kbd, unsigned int led)
981{
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;
989
990 set_leds();
991 spin_unlock_irqrestore(&led_lock, flags);
992}
993
994static inline unsigned char getleds(void)
995{
996 struct kbd_struct *kbd = kbd_table + fg_console;
997 unsigned char leds;
998 int i;
999
1000 if (kbd->ledmode == LED_SHOW_IOCTL)
1001 return ledioctl;
1002
1003 leds = kbd->ledflagstate;
1004
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);
1012 }
1013 }
1014 return leds;
1015}
1016
1017static int kbd_update_leds_helper(struct input_handle *handle, void *data)
1018{
1019 unsigned char leds = *(unsigned char *)data;
1020
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);
1026 }
1027
1028 return 0;
1029}
1030
1031
1032
1033
1034
1035
1036
1037
1038int vt_get_leds(int console, int flag)
1039{
1040 struct kbd_struct * kbd = kbd_table + console;
1041 int ret;
1042 unsigned long flags;
1043
1044 spin_lock_irqsave(&led_lock, flags);
1045 ret = vc_kbd_led(kbd, flag);
1046 spin_unlock_irqrestore(&led_lock, flags);
1047
1048 return ret;
1049}
1050EXPORT_SYMBOL_GPL(vt_get_leds);
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060void vt_set_led_state(int console, int leds)
1061{
1062 struct kbd_struct * kbd = kbd_table + console;
1063 setledstate(kbd, leds);
1064}
1065
1066
1067
1068
1069
1070
1071
1072
1073
1074
1075
1076
1077
1078
1079void vt_kbd_con_start(int console)
1080{
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);
1087}
1088
1089
1090
1091
1092
1093
1094
1095
1096void vt_kbd_con_stop(int console)
1097{
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);
1104}
1105
1106
1107
1108
1109
1110
1111
1112
1113static void kbd_bh(unsigned long dummy)
1114{
1115 unsigned char leds;
1116 unsigned long flags;
1117
1118 spin_lock_irqsave(&led_lock, flags);
1119 leds = getleds();
1120 spin_unlock_irqrestore(&led_lock, flags);
1121
1122 if (leds != ledstate) {
1123 input_handler_for_each_handle(&kbd_handler, &leds,
1124 kbd_update_leds_helper);
1125 ledstate = leds;
1126 }
1127}
1128
1129DECLARE_TASKLET_DISABLED(keyboard_tasklet, kbd_bh, 0);
1130
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)
1136
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))
1139
1140static 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 };
1156
1157#ifdef CONFIG_SPARC
1158static int sparc_l1_a_state;
1159extern void sun_do_break(void);
1160#endif
1161
1162static int emulate_raw(struct vc_data *vc, unsigned int keycode,
1163 unsigned char up_flag)
1164{
1165 int code;
1166
1167 switch (keycode) {
1168
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;
1174
1175 case KEY_HANGEUL:
1176 if (!up_flag)
1177 put_queue(vc, 0xf2);
1178 break;
1179
1180 case KEY_HANJA:
1181 if (!up_flag)
1182 put_queue(vc, 0xf1);
1183 break;
1184
1185 case KEY_SYSRQ:
1186
1187
1188
1189
1190
1191
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);
1200 }
1201 break;
1202
1203 default:
1204 if (keycode > 255)
1205 return -1;
1206
1207 code = x86_keycodes[keycode];
1208 if (!code)
1209 return -1;
1210
1211 if (code & 0x100)
1212 put_queue(vc, 0xe0);
1213 put_queue(vc, (code & 0x7f) | up_flag);
1214
1215 break;
1216 }
1217
1218 return 0;
1219}
1220
1221#else
1222
1223#define HW_RAW(dev) 0
1224
1225static int emulate_raw(struct vc_data *vc, unsigned int keycode, unsigned char up_flag)
1226{
1227 if (keycode > 127)
1228 return -1;
1229
1230 put_queue(vc, keycode | up_flag);
1231 return 0;
1232}
1233#endif
1234
1235static void kbd_rawcode(unsigned char data)
1236{
1237 struct vc_data *vc = vc_cons[fg_console].d;
1238
1239 kbd = kbd_table + vc->vc_num;
1240 if (kbd->kbdmode == VC_RAW)
1241 put_queue(vc, data);
1242}
1243
1244static void kbd_keycode(unsigned int keycode, int down, int hw_raw)
1245{
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;
1254
1255 tty = vc->port.tty;
1256
1257 if (tty && (!tty->driver_data)) {
1258
1259 tty->driver_data = vc;
1260 }
1261
1262 kbd = kbd_table + vc->vc_num;
1263
1264#ifdef CONFIG_SPARC
1265 if (keycode == KEY_STOP)
1266 sparc_l1_a_state = down;
1267#endif
1268
1269 rep = (down == 2);
1270
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);
1277
1278#ifdef CONFIG_SPARC
1279 if (keycode == KEY_A && sparc_l1_a_state) {
1280 sparc_l1_a_state = false;
1281 sun_do_break();
1282 }
1283#endif
1284
1285 if (kbd->kbdmode == VC_MEDIUMRAW) {
1286
1287
1288
1289
1290
1291
1292
1293
1294
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);
1301 }
1302 raw_mode = true;
1303 }
1304
1305 if (down)
1306 set_bit(keycode, key_down);
1307 else
1308 clear_bit(keycode, key_down);
1309
1310 if (rep &&
1311 (!vc_kbd_mode(kbd, VC_REPEAT) ||
1312 (tty && !L_ECHO(tty) && tty_chars_in_buffer(tty)))) {
1313
1314
1315
1316
1317
1318 return;
1319 }
1320
1321 param.shift = shift_final = (shift_state | kbd->slockstate) ^ kbd->lockstate;
1322 param.ledstate = kbd->ledflagstate;
1323 key_map = key_maps[shift_final];
1324
1325 rc = atomic_notifier_call_chain(&keyboard_notifier_list,
1326 KBD_KEYCODE, ¶m);
1327 if (rc == NOTIFY_STOP || !key_map) {
1328 atomic_notifier_call_chain(&keyboard_notifier_list,
1329 KBD_UNBOUND_KEYCODE, ¶m);
1330 do_compute_shiftstate();
1331 kbd->slockstate = 0;
1332 return;
1333 }
1334
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;
1341
1342 type = KTYP(keysym);
1343
1344 if (type < 0xf0) {
1345 param.value = keysym;
1346 rc = atomic_notifier_call_chain(&keyboard_notifier_list,
1347 KBD_UNICODE, ¶m);
1348 if (rc != NOTIFY_STOP)
1349 if (down && !raw_mode)
1350 to_utf8(vc, keysym);
1351 return;
1352 }
1353
1354 type -= 0xf0;
1355
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];
1362 }
1363 }
1364
1365 param.value = keysym;
1366 rc = atomic_notifier_call_chain(&keyboard_notifier_list,
1367 KBD_KEYSYM, ¶m);
1368 if (rc == NOTIFY_STOP)
1369 return;
1370
1371 if ((raw_mode || kbd->kbdmode == VC_OFF) && type != KT_SPEC && type != KT_SHIFT)
1372 return;
1373
1374 (*k_handler[type])(vc, keysym & 0xff, !down);
1375
1376 param.ledstate = kbd->ledflagstate;
1377 atomic_notifier_call_chain(&keyboard_notifier_list, KBD_POST_KEYSYM, ¶m);
1378
1379 if (type != KT_SLOCK)
1380 kbd->slockstate = 0;
1381}
1382
1383static void kbd_event(struct input_handle *handle, unsigned int event_type,
1384 unsigned int event_code, int value)
1385{
1386
1387 spin_lock(&kbd_event_lock);
1388
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));
1393
1394 spin_unlock(&kbd_event_lock);
1395
1396 tasklet_schedule(&keyboard_tasklet);
1397 do_poke_blanked_console = 1;
1398 schedule_console_callback();
1399}
1400
1401static bool kbd_match(struct input_handler *handler, struct input_dev *dev)
1402{
1403 int i;
1404
1405 if (test_bit(EV_SND, dev->evbit))
1406 return true;
1407
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;
1415 }
1416
1417 return false;
1418}
1419
1420
1421
1422
1423
1424
1425
1426static int kbd_connect(struct input_handler *handler, struct input_dev *dev,
1427 const struct input_device_id *id)
1428{
1429 struct input_handle *handle;
1430 int error;
1431
1432 handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL);
1433 if (!handle)
1434 return -ENOMEM;
1435
1436 handle->dev = dev;
1437 handle->handler = handler;
1438 handle->name = "kbd";
1439
1440 error = input_register_handle(handle);
1441 if (error)
1442 goto err_free_handle;
1443
1444 error = input_open_device(handle);
1445 if (error)
1446 goto err_unregister_handle;
1447
1448 return 0;
1449
1450 err_unregister_handle:
1451 input_unregister_handle(handle);
1452 err_free_handle:
1453 kfree(handle);
1454 return error;
1455}
1456
1457static void kbd_disconnect(struct input_handle *handle)
1458{
1459 input_close_device(handle);
1460 input_unregister_handle(handle);
1461 kfree(handle);
1462}
1463
1464
1465
1466
1467
1468static void kbd_start(struct input_handle *handle)
1469{
1470 tasklet_disable(&keyboard_tasklet);
1471
1472 if (ledstate != 0xff)
1473 kbd_update_leds_helper(handle, &ledstate);
1474
1475 tasklet_enable(&keyboard_tasklet);
1476}
1477
1478static const struct input_device_id kbd_ids[] = {
1479 {
1480 .flags = INPUT_DEVICE_ID_MATCH_EVBIT,
1481 .evbit = { BIT_MASK(EV_KEY) },
1482 },
1483
1484 {
1485 .flags = INPUT_DEVICE_ID_MATCH_EVBIT,
1486 .evbit = { BIT_MASK(EV_SND) },
1487 },
1488
1489 { },
1490};
1491
1492MODULE_DEVICE_TABLE(input, kbd_ids);
1493
1494static 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,
1502};
1503
1504int __init kbd_init(void)
1505{
1506 int i;
1507 int error;
1508
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;
1517 }
1518
1519 error = input_register_handler(&kbd_handler);
1520 if (error)
1521 return error;
1522
1523 tasklet_enable(&keyboard_tasklet);
1524 tasklet_schedule(&keyboard_tasklet);
1525
1526 return 0;
1527}
1528
1529
1530
1531
1532
1533
1534
1535
1536
1537
1538
1539
1540int vt_do_diacrit(unsigned int cmd, void __user *up, int perm)
1541{
1542 struct kbdiacrs __user *a = up;
1543 unsigned long flags;
1544 int asize;
1545 int ret = 0;
1546
1547 switch (cmd) {
1548 case KDGKBDIACR:
1549 {
1550 struct kbdiacr *diacr;
1551 int i;
1552
1553 diacr = kmalloc(MAX_DIACR * sizeof(struct kbdiacr),
1554 GFP_KERNEL);
1555 if (diacr == NULL)
1556 return -ENOMEM;
1557
1558
1559
1560 spin_lock_irqsave(&kbd_event_lock, flags);
1561
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);
1570 }
1571 spin_unlock_irqrestore(&kbd_event_lock, flags);
1572
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;
1580 }
1581 case KDGKBDIACRUC:
1582 {
1583 struct kbdiacrsuc __user *a = up;
1584 void *buf;
1585
1586 buf = kmalloc(MAX_DIACR * sizeof(struct kbdiacruc),
1587 GFP_KERNEL);
1588 if (buf == NULL)
1589 return -ENOMEM;
1590
1591
1592
1593 spin_lock_irqsave(&kbd_event_lock, flags);
1594
1595 asize = accent_table_size;
1596 memcpy(buf, accent_table, asize * sizeof(struct kbdiacruc));
1597
1598 spin_unlock_irqrestore(&kbd_event_lock, flags);
1599
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;
1607 }
1608
1609 case KDSKBDIACR:
1610 {
1611 struct kbdiacrs __user *a = up;
1612 struct kbdiacr *diacr = NULL;
1613 unsigned int ct;
1614 int i;
1615
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;
1622
1623 if (ct) {
1624 diacr = kmalloc(sizeof(struct kbdiacr) * ct,
1625 GFP_KERNEL);
1626 if (diacr == NULL)
1627 return -ENOMEM;
1628
1629 if (copy_from_user(diacr, a->kbdiacr,
1630 sizeof(struct kbdiacr) * ct)) {
1631 kfree(diacr);
1632 return -EFAULT;
1633 }
1634 }
1635
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);
1645 }
1646 spin_unlock_irqrestore(&kbd_event_lock, flags);
1647 kfree(diacr);
1648 return 0;
1649 }
1650
1651 case KDSKBDIACRUC:
1652 {
1653 struct kbdiacrsuc __user *a = up;
1654 unsigned int ct;
1655 void *buf = NULL;
1656
1657 if (!perm)
1658 return -EPERM;
1659
1660 if (get_user(ct, &a->kb_cnt))
1661 return -EFAULT;
1662
1663 if (ct >= MAX_DIACR)
1664 return -EINVAL;
1665
1666 if (ct) {
1667 buf = kmalloc(ct * sizeof(struct kbdiacruc),
1668 GFP_KERNEL);
1669 if (buf == NULL)
1670 return -ENOMEM;
1671
1672 if (copy_from_user(buf, a->kbdiacruc,
1673 ct * sizeof(struct kbdiacruc))) {
1674 kfree(buf);
1675 return -EFAULT;
1676 }
1677 }
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;
1686 }
1687 }
1688 return ret;
1689}
1690
1691
1692
1693
1694
1695
1696
1697
1698
1699int vt_do_kdskbmode(int console, unsigned int arg)
1700{
1701 struct kbd_struct * kbd = kbd_table + console;
1702 int ret = 0;
1703 unsigned long flags;
1704
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;
1726 }
1727 spin_unlock_irqrestore(&kbd_event_lock, flags);
1728 return ret;
1729}
1730
1731
1732
1733
1734
1735
1736
1737
1738
1739int vt_do_kdskbmeta(int console, unsigned int arg)
1740{
1741 struct kbd_struct * kbd = kbd_table + console;
1742 int ret = 0;
1743 unsigned long flags;
1744
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;
1755 }
1756 spin_unlock_irqrestore(&kbd_event_lock, flags);
1757 return ret;
1758}
1759
1760int vt_do_kbkeycode_ioctl(int cmd, struct kbkeycode __user *user_kbkc,
1761 int perm)
1762{
1763 struct kbkeycode tmp;
1764 int kc = 0;
1765
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;
1779 }
1780 return kc;
1781}
1782
1783#define i (tmp.kb_index)
1784#define s (tmp.kb_table)
1785#define v (tmp.kb_value)
1786
1787int vt_do_kdsk_ioctl(int cmd, struct kbentry __user *user_kbe, int perm,
1788 int console)
1789{
1790 struct kbd_struct * kbd = kbd_table + console;
1791 struct kbentry tmp;
1792 ushort *key_map, *new_map, val, ov;
1793 unsigned long flags;
1794
1795 if (copy_from_user(&tmp, user_kbe, sizeof(struct kbentry)))
1796 return -EFAULT;
1797
1798 if (!capable(CAP_SYS_TTY_CONFIG))
1799 perm = 0;
1800
1801 switch (cmd) {
1802 case KDGKBENT:
1803
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
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--;
1826 }
1827 }
1828 spin_unlock_irqrestore(&kbd_event_lock, flags);
1829 break;
1830 }
1831
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;
1838
1839
1840#if !defined(__mc68000__) && !defined(__powerpc__)
1841
1842 if (!i)
1843 break;
1844#endif
1845
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;
1853
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;
1859 }
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);
1868
1869 ov = U(key_map[i]);
1870 if (v == ov)
1871 goto out;
1872
1873
1874
1875 if (((ov == K_SAK) || (v == K_SAK)) && !capable(CAP_SYS_ADMIN)) {
1876 spin_unlock_irqrestore(&kbd_event_lock, flags);
1877 return -EPERM;
1878 }
1879 key_map[i] = U(v);
1880 if (!s && (KTYP(ov) == KT_SHIFT || KTYP(v) == KT_SHIFT))
1881 do_compute_shiftstate();
1882out:
1883 spin_unlock_irqrestore(&kbd_event_lock, flags);
1884 break;
1885 }
1886 return 0;
1887}
1888#undef i
1889#undef s
1890#undef v
1891
1892
1893int vt_do_kdgkb_ioctl(int cmd, struct kbsentry __user *user_kdgkb, int perm)
1894{
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;
1904
1905 if (!capable(CAP_SYS_TTY_CONFIG))
1906 perm = 0;
1907
1908 kbs = kmalloc(sizeof(*kbs), GFP_KERNEL);
1909 if (!kbs) {
1910 ret = -ENOMEM;
1911 goto reterr;
1912 }
1913
1914
1915 if (copy_from_user(kbs, user_kdgkb, sizeof(struct kbsentry))) {
1916 ret = -EFAULT;
1917 goto reterr;
1918 }
1919 kbs->kb_string[sizeof(kbs->kb_string)-1] = '\0';
1920 i = kbs->kb_func;
1921
1922 switch (cmd) {
1923 case KDGKBSENT:
1924 sz = sizeof(kbs->kb_string) - 1;
1925
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;
1933 }
1934 if (put_user('\0', up)) {
1935 ret = -EFAULT;
1936 goto reterr;
1937 }
1938 kfree(kbs);
1939 return ((p && *p) ? -EOVERFLOW : 0);
1940 case KDSKBSENT:
1941 if (!perm) {
1942 ret = -EPERM;
1943 goto reterr;
1944 }
1945
1946 q = func_table[i];
1947 first_free = funcbufptr + (funcbufsize - funcbufleft);
1948 for (j = i+1; j < MAX_NR_FUNC && !func_table[j]; j++)
1949 ;
1950 if (j < MAX_NR_FUNC)
1951 fj = func_table[j];
1952 else
1953 fj = first_free;
1954
1955 delta = (q ? -strlen(q) : 1) + strlen(kbs->kb_string);
1956 if (delta <= funcbufleft) {
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;
1962 }
1963 if (!q)
1964 func_table[i] = fj;
1965 funcbufleft -= delta;
1966 } else {
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;
1974 }
1975
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);
1983
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;
1989 }
1990 if (funcbufptr != func_buf)
1991 kfree(funcbufptr);
1992 funcbufptr = fnw;
1993 funcbufleft = funcbufleft - delta + sz - funcbufsize;
1994 funcbufsize = sz;
1995 }
1996 strcpy(func_table[i], kbs->kb_string);
1997 break;
1998 }
1999 ret = 0;
2000reterr:
2001 kfree(kbs);
2002 return ret;
2003}
2004
2005int vt_do_kdskled(int console, int cmd, unsigned long arg, int perm)
2006{
2007 struct kbd_struct * kbd = kbd_table + console;
2008 unsigned long flags;
2009 unsigned char ucval;
2010
2011 switch(cmd) {
2012
2013
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);
2019
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;
2031
2032
2033
2034 case KDGETLED:
2035 ucval = getledstate();
2036 return put_user(ucval, (char __user *)arg);
2037
2038 case KDSETLED:
2039 if (!perm)
2040 return -EPERM;
2041 setledstate(kbd, arg);
2042 return 0;
2043 }
2044 return -ENOIOCTLCMD;
2045}
2046
2047int vt_do_kdgkbmode(int console)
2048{
2049 struct kbd_struct * kbd = kbd_table + console;
2050
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;
2062 }
2063}
2064
2065
2066
2067
2068
2069
2070
2071int vt_do_kdgkbmeta(int console)
2072{
2073 struct kbd_struct * kbd = kbd_table + console;
2074
2075 return vc_kbd_mode(kbd, VC_META) ? K_ESCPREFIX : K_METABIT;
2076}
2077
2078
2079
2080
2081
2082
2083
2084void vt_reset_unicode(int console)
2085{
2086 unsigned long flags;
2087
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);
2091}
2092
2093
2094
2095
2096
2097
2098
2099int vt_get_shift_state(void)
2100{
2101
2102 return shift_state;
2103}
2104
2105
2106
2107
2108
2109
2110
2111
2112void vt_reset_keyboard(int console)
2113{
2114 struct kbd_struct * kbd = kbd_table + console;
2115 unsigned long flags;
2116
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
2129
2130 spin_unlock_irqrestore(&kbd_event_lock, flags);
2131}
2132
2133
2134
2135
2136
2137
2138
2139
2140
2141
2142int vt_get_kbd_mode_bit(int console, int bit)
2143{
2144 struct kbd_struct * kbd = kbd_table + console;
2145 return vc_kbd_mode(kbd, bit);
2146}
2147
2148
2149
2150
2151
2152
2153
2154
2155
2156
2157void vt_set_kbd_mode_bit(int console, int bit)
2158{
2159 struct kbd_struct * kbd = kbd_table + console;
2160 unsigned long flags;
2161
2162 spin_lock_irqsave(&kbd_event_lock, flags);
2163 set_vc_kbd_mode(kbd, bit);
2164 spin_unlock_irqrestore(&kbd_event_lock, flags);
2165}
2166
2167
2168
2169
2170
2171
2172
2173
2174
2175
2176void vt_clr_kbd_mode_bit(int console, int bit)
2177{
2178 struct kbd_struct * kbd = kbd_table + console;
2179 unsigned long flags;
2180
2181 spin_lock_irqsave(&kbd_event_lock, flags);
2182 clr_vc_kbd_mode(kbd, bit);
2183 spin_unlock_irqrestore(&kbd_event_lock, flags);
2184}
2185