Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 1 | // 16bit code to handle keyboard requests. |
| 2 | // |
| 3 | // Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net> |
| 4 | // Copyright (C) 2002 MandrakeSoft S.A. |
| 5 | // |
| 6 | // This file may be distributed under the terms of the GNU GPLv3 license. |
| 7 | |
Kevin O'Connor | 9521e26 | 2008-07-04 13:04:29 -0400 | [diff] [blame] | 8 | #include "biosvar.h" // GET_BDA |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 9 | #include "util.h" // debug_enter |
Kevin O'Connor | 38fcbfe | 2008-02-25 22:30:47 -0500 | [diff] [blame] | 10 | #include "config.h" // CONFIG_* |
Kevin O'Connor | f54c150 | 2008-06-14 15:56:16 -0400 | [diff] [blame] | 11 | #include "pic.h" // eoi_pic1 |
Kevin O'Connor | 9521e26 | 2008-07-04 13:04:29 -0400 | [diff] [blame] | 12 | #include "bregs.h" // struct bregs |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 13 | #include "ps2port.h" // i8042_flush |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 14 | |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 15 | static void |
| 16 | keyboard_init() |
| 17 | { |
Kevin O'Connor | c258869 | 2008-05-18 17:10:41 -0400 | [diff] [blame] | 18 | if (CONFIG_COREBOOT) |
| 19 | // Coreboot already does low-level keyboard init. |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 20 | goto end; |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 21 | |
| 22 | /* flush incoming keys */ |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 23 | int ret = i8042_flush(); |
| 24 | if (ret) |
| 25 | return; |
| 26 | |
| 27 | // Controller self-test. |
| 28 | u8 param[2]; |
| 29 | ret = i8042_command(I8042_CMD_CTL_TEST, param); |
| 30 | if (ret) |
| 31 | return; |
| 32 | if (param[0] != 0x55) { |
Kevin O'Connor | f13b008 | 2008-08-17 11:26:42 -0400 | [diff] [blame] | 33 | dprintf(1, "i8042 self test failed (got %x not 0x55)\n", param[0]); |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 34 | return; |
Kevin O'Connor | 06ad44e | 2008-04-05 19:30:02 -0400 | [diff] [blame] | 35 | } |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 36 | |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 37 | // Controller keyboard test. |
| 38 | ret = i8042_command(I8042_CMD_KBD_TEST, param); |
| 39 | if (ret) |
| 40 | return; |
| 41 | if (param[0] != 0x00) { |
Kevin O'Connor | f13b008 | 2008-08-17 11:26:42 -0400 | [diff] [blame] | 42 | dprintf(1, "i8042 keyboard test failed (got %x not 0x00)\n", param[0]); |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 43 | return; |
| 44 | } |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 45 | |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 46 | // Enable keyboard and mouse ports. |
| 47 | ret = i8042_command(I8042_CMD_KBD_ENABLE, NULL); |
| 48 | if (ret) |
| 49 | return; |
| 50 | ret = i8042_command(I8042_CMD_AUX_ENABLE, NULL); |
| 51 | if (ret) |
| 52 | return; |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 53 | |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 54 | |
| 55 | /* ------------------- keyboard side ------------------------*/ |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 56 | /* reset keyboard and self test (keyboard side) */ |
| 57 | ret = kbd_command(ATKBD_CMD_RESET_BAT, param); |
Kevin O'Connor | f13b008 | 2008-08-17 11:26:42 -0400 | [diff] [blame] | 58 | if (ret != 0 && ret != 2) |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 59 | return; |
| 60 | if (param[0] != 0xaa) { |
Kevin O'Connor | f13b008 | 2008-08-17 11:26:42 -0400 | [diff] [blame] | 61 | dprintf(1, "keyboard self test failed (got %x not 0xaa)\n", param[0]); |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 62 | return; |
| 63 | } |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 64 | |
| 65 | /* Disable keyboard */ |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 66 | ret = kbd_command(ATKBD_CMD_RESET_DIS, NULL); |
| 67 | if (ret) |
| 68 | return; |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 69 | |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 70 | end: |
| 71 | // Keyboard Mode: scan code convert, disable mouse, enable IRQ 1 |
| 72 | SET_EBDA(ps2ctr, I8042_CTR_AUXDIS | I8042_CTR_XLATE | I8042_CTR_KBDINT); |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 73 | |
| 74 | /* Enable keyboard */ |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 75 | ret = kbd_command(ATKBD_CMD_ENABLE, NULL); |
| 76 | if (ret) |
| 77 | return; |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 78 | |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 79 | dprintf(1, "keyboard initialized\n"); |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 80 | } |
| 81 | |
| 82 | void |
| 83 | kbd_setup() |
| 84 | { |
Kevin O'Connor | 35192dd | 2008-06-08 19:18:33 -0400 | [diff] [blame] | 85 | dprintf(3, "init keyboard\n"); |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 86 | u16 x = offsetof(struct bios_data_area_s, kbd_buf) - 0x400; |
| 87 | SET_BDA(kbd_mode, 0x10); |
| 88 | SET_BDA(kbd_buf_head, x); |
| 89 | SET_BDA(kbd_buf_tail, x); |
| 90 | SET_BDA(kbd_buf_start_offset, x); |
| 91 | |
| 92 | SET_BDA(kbd_buf_end_offset |
| 93 | , x + FIELD_SIZEOF(struct bios_data_area_s, kbd_buf)); |
| 94 | |
Kevin O'Connor | 4096702 | 2008-07-21 22:23:05 -0400 | [diff] [blame] | 95 | if (! CONFIG_KEYBOARD) |
| 96 | return; |
| 97 | |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 98 | keyboard_init(); |
Kevin O'Connor | f54c150 | 2008-06-14 15:56:16 -0400 | [diff] [blame] | 99 | |
Kevin O'Connor | d21c089 | 2008-11-26 17:02:43 -0500 | [diff] [blame] | 100 | enable_hwirq(1, entry_09); |
Kevin O'Connor | 2018eff | 2008-03-12 21:27:02 -0400 | [diff] [blame] | 101 | } |
| 102 | |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 103 | static u8 |
| 104 | enqueue_key(u8 scan_code, u8 ascii_code) |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 105 | { |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 106 | u16 buffer_start = GET_BDA(kbd_buf_start_offset); |
| 107 | u16 buffer_end = GET_BDA(kbd_buf_end_offset); |
| 108 | |
| 109 | u16 buffer_head = GET_BDA(kbd_buf_head); |
| 110 | u16 buffer_tail = GET_BDA(kbd_buf_tail); |
| 111 | |
| 112 | u16 temp_tail = buffer_tail; |
| 113 | buffer_tail += 2; |
| 114 | if (buffer_tail >= buffer_end) |
| 115 | buffer_tail = buffer_start; |
| 116 | |
| 117 | if (buffer_tail == buffer_head) |
| 118 | return 0; |
| 119 | |
Kevin O'Connor | 438f635 | 2008-03-30 21:46:53 -0400 | [diff] [blame] | 120 | SET_FARVAR(SEG_BDA, *(u8*)(temp_tail+0x400+0), ascii_code); |
| 121 | SET_FARVAR(SEG_BDA, *(u8*)(temp_tail+0x400+1), scan_code); |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 122 | SET_BDA(kbd_buf_tail, buffer_tail); |
| 123 | return 1; |
| 124 | } |
| 125 | |
| 126 | static u8 |
| 127 | dequeue_key(u8 *scan_code, u8 *ascii_code, u8 incr) |
| 128 | { |
| 129 | u16 buffer_head; |
| 130 | u16 buffer_tail; |
| 131 | for (;;) { |
| 132 | buffer_head = GET_BDA(kbd_buf_head); |
| 133 | buffer_tail = GET_BDA(kbd_buf_tail); |
| 134 | |
| 135 | if (buffer_head != buffer_tail) |
| 136 | break; |
| 137 | if (!incr) |
| 138 | return 0; |
Kevin O'Connor | 06ad44e | 2008-04-05 19:30:02 -0400 | [diff] [blame] | 139 | cpu_relax(); |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 140 | } |
| 141 | |
Kevin O'Connor | 438f635 | 2008-03-30 21:46:53 -0400 | [diff] [blame] | 142 | *ascii_code = GET_FARVAR(SEG_BDA, *(u8*)(buffer_head+0x400+0)); |
| 143 | *scan_code = GET_FARVAR(SEG_BDA, *(u8*)(buffer_head+0x400+1)); |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 144 | |
| 145 | if (incr) { |
| 146 | u16 buffer_start = GET_BDA(kbd_buf_start_offset); |
| 147 | u16 buffer_end = GET_BDA(kbd_buf_end_offset); |
| 148 | |
| 149 | buffer_head += 2; |
| 150 | if (buffer_head >= buffer_end) |
| 151 | buffer_head = buffer_start; |
| 152 | SET_BDA(kbd_buf_head, buffer_head); |
| 153 | } |
| 154 | return 1; |
| 155 | } |
| 156 | |
| 157 | // read keyboard input |
| 158 | static void |
| 159 | handle_1600(struct bregs *regs) |
| 160 | { |
| 161 | u8 scan_code, ascii_code; |
| 162 | dequeue_key(&scan_code, &ascii_code, 1); |
| 163 | if (scan_code != 0 && ascii_code == 0xF0) |
| 164 | ascii_code = 0; |
| 165 | else if (ascii_code == 0xE0) |
| 166 | ascii_code = 0; |
| 167 | regs->ax = (scan_code << 8) | ascii_code; |
| 168 | } |
| 169 | |
| 170 | // check keyboard status |
| 171 | static void |
| 172 | handle_1601(struct bregs *regs) |
| 173 | { |
| 174 | u8 scan_code, ascii_code; |
| 175 | if (!dequeue_key(&scan_code, &ascii_code, 0)) { |
| 176 | regs->flags |= F_ZF; |
| 177 | return; |
| 178 | } |
| 179 | if (scan_code != 0 && ascii_code == 0xF0) |
| 180 | ascii_code = 0; |
| 181 | else if (ascii_code == 0xE0) |
| 182 | ascii_code = 0; |
| 183 | regs->ax = (scan_code << 8) | ascii_code; |
| 184 | regs->flags &= ~F_ZF; |
| 185 | } |
| 186 | |
| 187 | // get shift flag status |
| 188 | static void |
| 189 | handle_1602(struct bregs *regs) |
| 190 | { |
| 191 | regs->al = GET_BDA(kbd_flag0); |
| 192 | } |
| 193 | |
| 194 | // store key-stroke into buffer |
| 195 | static void |
| 196 | handle_1605(struct bregs *regs) |
| 197 | { |
| 198 | regs->al = !enqueue_key(regs->ch, regs->cl); |
| 199 | } |
| 200 | |
| 201 | // GET KEYBOARD FUNCTIONALITY |
| 202 | static void |
| 203 | handle_1609(struct bregs *regs) |
| 204 | { |
| 205 | // bit Bochs Description |
| 206 | // 7 0 reserved |
| 207 | // 6 0 INT 16/AH=20h-22h supported (122-key keyboard support) |
| 208 | // 5 1 INT 16/AH=10h-12h supported (enhanced keyboard support) |
| 209 | // 4 1 INT 16/AH=0Ah supported |
| 210 | // 3 0 INT 16/AX=0306h supported |
| 211 | // 2 0 INT 16/AX=0305h supported |
| 212 | // 1 0 INT 16/AX=0304h supported |
| 213 | // 0 0 INT 16/AX=0300h supported |
| 214 | // |
| 215 | regs->al = 0x30; |
| 216 | } |
| 217 | |
| 218 | // GET KEYBOARD ID |
| 219 | static void |
| 220 | handle_160a(struct bregs *regs) |
| 221 | { |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 222 | u8 param[2]; |
| 223 | int ret = kbd_command(ATKBD_CMD_GETID, param); |
| 224 | if (ret) { |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 225 | regs->bx = 0; |
| 226 | return; |
| 227 | } |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 228 | regs->bx = (param[1] << 8) | param[0]; |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 229 | } |
| 230 | |
| 231 | // read MF-II keyboard input |
| 232 | static void |
| 233 | handle_1610(struct bregs *regs) |
| 234 | { |
| 235 | u8 scan_code, ascii_code; |
| 236 | dequeue_key(&scan_code, &ascii_code, 1); |
| 237 | if (scan_code != 0 && ascii_code == 0xF0) |
| 238 | ascii_code = 0; |
| 239 | regs->ax = (scan_code << 8) | ascii_code; |
| 240 | } |
| 241 | |
| 242 | // check MF-II keyboard status |
| 243 | static void |
| 244 | handle_1611(struct bregs *regs) |
| 245 | { |
| 246 | u8 scan_code, ascii_code; |
| 247 | if (!dequeue_key(&scan_code, &ascii_code, 0)) { |
| 248 | regs->flags |= F_ZF; |
| 249 | return; |
| 250 | } |
| 251 | if (scan_code != 0 && ascii_code == 0xF0) |
| 252 | ascii_code = 0; |
| 253 | regs->ax = (scan_code << 8) | ascii_code; |
| 254 | regs->flags &= ~F_ZF; |
| 255 | } |
| 256 | |
| 257 | // get extended keyboard status |
| 258 | static void |
| 259 | handle_1612(struct bregs *regs) |
| 260 | { |
| 261 | regs->al = GET_BDA(kbd_flag0); |
| 262 | regs->ah = (GET_BDA(kbd_flag1) & 0x73) | (GET_BDA(kbd_mode) & 0x0c); |
| 263 | //BX_DEBUG_INT16("int16: func 12 sending %04x\n",AX); |
| 264 | } |
| 265 | |
| 266 | static void |
| 267 | handle_166f(struct bregs *regs) |
| 268 | { |
| 269 | if (regs->al == 0x08) |
| 270 | // unsupported, aka normal keyboard |
| 271 | regs->ah = 2; |
| 272 | } |
| 273 | |
| 274 | // keyboard capability check called by DOS 5.0+ keyb |
| 275 | static void |
| 276 | handle_1692(struct bregs *regs) |
| 277 | { |
| 278 | // function int16 ah=0x10-0x12 supported |
| 279 | regs->ah = 0x80; |
| 280 | } |
| 281 | |
| 282 | // 122 keys capability check called by DOS 5.0+ keyb |
| 283 | static void |
| 284 | handle_16a2(struct bregs *regs) |
| 285 | { |
| 286 | // don't change AH : function int16 ah=0x20-0x22 NOT supported |
| 287 | } |
| 288 | |
| 289 | static void |
Kevin O'Connor | 9f4f640 | 2008-07-21 23:40:57 -0400 | [diff] [blame] | 290 | handle_16XX(struct bregs *regs) |
| 291 | { |
| 292 | debug_stub(regs); |
| 293 | } |
| 294 | |
| 295 | static void |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 296 | set_leds() |
| 297 | { |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 298 | u8 shift_flags = (GET_BDA(kbd_flag0) >> 4) & 0x07; |
| 299 | u8 kbd_led = GET_BDA(kbd_led); |
| 300 | u8 led_flags = kbd_led & 0x07; |
| 301 | if (shift_flags == led_flags) |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 302 | return; |
| 303 | |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 304 | int ret = kbd_command(ATKBD_CMD_SETLEDS, &shift_flags); |
| 305 | if (ret) |
| 306 | // Error |
| 307 | return; |
| 308 | kbd_led = (kbd_led & ~0x07) | shift_flags; |
| 309 | SET_BDA(kbd_led, kbd_led); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 310 | } |
| 311 | |
| 312 | // INT 16h Keyboard Service Entry Point |
Kevin O'Connor | 1978676 | 2008-03-05 21:09:59 -0500 | [diff] [blame] | 313 | void VISIBLE16 |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 314 | handle_16(struct bregs *regs) |
| 315 | { |
Kevin O'Connor | 15c1f22 | 2008-06-12 22:59:43 -0400 | [diff] [blame] | 316 | debug_enter(regs, DEBUG_HDL_16); |
Kevin O'Connor | 4096702 | 2008-07-21 22:23:05 -0400 | [diff] [blame] | 317 | if (! CONFIG_KEYBOARD) |
| 318 | return; |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 319 | |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 320 | irq_enable(); |
| 321 | |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 322 | set_leds(); |
| 323 | |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 324 | switch (regs->ah) { |
| 325 | case 0x00: handle_1600(regs); break; |
| 326 | case 0x01: handle_1601(regs); break; |
| 327 | case 0x02: handle_1602(regs); break; |
| 328 | case 0x05: handle_1605(regs); break; |
| 329 | case 0x09: handle_1609(regs); break; |
| 330 | case 0x0a: handle_160a(regs); break; |
| 331 | case 0x10: handle_1610(regs); break; |
| 332 | case 0x11: handle_1611(regs); break; |
| 333 | case 0x12: handle_1612(regs); break; |
| 334 | case 0x92: handle_1692(regs); break; |
| 335 | case 0xa2: handle_16a2(regs); break; |
| 336 | case 0x6f: handle_166f(regs); break; |
Kevin O'Connor | 9f4f640 | 2008-07-21 23:40:57 -0400 | [diff] [blame] | 337 | default: handle_16XX(regs); break; |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 338 | } |
| 339 | } |
| 340 | |
Kevin O'Connor | 3f168b6 | 2008-11-29 13:22:29 -0500 | [diff] [blame^] | 341 | // 16bit reset vector declared in romlayout.S |
| 342 | void reset_vector() __attribute__ ((noreturn)); |
| 343 | |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 344 | #define none 0 |
| 345 | #define MAX_SCAN_CODE 0x58 |
| 346 | |
| 347 | static struct scaninfo { |
| 348 | u16 normal; |
| 349 | u16 shift; |
| 350 | u16 control; |
| 351 | u16 alt; |
| 352 | u8 lock_flags; |
| 353 | } scan_to_scanascii[MAX_SCAN_CODE + 1] = { |
| 354 | { none, none, none, none, none }, |
| 355 | { 0x011b, 0x011b, 0x011b, 0x0100, none }, /* escape */ |
| 356 | { 0x0231, 0x0221, none, 0x7800, none }, /* 1! */ |
| 357 | { 0x0332, 0x0340, 0x0300, 0x7900, none }, /* 2@ */ |
| 358 | { 0x0433, 0x0423, none, 0x7a00, none }, /* 3# */ |
| 359 | { 0x0534, 0x0524, none, 0x7b00, none }, /* 4$ */ |
| 360 | { 0x0635, 0x0625, none, 0x7c00, none }, /* 5% */ |
| 361 | { 0x0736, 0x075e, 0x071e, 0x7d00, none }, /* 6^ */ |
| 362 | { 0x0837, 0x0826, none, 0x7e00, none }, /* 7& */ |
| 363 | { 0x0938, 0x092a, none, 0x7f00, none }, /* 8* */ |
| 364 | { 0x0a39, 0x0a28, none, 0x8000, none }, /* 9( */ |
| 365 | { 0x0b30, 0x0b29, none, 0x8100, none }, /* 0) */ |
| 366 | { 0x0c2d, 0x0c5f, 0x0c1f, 0x8200, none }, /* -_ */ |
| 367 | { 0x0d3d, 0x0d2b, none, 0x8300, none }, /* =+ */ |
| 368 | { 0x0e08, 0x0e08, 0x0e7f, none, none }, /* backspace */ |
| 369 | { 0x0f09, 0x0f00, none, none, none }, /* tab */ |
| 370 | { 0x1071, 0x1051, 0x1011, 0x1000, 0x40 }, /* Q */ |
| 371 | { 0x1177, 0x1157, 0x1117, 0x1100, 0x40 }, /* W */ |
| 372 | { 0x1265, 0x1245, 0x1205, 0x1200, 0x40 }, /* E */ |
| 373 | { 0x1372, 0x1352, 0x1312, 0x1300, 0x40 }, /* R */ |
| 374 | { 0x1474, 0x1454, 0x1414, 0x1400, 0x40 }, /* T */ |
| 375 | { 0x1579, 0x1559, 0x1519, 0x1500, 0x40 }, /* Y */ |
| 376 | { 0x1675, 0x1655, 0x1615, 0x1600, 0x40 }, /* U */ |
| 377 | { 0x1769, 0x1749, 0x1709, 0x1700, 0x40 }, /* I */ |
| 378 | { 0x186f, 0x184f, 0x180f, 0x1800, 0x40 }, /* O */ |
| 379 | { 0x1970, 0x1950, 0x1910, 0x1900, 0x40 }, /* P */ |
| 380 | { 0x1a5b, 0x1a7b, 0x1a1b, none, none }, /* [{ */ |
| 381 | { 0x1b5d, 0x1b7d, 0x1b1d, none, none }, /* ]} */ |
| 382 | { 0x1c0d, 0x1c0d, 0x1c0a, none, none }, /* Enter */ |
| 383 | { none, none, none, none, none }, /* L Ctrl */ |
| 384 | { 0x1e61, 0x1e41, 0x1e01, 0x1e00, 0x40 }, /* A */ |
| 385 | { 0x1f73, 0x1f53, 0x1f13, 0x1f00, 0x40 }, /* S */ |
| 386 | { 0x2064, 0x2044, 0x2004, 0x2000, 0x40 }, /* D */ |
| 387 | { 0x2166, 0x2146, 0x2106, 0x2100, 0x40 }, /* F */ |
| 388 | { 0x2267, 0x2247, 0x2207, 0x2200, 0x40 }, /* G */ |
| 389 | { 0x2368, 0x2348, 0x2308, 0x2300, 0x40 }, /* H */ |
| 390 | { 0x246a, 0x244a, 0x240a, 0x2400, 0x40 }, /* J */ |
| 391 | { 0x256b, 0x254b, 0x250b, 0x2500, 0x40 }, /* K */ |
| 392 | { 0x266c, 0x264c, 0x260c, 0x2600, 0x40 }, /* L */ |
| 393 | { 0x273b, 0x273a, none, none, none }, /* ;: */ |
| 394 | { 0x2827, 0x2822, none, none, none }, /* '" */ |
| 395 | { 0x2960, 0x297e, none, none, none }, /* `~ */ |
| 396 | { none, none, none, none, none }, /* L shift */ |
| 397 | { 0x2b5c, 0x2b7c, 0x2b1c, none, none }, /* |\ */ |
| 398 | { 0x2c7a, 0x2c5a, 0x2c1a, 0x2c00, 0x40 }, /* Z */ |
| 399 | { 0x2d78, 0x2d58, 0x2d18, 0x2d00, 0x40 }, /* X */ |
| 400 | { 0x2e63, 0x2e43, 0x2e03, 0x2e00, 0x40 }, /* C */ |
| 401 | { 0x2f76, 0x2f56, 0x2f16, 0x2f00, 0x40 }, /* V */ |
| 402 | { 0x3062, 0x3042, 0x3002, 0x3000, 0x40 }, /* B */ |
| 403 | { 0x316e, 0x314e, 0x310e, 0x3100, 0x40 }, /* N */ |
| 404 | { 0x326d, 0x324d, 0x320d, 0x3200, 0x40 }, /* M */ |
| 405 | { 0x332c, 0x333c, none, none, none }, /* ,< */ |
| 406 | { 0x342e, 0x343e, none, none, none }, /* .> */ |
| 407 | { 0x352f, 0x353f, none, none, none }, /* /? */ |
| 408 | { none, none, none, none, none }, /* R Shift */ |
| 409 | { 0x372a, 0x372a, none, none, none }, /* * */ |
| 410 | { none, none, none, none, none }, /* L Alt */ |
| 411 | { 0x3920, 0x3920, 0x3920, 0x3920, none }, /* space */ |
| 412 | { none, none, none, none, none }, /* caps lock */ |
| 413 | { 0x3b00, 0x5400, 0x5e00, 0x6800, none }, /* F1 */ |
| 414 | { 0x3c00, 0x5500, 0x5f00, 0x6900, none }, /* F2 */ |
| 415 | { 0x3d00, 0x5600, 0x6000, 0x6a00, none }, /* F3 */ |
| 416 | { 0x3e00, 0x5700, 0x6100, 0x6b00, none }, /* F4 */ |
| 417 | { 0x3f00, 0x5800, 0x6200, 0x6c00, none }, /* F5 */ |
| 418 | { 0x4000, 0x5900, 0x6300, 0x6d00, none }, /* F6 */ |
| 419 | { 0x4100, 0x5a00, 0x6400, 0x6e00, none }, /* F7 */ |
| 420 | { 0x4200, 0x5b00, 0x6500, 0x6f00, none }, /* F8 */ |
| 421 | { 0x4300, 0x5c00, 0x6600, 0x7000, none }, /* F9 */ |
| 422 | { 0x4400, 0x5d00, 0x6700, 0x7100, none }, /* F10 */ |
| 423 | { none, none, none, none, none }, /* Num Lock */ |
| 424 | { none, none, none, none, none }, /* Scroll Lock */ |
| 425 | { 0x4700, 0x4737, 0x7700, none, 0x20 }, /* 7 Home */ |
| 426 | { 0x4800, 0x4838, none, none, 0x20 }, /* 8 UP */ |
| 427 | { 0x4900, 0x4939, 0x8400, none, 0x20 }, /* 9 PgUp */ |
| 428 | { 0x4a2d, 0x4a2d, none, none, none }, /* - */ |
| 429 | { 0x4b00, 0x4b34, 0x7300, none, 0x20 }, /* 4 Left */ |
| 430 | { 0x4c00, 0x4c35, none, none, 0x20 }, /* 5 */ |
| 431 | { 0x4d00, 0x4d36, 0x7400, none, 0x20 }, /* 6 Right */ |
| 432 | { 0x4e2b, 0x4e2b, none, none, none }, /* + */ |
| 433 | { 0x4f00, 0x4f31, 0x7500, none, 0x20 }, /* 1 End */ |
| 434 | { 0x5000, 0x5032, none, none, 0x20 }, /* 2 Down */ |
| 435 | { 0x5100, 0x5133, 0x7600, none, 0x20 }, /* 3 PgDn */ |
| 436 | { 0x5200, 0x5230, none, none, 0x20 }, /* 0 Ins */ |
| 437 | { 0x5300, 0x532e, none, none, 0x20 }, /* Del */ |
| 438 | { none, none, none, none, none }, |
| 439 | { none, none, none, none, none }, |
| 440 | { 0x565c, 0x567c, none, none, none }, /* \| */ |
Kevin O'Connor | 7c77417 | 2008-10-25 14:38:31 -0400 | [diff] [blame] | 441 | { 0x8500, 0x8700, 0x8900, 0x8b00, none }, /* F11 */ |
| 442 | { 0x8600, 0x8800, 0x8a00, 0x8c00, none }, /* F12 */ |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 443 | }; |
| 444 | |
| 445 | static void |
| 446 | process_key(u8 scancode) |
| 447 | { |
| 448 | u8 shift_flags = GET_BDA(kbd_flag0); |
| 449 | u8 mf2_flags = GET_BDA(kbd_flag1); |
| 450 | u8 mf2_state = GET_BDA(kbd_mode); |
| 451 | |
| 452 | switch (scancode) { |
| 453 | case 0x00: |
Kevin O'Connor | ac8df8c | 2008-05-24 23:46:33 -0400 | [diff] [blame] | 454 | dprintf(1, "KBD: int09 handler: AL=0\n"); |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 455 | return; |
| 456 | |
| 457 | case 0x3a: /* Caps Lock press */ |
| 458 | shift_flags ^= 0x40; |
| 459 | SET_BDA(kbd_flag0, shift_flags); |
| 460 | mf2_flags |= 0x40; |
| 461 | SET_BDA(kbd_flag1, mf2_flags); |
| 462 | break; |
| 463 | case 0xba: /* Caps Lock release */ |
| 464 | mf2_flags &= ~0x40; |
| 465 | SET_BDA(kbd_flag1, mf2_flags); |
| 466 | break; |
| 467 | |
| 468 | case 0x2a: /* L Shift press */ |
| 469 | shift_flags |= 0x02; |
| 470 | SET_BDA(kbd_flag0, shift_flags); |
| 471 | break; |
| 472 | case 0xaa: /* L Shift release */ |
| 473 | shift_flags &= ~0x02; |
| 474 | SET_BDA(kbd_flag0, shift_flags); |
| 475 | break; |
| 476 | |
| 477 | case 0x36: /* R Shift press */ |
| 478 | shift_flags |= 0x01; |
| 479 | SET_BDA(kbd_flag0, shift_flags); |
| 480 | break; |
| 481 | case 0xb6: /* R Shift release */ |
| 482 | shift_flags &= ~0x01; |
| 483 | SET_BDA(kbd_flag0, shift_flags); |
| 484 | break; |
| 485 | |
| 486 | case 0x1d: /* Ctrl press */ |
| 487 | if ((mf2_state & 0x01) == 0) { |
| 488 | shift_flags |= 0x04; |
| 489 | SET_BDA(kbd_flag0, shift_flags); |
| 490 | if (mf2_state & 0x02) { |
| 491 | mf2_state |= 0x04; |
| 492 | SET_BDA(kbd_mode, mf2_state); |
| 493 | } else { |
| 494 | mf2_flags |= 0x01; |
| 495 | SET_BDA(kbd_flag1, mf2_flags); |
| 496 | } |
| 497 | } |
| 498 | break; |
| 499 | case 0x9d: /* Ctrl release */ |
| 500 | if ((mf2_state & 0x01) == 0) { |
| 501 | shift_flags &= ~0x04; |
| 502 | SET_BDA(kbd_flag0, shift_flags); |
| 503 | if (mf2_state & 0x02) { |
| 504 | mf2_state &= ~0x04; |
| 505 | SET_BDA(kbd_mode, mf2_state); |
| 506 | } else { |
| 507 | mf2_flags &= ~0x01; |
| 508 | SET_BDA(kbd_flag1, mf2_flags); |
| 509 | } |
| 510 | } |
| 511 | break; |
| 512 | |
| 513 | case 0x38: /* Alt press */ |
| 514 | shift_flags |= 0x08; |
| 515 | SET_BDA(kbd_flag0, shift_flags); |
| 516 | if (mf2_state & 0x02) { |
| 517 | mf2_state |= 0x08; |
| 518 | SET_BDA(kbd_mode, mf2_state); |
| 519 | } else { |
| 520 | mf2_flags |= 0x02; |
| 521 | SET_BDA(kbd_flag1, mf2_flags); |
| 522 | } |
| 523 | break; |
| 524 | case 0xb8: /* Alt release */ |
| 525 | shift_flags &= ~0x08; |
| 526 | SET_BDA(kbd_flag0, shift_flags); |
| 527 | if (mf2_state & 0x02) { |
| 528 | mf2_state &= ~0x08; |
| 529 | SET_BDA(kbd_mode, mf2_state); |
| 530 | } else { |
| 531 | mf2_flags &= ~0x02; |
| 532 | SET_BDA(kbd_flag1, mf2_flags); |
| 533 | } |
| 534 | break; |
| 535 | |
| 536 | case 0x45: /* Num Lock press */ |
| 537 | if ((mf2_state & 0x03) == 0) { |
| 538 | mf2_flags |= 0x20; |
| 539 | SET_BDA(kbd_flag1, mf2_flags); |
| 540 | shift_flags ^= 0x20; |
| 541 | SET_BDA(kbd_flag0, shift_flags); |
| 542 | } |
| 543 | break; |
| 544 | case 0xc5: /* Num Lock release */ |
| 545 | if ((mf2_state & 0x03) == 0) { |
| 546 | mf2_flags &= ~0x20; |
| 547 | SET_BDA(kbd_flag1, mf2_flags); |
| 548 | } |
| 549 | break; |
| 550 | |
| 551 | case 0x46: /* Scroll Lock press */ |
| 552 | mf2_flags |= 0x10; |
| 553 | SET_BDA(kbd_flag1, mf2_flags); |
| 554 | shift_flags ^= 0x10; |
| 555 | SET_BDA(kbd_flag0, shift_flags); |
| 556 | break; |
| 557 | case 0xc6: /* Scroll Lock release */ |
| 558 | mf2_flags &= ~0x10; |
| 559 | SET_BDA(kbd_flag1, mf2_flags); |
| 560 | break; |
| 561 | |
| 562 | case 0xe0: |
| 563 | // Extended key |
| 564 | SETBITS_BDA(kbd_mode, 0x02); |
| 565 | return; |
| 566 | case 0xe1: |
| 567 | // Pause key |
| 568 | SETBITS_BDA(kbd_mode, 0x01); |
| 569 | return; |
| 570 | |
| 571 | default: |
Kevin O'Connor | 3f168b6 | 2008-11-29 13:22:29 -0500 | [diff] [blame^] | 572 | if (scancode & 0x80) |
| 573 | // toss key releases |
| 574 | break; |
| 575 | if (scancode == 0x53 && (shift_flags & 0x0c) == 0x0c) |
| 576 | // Ctrl+alt+del - reset machine. |
| 577 | reset_vector(); |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 578 | if (scancode > MAX_SCAN_CODE) { |
Kevin O'Connor | ac8df8c | 2008-05-24 23:46:33 -0400 | [diff] [blame] | 579 | dprintf(1, "KBD: int09h_handler(): unknown scancode read: 0x%02x!\n" |
Kevin O'Connor | 438f635 | 2008-03-30 21:46:53 -0400 | [diff] [blame] | 580 | , scancode); |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 581 | return; |
| 582 | } |
| 583 | u8 asciicode; |
| 584 | struct scaninfo *info = &scan_to_scanascii[scancode]; |
| 585 | if (shift_flags & 0x08) { /* ALT */ |
| 586 | asciicode = GET_VAR(CS, info->alt); |
| 587 | scancode = GET_VAR(CS, info->alt) >> 8; |
| 588 | } else if (shift_flags & 0x04) { /* CONTROL */ |
| 589 | asciicode = GET_VAR(CS, info->control); |
| 590 | scancode = GET_VAR(CS, info->control) >> 8; |
Kevin O'Connor | 438f635 | 2008-03-30 21:46:53 -0400 | [diff] [blame] | 591 | } else if ((mf2_state & 0x02) > 0 |
| 592 | && scancode >= 0x47 && scancode <= 0x53) { |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 593 | /* extended keys handling */ |
| 594 | asciicode = 0xe0; |
| 595 | scancode = GET_VAR(CS, info->normal) >> 8; |
| 596 | } else if (shift_flags & 0x03) { /* LSHIFT + RSHIFT */ |
| 597 | /* check if lock state should be ignored |
| 598 | * because a SHIFT key are pressed */ |
| 599 | |
| 600 | if (shift_flags & GET_VAR(CS, info->lock_flags)) { |
| 601 | asciicode = GET_VAR(CS, info->normal); |
| 602 | scancode = GET_VAR(CS, info->normal) >> 8; |
| 603 | } else { |
| 604 | asciicode = GET_VAR(CS, info->shift); |
| 605 | scancode = GET_VAR(CS, info->shift) >> 8; |
| 606 | } |
| 607 | } else { |
| 608 | /* check if lock is on */ |
| 609 | if (shift_flags & GET_VAR(CS, info->lock_flags)) { |
| 610 | asciicode = GET_VAR(CS, info->shift); |
| 611 | scancode = GET_VAR(CS, info->shift) >> 8; |
| 612 | } else { |
| 613 | asciicode = GET_VAR(CS, info->normal); |
| 614 | scancode = GET_VAR(CS, info->normal) >> 8; |
| 615 | } |
| 616 | } |
| 617 | if (scancode==0 && asciicode==0) { |
Kevin O'Connor | ac8df8c | 2008-05-24 23:46:33 -0400 | [diff] [blame] | 618 | dprintf(1, "KBD: int09h_handler():" |
| 619 | " scancode & asciicode are zero?\n"); |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 620 | } |
| 621 | enqueue_key(scancode, asciicode); |
| 622 | break; |
| 623 | } |
| 624 | if ((scancode & 0x7f) != 0x1d) { |
| 625 | mf2_state &= ~0x01; |
| 626 | } |
| 627 | mf2_state &= ~0x02; |
| 628 | SET_BDA(kbd_mode, mf2_state); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 629 | } |
| 630 | |
| 631 | // INT09h : Keyboard Hardware Service Entry Point |
Kevin O'Connor | 1978676 | 2008-03-05 21:09:59 -0500 | [diff] [blame] | 632 | void VISIBLE16 |
Kevin O'Connor | ed12849 | 2008-03-11 11:14:59 -0400 | [diff] [blame] | 633 | handle_09() |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 634 | { |
Kevin O'Connor | 15c1f22 | 2008-06-12 22:59:43 -0400 | [diff] [blame] | 635 | debug_isr(DEBUG_ISR_09); |
Kevin O'Connor | 4096702 | 2008-07-21 22:23:05 -0400 | [diff] [blame] | 636 | if (! CONFIG_KEYBOARD) |
| 637 | goto done; |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 638 | |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 639 | // read key from keyboard controller |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 640 | u8 v = inb(PORT_PS2_STATUS); |
| 641 | if ((v & 0x21) != 0x01) { |
| 642 | dprintf(1, "int09 but no keyboard data.\n"); |
| 643 | goto done; |
| 644 | } |
Kevin O'Connor | ee2fd7a | 2008-03-02 08:42:16 -0500 | [diff] [blame] | 645 | u8 key = inb(PORT_PS2_DATA); |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 646 | |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 647 | irq_enable(); |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 648 | if (CONFIG_KBD_CALL_INT15_4F) { |
Kevin O'Connor | 38fcbfe | 2008-02-25 22:30:47 -0500 | [diff] [blame] | 649 | // allow for keyboard intercept |
| 650 | struct bregs tr; |
| 651 | memset(&tr, 0, sizeof(tr)); |
| 652 | tr.al = key; |
| 653 | tr.ah = 0x4f; |
| 654 | tr.flags = F_CF; |
| 655 | call16_int(0x15, &tr); |
Kevin O'Connor | c65a380 | 2008-03-02 13:58:23 -0500 | [diff] [blame] | 656 | if (!(tr.flags & F_CF)) |
Kevin O'Connor | 38fcbfe | 2008-02-25 22:30:47 -0500 | [diff] [blame] | 657 | goto done; |
| 658 | key = tr.al; |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 659 | } |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 660 | process_key(key); |
| 661 | |
| 662 | irq_disable(); |
Kevin O'Connor | 4b60c00 | 2008-02-25 22:29:55 -0500 | [diff] [blame] | 663 | |
Kevin O'Connor | 38fcbfe | 2008-02-25 22:30:47 -0500 | [diff] [blame] | 664 | done: |
Kevin O'Connor | 3b89719 | 2008-07-20 10:08:59 -0400 | [diff] [blame] | 665 | eoi_pic1(); |
Kevin O'Connor | f076a3e | 2008-02-25 22:25:15 -0500 | [diff] [blame] | 666 | } |