Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | * Written for linux by Johan Myreen as a translation from |
| 3 | * the assembly version by Linus (with diacriticals added) |
| 4 | * |
| 5 | * Some additional features added by Christoph Niemann (ChN), March 1993 |
| 6 | * |
| 7 | * Loadable keymaps by Risto Kankkunen, May 1993 |
| 8 | * |
| 9 | * Diacriticals redone & other small changes, aeb@cwi.nl, June 1993 |
| 10 | * Added decr/incr_console, dynamic keymaps, Unicode support, |
| 11 | * dynamic function/string keys, led setting, Sept 1994 |
| 12 | * `Sticky' modifier keys, 951006. |
| 13 | * |
| 14 | * 11-11-96: SAK should now work in the raw mode (Martin Mares) |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 15 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | * Modified to provide 'generic' keyboard support by Hamish Macdonald |
| 17 | * Merge with the m68k keyboard driver and split-off of the PC low-level |
| 18 | * parts by Geert Uytterhoeven, May 1997 |
| 19 | * |
| 20 | * 27-05-97: Added support for the Magic SysRq Key (Martin Mares) |
| 21 | * 30-07-98: Dead keys redone, aeb@cwi.nl. |
| 22 | * 21-08-02: Converted to input API, major cleanup. (Vojtech Pavlik) |
| 23 | */ |
| 24 | |
Dmitry Torokhov | 9272e9a | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 25 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| 26 | |
Jan Engelhardt | 759448f | 2007-07-15 23:40:40 -0700 | [diff] [blame] | 27 | #include <linux/consolemap.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 40 | #include <linux/input.h> |
Adrian Bunk | 83cc5ed | 2006-06-25 05:47:41 -0700 | [diff] [blame] | 41 | #include <linux/reboot.h> |
Samuel Thibault | 41ab439 | 2007-10-18 23:39:12 -0700 | [diff] [blame] | 42 | #include <linux/notifier.h> |
Julia Lawall | b39b044 | 2008-04-17 09:28:25 -0400 | [diff] [blame] | 43 | #include <linux/jiffies.h> |
Greg Kroah-Hartman | 6623d64 | 2012-02-27 15:18:56 -0800 | [diff] [blame] | 44 | #include <linux/uaccess.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 45 | |
Geert Uytterhoeven | 98c2b37 | 2011-09-11 13:59:29 +0200 | [diff] [blame] | 46 | #include <asm/irq_regs.h> |
| 47 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | extern void ctrl_alt_del(void); |
| 49 | |
| 50 | /* |
| 51 | * Exported functions/variables |
| 52 | */ |
| 53 | |
| 54 | #define KBD_DEFMODE ((1 << VC_REPEAT) | (1 << VC_META)) |
| 55 | |
Joshua Cov | b2d0b7a | 2012-04-13 21:08:26 +0200 | [diff] [blame] | 56 | #if defined(CONFIG_X86) || defined(CONFIG_PARISC) |
| 57 | #include <asm/kbdleds.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 | #else |
Joshua Cov | b2d0b7a | 2012-04-13 21:08:26 +0200 | [diff] [blame] | 59 | static inline int kbd_defleds(void) |
| 60 | { |
| 61 | return 0; |
| 62 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 63 | #endif |
| 64 | |
| 65 | #define KBD_DEFLOCK 0 |
| 66 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 67 | /* |
| 68 | * Handler Tables. |
| 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,\ |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 75 | k_slock, k_dead2, k_brl, k_ignore |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 76 | |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 77 | typedef void (k_handler_fn)(struct vc_data *vc, unsigned char value, |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 78 | char up_flag); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 79 | static k_handler_fn K_HANDLERS; |
Dmitry Torokhov | 97f5f0c | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 80 | static k_handler_fn *k_handler[16] = { K_HANDLERS }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | |
| 82 | #define FN_HANDLERS\ |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 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 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 88 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 89 | typedef void (fn_handler_fn)(struct vc_data *vc); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 90 | static fn_handler_fn FN_HANDLERS; |
| 91 | static fn_handler_fn *fn_handler[] = { FN_HANDLERS }; |
| 92 | |
| 93 | /* |
| 94 | * Variables exported for vt_ioctl.c |
| 95 | */ |
| 96 | |
Eric W. Biederman | 81af8d6 | 2006-10-02 02:17:13 -0700 | [diff] [blame] | 97 | struct vt_spawn_console vt_spawn_con = { |
Milind Arun Choudhary | ccc9425 | 2007-05-08 00:30:09 -0700 | [diff] [blame] | 98 | .lock = __SPIN_LOCK_UNLOCKED(vt_spawn_con.lock), |
Eric W. Biederman | 81af8d6 | 2006-10-02 02:17:13 -0700 | [diff] [blame] | 99 | .pid = NULL, |
| 100 | .sig = 0, |
| 101 | }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 102 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 103 | |
| 104 | /* |
| 105 | * Internal Data. |
| 106 | */ |
| 107 | |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 108 | static struct kbd_struct kbd_table[MAX_NR_CONSOLES]; |
| 109 | static struct kbd_struct *kbd = kbd_table; |
| 110 | |
| 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 |
| 116 | }; |
| 117 | |
| 118 | static const int NR_TYPES = ARRAY_SIZE(max_vals); |
| 119 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 120 | static struct input_handler kbd_handler; |
Dmitry Torokhov | 21cea58 | 2009-11-29 23:40:58 -0800 | [diff] [blame] | 121 | static DEFINE_SPINLOCK(kbd_event_lock); |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 122 | static DEFINE_SPINLOCK(led_lock); |
Jiri Slaby | 7b19ada | 2007-10-18 23:40:32 -0700 | [diff] [blame] | 123 | static unsigned long key_down[BITS_TO_LONGS(KEY_CNT)]; /* keyboard key bitmap */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 124 | static unsigned char shift_down[NR_SHIFT]; /* shift state counters.. */ |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 125 | static bool dead_key_next; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 126 | static int npadch = -1; /* -1 or number assembled on pad */ |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 127 | static unsigned int diacr; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 128 | static char rep; /* flag telling character repeat */ |
| 129 | |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 130 | static int shift_state = 0; |
| 131 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 132 | static unsigned char ledstate = 0xff; /* undefined */ |
| 133 | static unsigned char ledioctl; |
| 134 | |
| 135 | static struct ledptr { |
| 136 | unsigned int *addr; |
| 137 | unsigned int mask; |
| 138 | unsigned char valid:1; |
| 139 | } ledptrs[3]; |
| 140 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 141 | /* |
Samuel Thibault | 41ab439 | 2007-10-18 23:39:12 -0700 | [diff] [blame] | 142 | * Notifier list for console keyboard events |
| 143 | */ |
| 144 | static ATOMIC_NOTIFIER_HEAD(keyboard_notifier_list); |
| 145 | |
| 146 | int register_keyboard_notifier(struct notifier_block *nb) |
| 147 | { |
| 148 | return atomic_notifier_chain_register(&keyboard_notifier_list, nb); |
| 149 | } |
| 150 | EXPORT_SYMBOL_GPL(register_keyboard_notifier); |
| 151 | |
| 152 | int unregister_keyboard_notifier(struct notifier_block *nb) |
| 153 | { |
| 154 | return atomic_notifier_chain_unregister(&keyboard_notifier_list, nb); |
| 155 | } |
| 156 | EXPORT_SYMBOL_GPL(unregister_keyboard_notifier); |
| 157 | |
| 158 | /* |
Marvin Raaijmakers | c8e4c77 | 2007-03-14 22:50:42 -0400 | [diff] [blame] | 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. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 166 | */ |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 167 | |
| 168 | struct getset_keycode_data { |
Mauro Carvalho Chehab | 8613e4c | 2010-09-09 21:54:22 -0700 | [diff] [blame] | 169 | struct input_keymap_entry ke; |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 170 | int error; |
| 171 | }; |
| 172 | |
| 173 | static int getkeycode_helper(struct input_handle *handle, void *data) |
| 174 | { |
| 175 | struct getset_keycode_data *d = data; |
| 176 | |
Mauro Carvalho Chehab | 8613e4c | 2010-09-09 21:54:22 -0700 | [diff] [blame] | 177 | d->error = input_get_keycode(handle->dev, &d->ke); |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 178 | |
| 179 | return d->error == 0; /* stop as soon as we successfully get one */ |
| 180 | } |
| 181 | |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 182 | static int getkeycode(unsigned int scancode) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 183 | { |
Mauro Carvalho Chehab | 8613e4c | 2010-09-09 21:54:22 -0700 | [diff] [blame] | 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)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 194 | |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 195 | input_handler_for_each_handle(&kbd_handler, &d, getkeycode_helper); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 196 | |
Mauro Carvalho Chehab | 8613e4c | 2010-09-09 21:54:22 -0700 | [diff] [blame] | 197 | return d.error ?: d.ke.keycode; |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 198 | } |
| 199 | |
| 200 | static int setkeycode_helper(struct input_handle *handle, void *data) |
| 201 | { |
| 202 | struct getset_keycode_data *d = data; |
| 203 | |
Mauro Carvalho Chehab | 8613e4c | 2010-09-09 21:54:22 -0700 | [diff] [blame] | 204 | d->error = input_set_keycode(handle->dev, &d->ke); |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 205 | |
| 206 | return d->error == 0; /* stop as soon as we successfully set one */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 207 | } |
| 208 | |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 209 | static int setkeycode(unsigned int scancode, unsigned int keycode) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 210 | { |
Mauro Carvalho Chehab | 8613e4c | 2010-09-09 21:54:22 -0700 | [diff] [blame] | 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)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 221 | |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 222 | input_handler_for_each_handle(&kbd_handler, &d, setkeycode_helper); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 223 | |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 224 | return d.error; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 225 | } |
| 226 | |
| 227 | /* |
Dmitry Torokhov | 18f7ad5 | 2009-12-15 16:26:53 -0800 | [diff] [blame] | 228 | * Making beeps and bells. Note that we prefer beeps to bells, but when |
| 229 | * shutting the sound off we do both. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 230 | */ |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 231 | |
| 232 | static 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)) { |
Dmitry Torokhov | 18f7ad5 | 2009-12-15 16:26:53 -0800 | [diff] [blame] | 238 | if (test_bit(SND_TONE, dev->sndbit)) { |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 239 | input_inject_event(handle, EV_SND, SND_TONE, *hz); |
Dmitry Torokhov | 18f7ad5 | 2009-12-15 16:26:53 -0800 | [diff] [blame] | 240 | if (*hz) |
| 241 | return 0; |
| 242 | } |
| 243 | if (test_bit(SND_BELL, dev->sndbit)) |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 244 | input_inject_event(handle, EV_SND, SND_BELL, *hz ? 1 : 0); |
| 245 | } |
| 246 | |
| 247 | return 0; |
| 248 | } |
| 249 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 250 | static void kd_nosound(unsigned long ignored) |
| 251 | { |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 252 | static unsigned int zero; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 253 | |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 254 | input_handler_for_each_handle(&kbd_handler, &zero, kd_sound_helper); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 255 | } |
| 256 | |
Ingo Molnar | 8d06afa | 2005-09-09 13:10:40 -0700 | [diff] [blame] | 257 | static DEFINE_TIMER(kd_mksound_timer, kd_nosound, 0, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 258 | |
| 259 | void kd_mksound(unsigned int hz, unsigned int ticks) |
| 260 | { |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 261 | del_timer_sync(&kd_mksound_timer); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 262 | |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 263 | input_handler_for_each_handle(&kbd_handler, &hz, kd_sound_helper); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 264 | |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 265 | if (hz && ticks) |
| 266 | mod_timer(&kd_mksound_timer, jiffies + ticks); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 267 | } |
Samuel Thibault | f7511d5 | 2008-04-30 00:54:51 -0700 | [diff] [blame] | 268 | EXPORT_SYMBOL(kd_mksound); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 269 | |
| 270 | /* |
| 271 | * Setting the keyboard rate. |
| 272 | */ |
| 273 | |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 274 | static 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 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 295 | int kbd_rate(struct kbd_repeat *rep) |
| 296 | { |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 297 | struct kbd_repeat data[2] = { *rep }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 298 | |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 299 | input_handler_for_each_handle(&kbd_handler, data, kbd_rate_helper); |
| 300 | *rep = data[1]; /* Copy currently used settings */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 301 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 302 | return 0; |
| 303 | } |
| 304 | |
| 305 | /* |
| 306 | * Helper Functions. |
| 307 | */ |
| 308 | static void put_queue(struct vc_data *vc, int ch) |
| 309 | { |
Jiri Slaby | 92a19f9 | 2013-01-03 15:53:03 +0100 | [diff] [blame] | 310 | tty_insert_flip_char(&vc->port, ch, 0); |
Jiri Slaby | 6732c8b | 2013-01-03 15:53:07 +0100 | [diff] [blame^] | 311 | tty_schedule_flip(&vc->port); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 312 | } |
| 313 | |
| 314 | static void puts_queue(struct vc_data *vc, char *cp) |
| 315 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 316 | while (*cp) { |
Jiri Slaby | 92a19f9 | 2013-01-03 15:53:03 +0100 | [diff] [blame] | 317 | tty_insert_flip_char(&vc->port, *cp, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 318 | cp++; |
| 319 | } |
Jiri Slaby | 6732c8b | 2013-01-03 15:53:07 +0100 | [diff] [blame^] | 320 | tty_schedule_flip(&vc->port); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 321 | } |
| 322 | |
| 323 | static 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 | * 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 |
Jan Engelhardt | 759448f | 2007-07-15 23:40:40 -0700 | [diff] [blame] | 336 | * in utf-8 already. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 337 | */ |
Jan Engelhardt | 759448f | 2007-07-15 23:40:40 -0700 | [diff] [blame] | 338 | static void to_utf8(struct vc_data *vc, uint c) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 339 | { |
| 340 | if (c < 0x80) |
| 341 | /* 0******* */ |
| 342 | put_queue(vc, c); |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 343 | else if (c < 0x800) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 344 | /* 110***** 10****** */ |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 345 | put_queue(vc, 0xc0 | (c >> 6)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 346 | put_queue(vc, 0x80 | (c & 0x3f)); |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 347 | } else if (c < 0x10000) { |
| 348 | if (c >= 0xD800 && c < 0xE000) |
Jan Engelhardt | 759448f | 2007-07-15 23:40:40 -0700 | [diff] [blame] | 349 | return; |
| 350 | if (c == 0xFFFF) |
| 351 | return; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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)); |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 356 | } else if (c < 0x110000) { |
Jan Engelhardt | 759448f | 2007-07-15 23:40:40 -0700 | [diff] [blame] | 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)); |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 362 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 363 | } |
| 364 | |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 365 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 368 | * undefined, so that shiftkey release is seen. The caller must hold the |
| 369 | * kbd_event_lock. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 370 | */ |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 371 | |
| 372 | static void do_compute_shiftstate(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 373 | { |
| 374 | unsigned int i, j, k, sym, val; |
| 375 | |
| 376 | shift_state = 0; |
| 377 | memset(shift_down, 0, sizeof(shift_down)); |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 378 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 405 | /* We still have to export this method to vt.c */ |
| 406 | void 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 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 414 | /* |
| 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. |
| 420 | */ |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 421 | static unsigned int handle_diacr(struct vc_data *vc, unsigned int ch) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 422 | { |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 423 | unsigned int d = diacr; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 424 | unsigned int i; |
| 425 | |
| 426 | diacr = 0; |
| 427 | |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 435 | } |
| 436 | |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 437 | if (ch == ' ' || ch == (BRL_UC_ROW|0) || ch == d) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 438 | return d; |
| 439 | |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 440 | if (kbd->kbdmode == VC_UNICODE) |
Samuel Thibault | 04c7197 | 2007-10-16 23:27:04 -0700 | [diff] [blame] | 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 | } |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 447 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 448 | return ch; |
| 449 | } |
| 450 | |
| 451 | /* |
| 452 | * Special function handlers |
| 453 | */ |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 454 | static void fn_enter(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 455 | { |
| 456 | if (diacr) { |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 457 | if (kbd->kbdmode == VC_UNICODE) |
Samuel Thibault | 04c7197 | 2007-10-16 23:27:04 -0700 | [diff] [blame] | 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 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 464 | diacr = 0; |
| 465 | } |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 466 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 467 | put_queue(vc, 13); |
| 468 | if (vc_kbd_mode(kbd, VC_CRLF)) |
| 469 | put_queue(vc, 10); |
| 470 | } |
| 471 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 472 | static void fn_caps_toggle(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 473 | { |
| 474 | if (rep) |
| 475 | return; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 476 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 477 | chg_vc_kbd_led(kbd, VC_CAPSLOCK); |
| 478 | } |
| 479 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 480 | static void fn_caps_on(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 481 | { |
| 482 | if (rep) |
| 483 | return; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 484 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 485 | set_vc_kbd_led(kbd, VC_CAPSLOCK); |
| 486 | } |
| 487 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 488 | static void fn_show_ptregs(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 489 | { |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 490 | struct pt_regs *regs = get_irq_regs(); |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 491 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 492 | if (regs) |
| 493 | show_regs(regs); |
| 494 | } |
| 495 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 496 | static void fn_hold(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 497 | { |
Alan Cox | 8ce7326 | 2010-06-01 22:52:56 +0200 | [diff] [blame] | 498 | struct tty_struct *tty = vc->port.tty; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 499 | |
| 500 | if (rep || !tty) |
| 501 | return; |
| 502 | |
| 503 | /* |
| 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.) |
| 507 | */ |
| 508 | if (tty->stopped) |
| 509 | start_tty(tty); |
| 510 | else |
| 511 | stop_tty(tty); |
| 512 | } |
| 513 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 514 | static void fn_num(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 515 | { |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 516 | if (vc_kbd_mode(kbd, VC_APPLIC)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 517 | applkey(vc, 'P', 1); |
| 518 | else |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 519 | fn_bare_num(vc); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 520 | } |
| 521 | |
| 522 | /* |
| 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. |
| 527 | */ |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 528 | static void fn_bare_num(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 529 | { |
| 530 | if (!rep) |
| 531 | chg_vc_kbd_led(kbd, VC_NUMLOCK); |
| 532 | } |
| 533 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 534 | static void fn_lastcons(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 535 | { |
| 536 | /* switch to the last used console, ChN */ |
| 537 | set_console(last_console); |
| 538 | } |
| 539 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 540 | static void fn_dec_console(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 541 | { |
| 542 | int i, cur = fg_console; |
| 543 | |
| 544 | /* Currently switching? Queue this next switch relative to that. */ |
| 545 | if (want_console != -1) |
| 546 | cur = want_console; |
| 547 | |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 548 | for (i = cur - 1; i != cur; i--) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 549 | if (i == -1) |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 550 | i = MAX_NR_CONSOLES - 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 551 | if (vc_cons_allocated(i)) |
| 552 | break; |
| 553 | } |
| 554 | set_console(i); |
| 555 | } |
| 556 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 557 | static void fn_inc_console(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 558 | { |
| 559 | int i, cur = fg_console; |
| 560 | |
| 561 | /* Currently switching? Queue this next switch relative to that. */ |
| 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 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 574 | static void fn_send_intr(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 575 | { |
Jiri Slaby | 92a19f9 | 2013-01-03 15:53:03 +0100 | [diff] [blame] | 576 | tty_insert_flip_char(&vc->port, 0, TTY_BREAK); |
Jiri Slaby | 6732c8b | 2013-01-03 15:53:07 +0100 | [diff] [blame^] | 577 | tty_schedule_flip(&vc->port); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 578 | } |
| 579 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 580 | static void fn_scroll_forw(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 581 | { |
| 582 | scrollfront(vc, 0); |
| 583 | } |
| 584 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 585 | static void fn_scroll_back(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 586 | { |
| 587 | scrollback(vc, 0); |
| 588 | } |
| 589 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 590 | static void fn_show_mem(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 591 | { |
David Rientjes | b2b755b | 2011-03-24 15:18:15 -0700 | [diff] [blame] | 592 | show_mem(0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 593 | } |
| 594 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 595 | static void fn_show_state(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 596 | { |
| 597 | show_state(); |
| 598 | } |
| 599 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 600 | static void fn_boot_it(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 601 | { |
| 602 | ctrl_alt_del(); |
| 603 | } |
| 604 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 605 | static void fn_compose(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 606 | { |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 607 | dead_key_next = true; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 608 | } |
| 609 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 610 | static void fn_spawn_con(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 611 | { |
Eric W. Biederman | 81af8d6 | 2006-10-02 02:17:13 -0700 | [diff] [blame] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 619 | } |
| 620 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 621 | static void fn_SAK(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 622 | { |
Eric W. Biederman | 8b6312f | 2007-02-10 01:44:34 -0800 | [diff] [blame] | 623 | struct work_struct *SAK_work = &vc_cons[fg_console].SAK_work; |
Eric W. Biederman | 8b6312f | 2007-02-10 01:44:34 -0800 | [diff] [blame] | 624 | schedule_work(SAK_work); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 625 | } |
| 626 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 627 | static void fn_null(struct vc_data *vc) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 628 | { |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 629 | do_compute_shiftstate(); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 630 | } |
| 631 | |
| 632 | /* |
| 633 | * Special key handlers |
| 634 | */ |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 635 | static void k_ignore(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 636 | { |
| 637 | } |
| 638 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 639 | static void k_spec(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 640 | { |
| 641 | if (up_flag) |
| 642 | return; |
| 643 | if (value >= ARRAY_SIZE(fn_handler)) |
| 644 | return; |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 645 | if ((kbd->kbdmode == VC_RAW || |
Arthur Taylor | 9fc3de9 | 2011-02-04 13:55:50 -0800 | [diff] [blame] | 646 | kbd->kbdmode == VC_MEDIUMRAW || |
| 647 | kbd->kbdmode == VC_OFF) && |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 648 | value != KVAL(K_SAK)) |
| 649 | return; /* SAK is allowed even in raw mode */ |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 650 | fn_handler[value](vc); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 651 | } |
| 652 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 653 | static void k_lowercase(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 654 | { |
Dmitry Torokhov | 9272e9a | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 655 | pr_err("k_lowercase was called - impossible\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 656 | } |
| 657 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 658 | static void k_unicode(struct vc_data *vc, unsigned int value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 659 | { |
| 660 | if (up_flag) |
| 661 | return; /* no action, if this is a key release */ |
| 662 | |
| 663 | if (diacr) |
| 664 | value = handle_diacr(vc, value); |
| 665 | |
| 666 | if (dead_key_next) { |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 667 | dead_key_next = false; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 668 | diacr = value; |
| 669 | return; |
| 670 | } |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 671 | if (kbd->kbdmode == VC_UNICODE) |
Samuel Thibault | 04c7197 | 2007-10-16 23:27:04 -0700 | [diff] [blame] | 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 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 678 | } |
| 679 | |
| 680 | /* |
| 681 | * Handle dead key. Note that we now may have several |
| 682 | * dead keys modifying the same character. Very useful |
| 683 | * for Vietnamese. |
| 684 | */ |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 685 | static void k_deadunicode(struct vc_data *vc, unsigned int value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 686 | { |
| 687 | if (up_flag) |
| 688 | return; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 689 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 690 | diacr = (diacr ? handle_diacr(vc, value) : value); |
| 691 | } |
| 692 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 693 | static void k_self(struct vc_data *vc, unsigned char value, char up_flag) |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 694 | { |
Jiri Bohac | d2187eb | 2008-06-12 15:21:51 -0700 | [diff] [blame] | 695 | k_unicode(vc, conv_8bit_to_uni(value), up_flag); |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 696 | } |
| 697 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 698 | static void k_dead2(struct vc_data *vc, unsigned char value, char up_flag) |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 699 | { |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 700 | k_deadunicode(vc, value, up_flag); |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 701 | } |
| 702 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 703 | /* |
| 704 | * Obsolete - for backwards compatibility only |
| 705 | */ |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 706 | static void k_dead(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 707 | { |
Andreas Mohr | 0f5e560 | 2006-06-05 00:18:00 -0400 | [diff] [blame] | 708 | static const unsigned char ret_diacr[NR_DEAD] = {'`', '\'', '^', '~', '"', ',' }; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 709 | |
| 710 | k_deadunicode(vc, ret_diacr[value], up_flag); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 711 | } |
| 712 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 713 | static void k_cons(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 714 | { |
| 715 | if (up_flag) |
| 716 | return; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 717 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 718 | set_console(value); |
| 719 | } |
| 720 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 721 | static void k_fn(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 722 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 723 | if (up_flag) |
| 724 | return; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 725 | |
| 726 | if ((unsigned)value < ARRAY_SIZE(func_table)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 727 | if (func_table[value]) |
| 728 | puts_queue(vc, func_table[value]); |
| 729 | } else |
Dmitry Torokhov | 9272e9a | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 730 | pr_err("k_fn called with value=%d\n", value); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 731 | } |
| 732 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 733 | static void k_cur(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 734 | { |
Brandon Philips | e52b29c | 2006-11-04 22:09:08 -0500 | [diff] [blame] | 735 | static const char cur_chars[] = "BDCA"; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 736 | |
| 737 | if (up_flag) |
| 738 | return; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 739 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 740 | applkey(vc, cur_chars[value], vc_kbd_mode(kbd, VC_CKMODE)); |
| 741 | } |
| 742 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 743 | static void k_pad(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 744 | { |
Andreas Mohr | 0f5e560 | 2006-06-05 00:18:00 -0400 | [diff] [blame] | 745 | static const char pad_chars[] = "0123456789+-*/\015,.?()#"; |
| 746 | static const char app_map[] = "pqrstuvwxylSRQMnnmPQS"; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 747 | |
| 748 | if (up_flag) |
| 749 | return; /* no action, if this is a key release */ |
| 750 | |
| 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; |
| 755 | } |
| 756 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 757 | if (!vc_kbd_led(kbd, VC_NUMLOCK)) { |
| 758 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 759 | switch (value) { |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 794 | } |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 795 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 802 | static void k_shift(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 803 | { |
| 804 | int old_state = shift_state; |
| 805 | |
| 806 | if (rep) |
| 807 | return; |
| 808 | /* |
| 809 | * Mimic typewriter: |
| 810 | * a CapsShift key acts like Shift but undoes CapsLock |
| 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 | * handle the case that two shift or control |
| 821 | * keys are depressed simultaneously |
| 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 | /* kludge */ |
| 834 | if (up_flag && shift_state != old_state && npadch != -1) { |
| 835 | if (kbd->kbdmode == VC_UNICODE) |
Jan Engelhardt | 759448f | 2007-07-15 23:40:40 -0700 | [diff] [blame] | 836 | to_utf8(vc, npadch); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 837 | else |
| 838 | put_queue(vc, npadch & 0xff); |
| 839 | npadch = -1; |
| 840 | } |
| 841 | } |
| 842 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 843 | static void k_meta(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 855 | static void k_ascii(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 856 | { |
| 857 | int base; |
| 858 | |
| 859 | if (up_flag) |
| 860 | return; |
| 861 | |
| 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; |
| 869 | } |
| 870 | |
| 871 | if (npadch == -1) |
| 872 | npadch = value; |
| 873 | else |
| 874 | npadch = npadch * base + value; |
| 875 | } |
| 876 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 877 | static void k_lock(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 878 | { |
| 879 | if (up_flag || rep) |
| 880 | return; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 881 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 882 | chg_vc_kbd_lock(kbd, value); |
| 883 | } |
| 884 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 885 | static void k_slock(struct vc_data *vc, unsigned char value, char up_flag) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 886 | { |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 887 | k_shift(vc, value, up_flag); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 888 | if (up_flag || rep) |
| 889 | return; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 890 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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); |
| 896 | } |
| 897 | } |
| 898 | |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 899 | /* by default, 300ms interval for combination release */ |
Samuel Thibault | 77426d7 | 2006-04-26 00:14:10 -0400 | [diff] [blame] | 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); |
| 903 | |
| 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); |
| 907 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 908 | static void k_brlcommit(struct vc_data *vc, unsigned int pattern, char up_flag) |
Samuel Thibault | 77426d7 | 2006-04-26 00:14:10 -0400 | [diff] [blame] | 909 | { |
| 910 | static unsigned long chords; |
| 911 | static unsigned committed; |
| 912 | |
| 913 | if (!brl_nbchords) |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 914 | k_deadunicode(vc, BRL_UC_ROW | pattern, up_flag); |
Samuel Thibault | 77426d7 | 2006-04-26 00:14:10 -0400 | [diff] [blame] | 915 | else { |
| 916 | committed |= pattern; |
| 917 | chords++; |
| 918 | if (chords == brl_nbchords) { |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 919 | k_unicode(vc, BRL_UC_ROW | committed, up_flag); |
Samuel Thibault | 77426d7 | 2006-04-26 00:14:10 -0400 | [diff] [blame] | 920 | chords = 0; |
| 921 | committed = 0; |
| 922 | } |
| 923 | } |
| 924 | } |
| 925 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 926 | static void k_brl(struct vc_data *vc, unsigned char value, char up_flag) |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 927 | { |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 928 | static unsigned pressed, committing; |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 929 | static unsigned long releasestart; |
| 930 | |
| 931 | if (kbd->kbdmode != VC_UNICODE) { |
| 932 | if (!up_flag) |
Dmitry Torokhov | 9272e9a | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 933 | pr_warning("keyboard mode must be unicode for braille patterns\n"); |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 934 | return; |
| 935 | } |
| 936 | |
| 937 | if (!value) { |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 938 | k_unicode(vc, BRL_UC_ROW, up_flag); |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 939 | return; |
| 940 | } |
| 941 | |
| 942 | if (value > 8) |
| 943 | return; |
| 944 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 945 | if (!up_flag) { |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 946 | pressed |= 1 << (value - 1); |
| 947 | if (!brl_timeout) |
| 948 | committing = pressed; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 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)); |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 967 | } |
| 968 | } |
| 969 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 970 | /* |
| 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. |
| 974 | */ |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 975 | static unsigned char getledstate(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 976 | { |
| 977 | return ledstate; |
| 978 | } |
| 979 | |
| 980 | void setledstate(struct kbd_struct *kbd, unsigned int led) |
| 981 | { |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 982 | unsigned long flags; |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 983 | spin_lock_irqsave(&led_lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 984 | if (!(led & ~7)) { |
| 985 | ledioctl = led; |
| 986 | kbd->ledmode = LED_SHOW_IOCTL; |
| 987 | } else |
| 988 | kbd->ledmode = LED_SHOW_FLAGS; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 989 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 990 | set_leds(); |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 991 | spin_unlock_irqrestore(&led_lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 992 | } |
| 993 | |
| 994 | static 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 | |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 1017 | static int kbd_update_leds_helper(struct input_handle *handle, void *data) |
| 1018 | { |
| 1019 | unsigned char leds = *(unsigned char *)data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1020 | |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 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 | |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 1031 | /** |
| 1032 | * vt_get_leds - helper for braille console |
| 1033 | * @console: console to read |
| 1034 | * @flag: flag we want to check |
| 1035 | * |
| 1036 | * Check the status of a keyboard led flag and report it back |
| 1037 | */ |
| 1038 | int vt_get_leds(int console, int flag) |
| 1039 | { |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 1040 | struct kbd_struct * kbd = kbd_table + console; |
| 1041 | int ret; |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 1042 | unsigned long flags; |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 1043 | |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 1044 | spin_lock_irqsave(&led_lock, flags); |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 1045 | ret = vc_kbd_led(kbd, flag); |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 1046 | spin_unlock_irqrestore(&led_lock, flags); |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 1047 | |
| 1048 | return ret; |
| 1049 | } |
| 1050 | EXPORT_SYMBOL_GPL(vt_get_leds); |
| 1051 | |
| 1052 | /** |
| 1053 | * vt_set_led_state - set LED state of a console |
| 1054 | * @console: console to set |
| 1055 | * @leds: LED bits |
| 1056 | * |
| 1057 | * Set the LEDs on a console. This is a wrapper for the VT layer |
| 1058 | * so that we can keep kbd knowledge internal |
| 1059 | */ |
| 1060 | void 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 | * vt_kbd_con_start - Keyboard side of console start |
| 1068 | * @console: console |
| 1069 | * |
| 1070 | * Handle console start. This is a wrapper for the VT layer |
| 1071 | * so that we can keep kbd knowledge internal |
Alan Cox | 84f904e | 2012-05-01 16:12:19 +0100 | [diff] [blame] | 1072 | * |
| 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! |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 1078 | */ |
| 1079 | void vt_kbd_con_start(int console) |
| 1080 | { |
| 1081 | struct kbd_struct * kbd = kbd_table + console; |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 1082 | unsigned long flags; |
| 1083 | spin_lock_irqsave(&led_lock, flags); |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 1084 | clr_vc_kbd_led(kbd, VC_SCROLLOCK); |
| 1085 | set_leds(); |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 1086 | spin_unlock_irqrestore(&led_lock, flags); |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 1087 | } |
| 1088 | |
| 1089 | /** |
| 1090 | * vt_kbd_con_stop - Keyboard side of console stop |
| 1091 | * @console: console |
| 1092 | * |
| 1093 | * Handle console stop. This is a wrapper for the VT layer |
| 1094 | * so that we can keep kbd knowledge internal |
| 1095 | */ |
| 1096 | void vt_kbd_con_stop(int console) |
| 1097 | { |
| 1098 | struct kbd_struct * kbd = kbd_table + console; |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 1099 | unsigned long flags; |
| 1100 | spin_lock_irqsave(&led_lock, flags); |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 1101 | set_vc_kbd_led(kbd, VC_SCROLLOCK); |
| 1102 | set_leds(); |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 1103 | spin_unlock_irqrestore(&led_lock, flags); |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 1104 | } |
| 1105 | |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 1106 | /* |
| 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 |
Alan Cox | 84f904e | 2012-05-01 16:12:19 +0100 | [diff] [blame] | 1110 | * registered yet but we already getting updates from the VT to |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 1111 | * update led state. |
| 1112 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1113 | static void kbd_bh(unsigned long dummy) |
| 1114 | { |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1121 | |
| 1122 | if (leds != ledstate) { |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 1123 | input_handler_for_each_handle(&kbd_handler, &leds, |
| 1124 | kbd_update_leds_helper); |
| 1125 | ledstate = leds; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1126 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1127 | } |
| 1128 | |
| 1129 | DECLARE_TASKLET_DISABLED(keyboard_tasklet, kbd_bh, 0); |
| 1130 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1131 | #if defined(CONFIG_X86) || defined(CONFIG_IA64) || defined(CONFIG_ALPHA) ||\ |
Adrian Bunk | 0b57ee9 | 2005-12-22 21:03:47 -0800 | [diff] [blame] | 1132 | defined(CONFIG_MIPS) || defined(CONFIG_PPC) || defined(CONFIG_SPARC) ||\ |
| 1133 | defined(CONFIG_PARISC) || defined(CONFIG_SUPERH) ||\ |
Hans-Christian Egtvedt | 3a4e832 | 2007-12-04 13:15:41 +0100 | [diff] [blame] | 1134 | (defined(CONFIG_ARM) && defined(CONFIG_KEYBOARD_ATKBD) && !defined(CONFIG_ARCH_RPC)) ||\ |
| 1135 | defined(CONFIG_AVR32) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | |
Andreas Mohr | 0f5e560 | 2006-06-05 00:18:00 -0400 | [diff] [blame] | 1140 | static const unsigned short x86_keycodes[256] = |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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, |
Dmitry Torokhov | 896cdc7b | 2006-07-19 01:14:25 -0400 | [diff] [blame] | 1147 | 284,285,309, 0,312, 91,327,328,329,331,333,335,336,337,338,339, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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, |
Hans de Goede | 72a42f2 | 2007-07-03 01:55:18 -0400 | [diff] [blame] | 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, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | |
Adrian Bunk | 0b57ee9 | 2005-12-22 21:03:47 -0800 | [diff] [blame] | 1157 | #ifdef CONFIG_SPARC |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1158 | static int sparc_l1_a_state; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1159 | extern void sun_do_break(void); |
| 1160 | #endif |
| 1161 | |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 1162 | static int emulate_raw(struct vc_data *vc, unsigned int keycode, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1163 | unsigned char up_flag) |
| 1164 | { |
Dmitry Torokhov | 896cdc7b | 2006-07-19 01:14:25 -0400 | [diff] [blame] | 1165 | int code; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1166 | |
| 1167 | switch (keycode) { |
Dmitry Torokhov | 896cdc7b | 2006-07-19 01:14:25 -0400 | [diff] [blame] | 1168 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 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; |
Dmitry Torokhov | 896cdc7b | 2006-07-19 01:14:25 -0400 | [diff] [blame] | 1174 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1175 | case KEY_HANGEUL: |
| 1176 | if (!up_flag) |
| 1177 | put_queue(vc, 0xf2); |
| 1178 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1179 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1180 | case KEY_HANJA: |
| 1181 | if (!up_flag) |
| 1182 | put_queue(vc, 0xf1); |
| 1183 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1184 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1185 | case KEY_SYSRQ: |
| 1186 | /* |
| 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. |
| 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1202 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1203 | default: |
| 1204 | if (keycode > 255) |
| 1205 | return -1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1206 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1207 | code = x86_keycodes[keycode]; |
| 1208 | if (!code) |
| 1209 | return -1; |
Dmitry Torokhov | 896cdc7b | 2006-07-19 01:14:25 -0400 | [diff] [blame] | 1210 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1211 | if (code & 0x100) |
| 1212 | put_queue(vc, 0xe0); |
| 1213 | put_queue(vc, (code & 0x7f) | up_flag); |
| 1214 | |
| 1215 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1216 | } |
| 1217 | |
| 1218 | return 0; |
| 1219 | } |
| 1220 | |
| 1221 | #else |
| 1222 | |
| 1223 | #define HW_RAW(dev) 0 |
| 1224 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1225 | static 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 | |
| 1235 | static void kbd_rawcode(unsigned char data) |
| 1236 | { |
| 1237 | struct vc_data *vc = vc_cons[fg_console].d; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1238 | |
Alan Jenkins | 0c09b2a | 2009-11-18 00:40:48 -0800 | [diff] [blame] | 1239 | kbd = kbd_table + vc->vc_num; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1240 | if (kbd->kbdmode == VC_RAW) |
| 1241 | put_queue(vc, data); |
| 1242 | } |
| 1243 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 1244 | static void kbd_keycode(unsigned int keycode, int down, int hw_raw) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1245 | { |
| 1246 | struct vc_data *vc = vc_cons[fg_console].d; |
| 1247 | unsigned short keysym, *key_map; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1248 | unsigned char type; |
| 1249 | bool raw_mode; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1250 | struct tty_struct *tty; |
| 1251 | int shift_final; |
Samuel Thibault | 41ab439 | 2007-10-18 23:39:12 -0700 | [diff] [blame] | 1252 | struct keyboard_notifier_param param = { .vc = vc, .value = keycode, .down = down }; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1253 | int rc; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1254 | |
Alan Cox | 8ce7326 | 2010-06-01 22:52:56 +0200 | [diff] [blame] | 1255 | tty = vc->port.tty; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1256 | |
| 1257 | if (tty && (!tty->driver_data)) { |
| 1258 | /* No driver data? Strange. Okay we fix it then. */ |
| 1259 | tty->driver_data = vc; |
| 1260 | } |
| 1261 | |
Alan Jenkins | 0c09b2a | 2009-11-18 00:40:48 -0800 | [diff] [blame] | 1262 | kbd = kbd_table + vc->vc_num; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1263 | |
Adrian Bunk | 0b57ee9 | 2005-12-22 21:03:47 -0800 | [diff] [blame] | 1264 | #ifdef CONFIG_SPARC |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1265 | if (keycode == KEY_STOP) |
| 1266 | sparc_l1_a_state = down; |
| 1267 | #endif |
| 1268 | |
| 1269 | rep = (down == 2); |
| 1270 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1271 | raw_mode = (kbd->kbdmode == VC_RAW); |
| 1272 | if (raw_mode && !hw_raw) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1273 | if (emulate_raw(vc, keycode, !down << 7)) |
Dmitry Torokhov | 9e35d20 | 2007-04-12 01:30:52 -0400 | [diff] [blame] | 1274 | if (keycode < BTN_MISC && printk_ratelimit()) |
Dmitry Torokhov | 9272e9a | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1275 | pr_warning("can't emulate rawmode for keycode %d\n", |
| 1276 | keycode); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1277 | |
Adrian Bunk | 0b57ee9 | 2005-12-22 21:03:47 -0800 | [diff] [blame] | 1278 | #ifdef CONFIG_SPARC |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1279 | if (keycode == KEY_A && sparc_l1_a_state) { |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1280 | sparc_l1_a_state = false; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1281 | sun_do_break(); |
| 1282 | } |
| 1283 | #endif |
| 1284 | |
| 1285 | if (kbd->kbdmode == VC_MEDIUMRAW) { |
| 1286 | /* |
| 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. |
| 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 | } |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1302 | raw_mode = true; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1303 | } |
| 1304 | |
| 1305 | if (down) |
| 1306 | set_bit(keycode, key_down); |
| 1307 | else |
| 1308 | clear_bit(keycode, key_down); |
| 1309 | |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 1310 | if (rep && |
| 1311 | (!vc_kbd_mode(kbd, VC_REPEAT) || |
Alan Cox | f34d7a5 | 2008-04-30 00:54:13 -0700 | [diff] [blame] | 1312 | (tty && !L_ECHO(tty) && tty_chars_in_buffer(tty)))) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1313 | /* |
| 1314 | * Don't repeat a key if the input buffers are not empty and the |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 1315 | * characters get aren't echoed locally. This makes key repeat |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1316 | * usable with slow applications and under heavy loads. |
| 1317 | */ |
| 1318 | return; |
| 1319 | } |
| 1320 | |
Samuel Thibault | 41ab439 | 2007-10-18 23:39:12 -0700 | [diff] [blame] | 1321 | param.shift = shift_final = (shift_state | kbd->slockstate) ^ kbd->lockstate; |
Karl Dahlke | 0beb4f6 | 2008-04-15 01:30:32 -0400 | [diff] [blame] | 1322 | param.ledstate = kbd->ledflagstate; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1323 | key_map = key_maps[shift_final]; |
| 1324 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 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); |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 1330 | do_compute_shiftstate(); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1331 | kbd->slockstate = 0; |
| 1332 | return; |
| 1333 | } |
| 1334 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1335 | if (keycode < NR_KEYS) |
Samuel Thibault | b9ec4e1 | 2006-04-02 00:10:28 -0500 | [diff] [blame] | 1336 | keysym = key_map[keycode]; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1341 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1342 | type = KTYP(keysym); |
| 1343 | |
| 1344 | if (type < 0xf0) { |
Samuel Thibault | 41ab439 | 2007-10-18 23:39:12 -0700 | [diff] [blame] | 1345 | param.value = keysym; |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1351 | return; |
| 1352 | } |
| 1353 | |
| 1354 | type -= 0xf0; |
| 1355 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | } |
Samuel Thibault | 41ab439 | 2007-10-18 23:39:12 -0700 | [diff] [blame] | 1364 | |
Dmitry Torokhov | e078557 | 2010-03-21 22:31:26 -0700 | [diff] [blame] | 1365 | param.value = keysym; |
| 1366 | rc = atomic_notifier_call_chain(&keyboard_notifier_list, |
| 1367 | KBD_KEYSYM, ¶m); |
| 1368 | if (rc == NOTIFY_STOP) |
Samuel Thibault | 41ab439 | 2007-10-18 23:39:12 -0700 | [diff] [blame] | 1369 | return; |
| 1370 | |
Arthur Taylor | 9fc3de9 | 2011-02-04 13:55:50 -0800 | [diff] [blame] | 1371 | if ((raw_mode || kbd->kbdmode == VC_OFF) && type != KT_SPEC && type != KT_SHIFT) |
Samuel Thibault | 41ab439 | 2007-10-18 23:39:12 -0700 | [diff] [blame] | 1372 | return; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1373 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 1374 | (*k_handler[type])(vc, keysym & 0xff, !down); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1375 | |
Karl Dahlke | 0beb4f6 | 2008-04-15 01:30:32 -0400 | [diff] [blame] | 1376 | param.ledstate = kbd->ledflagstate; |
Samuel Thibault | 41ab439 | 2007-10-18 23:39:12 -0700 | [diff] [blame] | 1377 | atomic_notifier_call_chain(&keyboard_notifier_list, KBD_POST_KEYSYM, ¶m); |
| 1378 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1379 | if (type != KT_SLOCK) |
| 1380 | kbd->slockstate = 0; |
| 1381 | } |
| 1382 | |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 1383 | static void kbd_event(struct input_handle *handle, unsigned int event_type, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1384 | unsigned int event_code, int value) |
| 1385 | { |
Dmitry Torokhov | 21cea58 | 2009-11-29 23:40:58 -0800 | [diff] [blame] | 1386 | /* We are called with interrupts disabled, just take the lock */ |
| 1387 | spin_lock(&kbd_event_lock); |
| 1388 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1389 | if (event_type == EV_MSC && event_code == MSC_RAW && HW_RAW(handle->dev)) |
| 1390 | kbd_rawcode(value); |
| 1391 | if (event_type == EV_KEY) |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 1392 | kbd_keycode(event_code, value, HW_RAW(handle->dev)); |
Dmitry Torokhov | 21cea58 | 2009-11-29 23:40:58 -0800 | [diff] [blame] | 1393 | |
| 1394 | spin_unlock(&kbd_event_lock); |
| 1395 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1396 | tasklet_schedule(&keyboard_tasklet); |
| 1397 | do_poke_blanked_console = 1; |
| 1398 | schedule_console_callback(); |
| 1399 | } |
| 1400 | |
Dmitry Torokhov | 0b7024ac | 2010-02-02 21:08:26 -0800 | [diff] [blame] | 1401 | static 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 | |
Samuel Thibault | 53c1f76 | 2010-07-31 02:28:51 -0700 | [diff] [blame] | 1408 | if (test_bit(EV_KEY, dev->evbit)) { |
Dmitry Torokhov | 0b7024ac | 2010-02-02 21:08:26 -0800 | [diff] [blame] | 1409 | for (i = KEY_RESERVED; i < BTN_MISC; i++) |
| 1410 | if (test_bit(i, dev->keybit)) |
| 1411 | return true; |
Samuel Thibault | 53c1f76 | 2010-07-31 02:28:51 -0700 | [diff] [blame] | 1412 | for (i = KEY_BRL_DOT1; i <= KEY_BRL_DOT10; i++) |
| 1413 | if (test_bit(i, dev->keybit)) |
| 1414 | return true; |
| 1415 | } |
Dmitry Torokhov | 0b7024ac | 2010-02-02 21:08:26 -0800 | [diff] [blame] | 1416 | |
| 1417 | return false; |
| 1418 | } |
| 1419 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1420 | /* |
| 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. |
| 1425 | */ |
Dmitry Torokhov | 5b2a0826 | 2007-04-12 01:29:46 -0400 | [diff] [blame] | 1426 | static int kbd_connect(struct input_handler *handler, struct input_dev *dev, |
| 1427 | const struct input_device_id *id) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1428 | { |
| 1429 | struct input_handle *handle; |
Dmitry Torokhov | 5b2a0826 | 2007-04-12 01:29:46 -0400 | [diff] [blame] | 1430 | int error; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1431 | |
Dmitry Torokhov | 22479e1 | 2006-08-04 22:51:51 -0400 | [diff] [blame] | 1432 | handle = kzalloc(sizeof(struct input_handle), GFP_KERNEL); |
| 1433 | if (!handle) |
Dmitry Torokhov | 5b2a0826 | 2007-04-12 01:29:46 -0400 | [diff] [blame] | 1434 | return -ENOMEM; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1435 | |
| 1436 | handle->dev = dev; |
| 1437 | handle->handler = handler; |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 1438 | handle->name = "kbd"; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1439 | |
Dmitry Torokhov | 5b2a0826 | 2007-04-12 01:29:46 -0400 | [diff] [blame] | 1440 | error = input_register_handle(handle); |
| 1441 | if (error) |
| 1442 | goto err_free_handle; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1443 | |
Dmitry Torokhov | 5b2a0826 | 2007-04-12 01:29:46 -0400 | [diff] [blame] | 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1455 | } |
| 1456 | |
| 1457 | static void kbd_disconnect(struct input_handle *handle) |
| 1458 | { |
| 1459 | input_close_device(handle); |
Dmitry Torokhov | 5b2a0826 | 2007-04-12 01:29:46 -0400 | [diff] [blame] | 1460 | input_unregister_handle(handle); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1461 | kfree(handle); |
| 1462 | } |
| 1463 | |
Dmitry Torokhov | c7e8dc6 | 2006-07-06 00:21:03 -0400 | [diff] [blame] | 1464 | /* |
| 1465 | * Start keyboard handler on the new keyboard by refreshing LED state to |
| 1466 | * match the rest of the system. |
| 1467 | */ |
| 1468 | static void kbd_start(struct input_handle *handle) |
| 1469 | { |
Dmitry Torokhov | c7e8dc6 | 2006-07-06 00:21:03 -0400 | [diff] [blame] | 1470 | tasklet_disable(&keyboard_tasklet); |
Dmitry Torokhov | 66d2a59 | 2009-12-01 21:54:35 -0800 | [diff] [blame] | 1471 | |
| 1472 | if (ledstate != 0xff) |
| 1473 | kbd_update_leds_helper(handle, &ledstate); |
| 1474 | |
Dmitry Torokhov | c7e8dc6 | 2006-07-06 00:21:03 -0400 | [diff] [blame] | 1475 | tasklet_enable(&keyboard_tasklet); |
| 1476 | } |
| 1477 | |
Dmitry Torokhov | 66e6611 | 2006-09-14 01:31:59 -0400 | [diff] [blame] | 1478 | static const struct input_device_id kbd_ids[] = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1479 | { |
Alan Cox | 6aeed47 | 2012-02-24 12:47:29 +0000 | [diff] [blame] | 1480 | .flags = INPUT_DEVICE_ID_MATCH_EVBIT, |
| 1481 | .evbit = { BIT_MASK(EV_KEY) }, |
| 1482 | }, |
Dmitry Torokhov | fe1e860 | 2005-09-10 12:03:38 -0500 | [diff] [blame] | 1483 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1484 | { |
Alan Cox | 6aeed47 | 2012-02-24 12:47:29 +0000 | [diff] [blame] | 1485 | .flags = INPUT_DEVICE_ID_MATCH_EVBIT, |
| 1486 | .evbit = { BIT_MASK(EV_SND) }, |
| 1487 | }, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1488 | |
| 1489 | { }, /* Terminating entry */ |
| 1490 | }; |
| 1491 | |
| 1492 | MODULE_DEVICE_TABLE(input, kbd_ids); |
| 1493 | |
| 1494 | static struct input_handler kbd_handler = { |
| 1495 | .event = kbd_event, |
Dmitry Torokhov | 0b7024ac | 2010-02-02 21:08:26 -0800 | [diff] [blame] | 1496 | .match = kbd_match, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1497 | .connect = kbd_connect, |
| 1498 | .disconnect = kbd_disconnect, |
Dmitry Torokhov | c7e8dc6 | 2006-07-06 00:21:03 -0400 | [diff] [blame] | 1499 | .start = kbd_start, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1500 | .name = "kbd", |
| 1501 | .id_table = kbd_ids, |
| 1502 | }; |
| 1503 | |
| 1504 | int __init kbd_init(void) |
| 1505 | { |
| 1506 | int i; |
Dmitry Torokhov | 4263cf0 | 2006-09-14 01:32:39 -0400 | [diff] [blame] | 1507 | int error; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1508 | |
Alan Cox | 6aeed47 | 2012-02-24 12:47:29 +0000 | [diff] [blame] | 1509 | for (i = 0; i < MAX_NR_CONSOLES; i++) { |
Joshua Cov | b2d0b7a | 2012-04-13 21:08:26 +0200 | [diff] [blame] | 1510 | kbd_table[i].ledflagstate = kbd_defleds(); |
| 1511 | kbd_table[i].default_ledflagstate = kbd_defleds(); |
Dmitry Torokhov | 2b19290 | 2006-07-19 01:13:26 -0400 | [diff] [blame] | 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; |
Bill Nottingham | 2e8ecb9 | 2007-10-16 23:29:38 -0700 | [diff] [blame] | 1516 | kbd_table[i].kbdmode = default_utf8 ? VC_UNICODE : VC_XLATE; |
Dmitry Torokhov | 2b19290 | 2006-07-19 01:13:26 -0400 | [diff] [blame] | 1517 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1518 | |
Dmitry Torokhov | 4263cf0 | 2006-09-14 01:32:39 -0400 | [diff] [blame] | 1519 | error = input_register_handler(&kbd_handler); |
| 1520 | if (error) |
| 1521 | return error; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1522 | |
| 1523 | tasklet_enable(&keyboard_tasklet); |
| 1524 | tasklet_schedule(&keyboard_tasklet); |
| 1525 | |
| 1526 | return 0; |
| 1527 | } |
Alan Cox | 247ff8e | 2012-02-24 12:47:11 +0000 | [diff] [blame] | 1528 | |
| 1529 | /* Ioctl support code */ |
| 1530 | |
| 1531 | /** |
| 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 |
| 1536 | * |
| 1537 | * Update the diacritical tables atomically and safely. Lock them |
| 1538 | * against simultaneous keypresses |
| 1539 | */ |
| 1540 | int 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 | /* Lock the diacriticals table, make a copy and then |
| 1559 | copy it after we unlock */ |
| 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 | /* Lock the diacriticals table, make a copy and then |
| 1592 | copy it after we unlock */ |
| 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 | } |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 1690 | |
| 1691 | /** |
| 1692 | * vt_do_kdskbmode - set keyboard mode ioctl |
| 1693 | * @console: the console to use |
| 1694 | * @arg: the requested mode |
| 1695 | * |
| 1696 | * Update the keyboard mode bits while holding the correct locks. |
| 1697 | * Return 0 for success or an error code. |
| 1698 | */ |
| 1699 | int 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 | * vt_do_kdskbmeta - set keyboard meta state |
| 1733 | * @console: the console to use |
| 1734 | * @arg: the requested meta state |
| 1735 | * |
| 1736 | * Update the keyboard meta bits while holding the correct locks. |
| 1737 | * Return 0 for success or an error code. |
| 1738 | */ |
| 1739 | int 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 | |
| 1760 | int 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 | |
| 1787 | int 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 | /* 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--; |
| 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 | /* ++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 |
| 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; |
Dan Carpenter | 8289621 | 2012-03-10 11:59:23 +0300 | [diff] [blame] | 1861 | key_map = new_map; |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 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 | * Attention Key. |
| 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(); |
| 1882 | out: |
| 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 | /* FIXME: This one needs untangling and locking */ |
| 1893 | int 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 | /* 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; |
| 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; /* 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; |
| 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) { /* 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; |
| 1962 | } |
| 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; |
| 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; |
| 2000 | reterr: |
| 2001 | kfree(kbs); |
| 2002 | return ret; |
| 2003 | } |
| 2004 | |
| 2005 | int 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 | /* 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); |
| 2019 | |
| 2020 | case KDSKBLED: |
| 2021 | if (!perm) |
| 2022 | return -EPERM; |
| 2023 | if (arg & ~0x77) |
| 2024 | return -EINVAL; |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 2025 | spin_lock_irqsave(&led_lock, flags); |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 2026 | kbd->ledflagstate = (arg & 7); |
| 2027 | kbd->default_ledflagstate = ((arg >> 4) & 7); |
| 2028 | set_leds(); |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 2029 | spin_unlock_irqrestore(&led_lock, flags); |
Alan Cox | eea41ae | 2012-05-14 14:41:31 +0100 | [diff] [blame] | 2030 | return 0; |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 2031 | |
| 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); |
| 2037 | |
| 2038 | case KDSETLED: |
| 2039 | if (!perm) |
| 2040 | return -EPERM; |
| 2041 | setledstate(kbd, arg); |
| 2042 | return 0; |
| 2043 | } |
| 2044 | return -ENOIOCTLCMD; |
| 2045 | } |
| 2046 | |
| 2047 | int vt_do_kdgkbmode(int console) |
| 2048 | { |
| 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; |
| 2062 | } |
| 2063 | } |
| 2064 | |
| 2065 | /** |
| 2066 | * vt_do_kdgkbmeta - report meta status |
| 2067 | * @console: console to report |
| 2068 | * |
| 2069 | * Report the meta flag status of this console |
| 2070 | */ |
| 2071 | int vt_do_kdgkbmeta(int console) |
| 2072 | { |
| 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; |
| 2076 | } |
| 2077 | |
| 2078 | /** |
| 2079 | * vt_reset_unicode - reset the unicode status |
| 2080 | * @console: console being reset |
| 2081 | * |
| 2082 | * Restore the unicode console state to its default |
| 2083 | */ |
| 2084 | void 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 | * vt_get_shiftstate - shift bit state |
| 2095 | * |
| 2096 | * Report the shift bits from the keyboard state. We have to export |
| 2097 | * this to support some oddities in the vt layer. |
| 2098 | */ |
| 2099 | int vt_get_shift_state(void) |
| 2100 | { |
| 2101 | /* Don't lock as this is a transient report */ |
| 2102 | return shift_state; |
| 2103 | } |
| 2104 | |
| 2105 | /** |
| 2106 | * vt_reset_keyboard - reset keyboard state |
| 2107 | * @console: console to reset |
| 2108 | * |
| 2109 | * Reset the keyboard bits for a console as part of a general console |
| 2110 | * reset event |
| 2111 | */ |
| 2112 | void 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; |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 2124 | spin_lock(&led_lock); |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 2125 | kbd->ledmode = LED_SHOW_FLAGS; |
| 2126 | kbd->ledflagstate = kbd->default_ledflagstate; |
Alan Cox | 3db1ddb | 2012-07-17 17:06:41 +0100 | [diff] [blame] | 2127 | spin_unlock(&led_lock); |
Alan Cox | 079c953 | 2012-02-28 14:49:23 +0000 | [diff] [blame] | 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); |
| 2131 | } |
| 2132 | |
| 2133 | /** |
| 2134 | * vt_get_kbd_mode_bit - read keyboard status bits |
| 2135 | * @console: console to read from |
| 2136 | * @bit: mode bit to read |
| 2137 | * |
| 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 |
| 2140 | */ |
| 2141 | |
| 2142 | int 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 | * vt_set_kbd_mode_bit - read keyboard status bits |
| 2150 | * @console: console to read from |
| 2151 | * @bit: mode bit to read |
| 2152 | * |
| 2153 | * Set a vt mode bit. We do this without locking so the |
| 2154 | * caller must be sure that there are no synchronization needs |
| 2155 | */ |
| 2156 | |
| 2157 | void 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 | * vt_clr_kbd_mode_bit - read keyboard status bits |
| 2169 | * @console: console to read from |
| 2170 | * @bit: mode bit to read |
| 2171 | * |
| 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 |
| 2174 | */ |
| 2175 | |
| 2176 | void 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 | } |