| /* |
| * PC/HW routine collection v1.3 for DOS/DJGPP |
| * |
| * Copyright (C) 2002 - Daniel Borca |
| * Email : dborca@yahoo.com |
| * Web : http://www.geocities.com/dborca |
| */ |
| |
| |
| #include <pc.h> |
| #include <sys/exceptn.h> |
| #include <sys/farptr.h> |
| |
| #include "pc_hw.h" |
| |
| |
| #define KEYB_IRQ 1 |
| |
| #define KEY_BUFFER_SIZE 64 |
| |
| #define KB_MODIFIERS (KB_SHIFT_FLAG | KB_CTRL_FLAG | KB_ALT_FLAG | KB_LWIN_FLAG | KB_RWIN_FLAG | KB_MENU_FLAG) |
| #define KB_LED_FLAGS (KB_SCROLOCK_FLAG | KB_NUMLOCK_FLAG | KB_CAPSLOCK_FLAG) |
| |
| static int keyboard_installed; |
| |
| static volatile struct { |
| volatile int start, end; |
| volatile int key[KEY_BUFFER_SIZE]; |
| } key_buffer; |
| |
| static volatile int key_enhanced, key_pause_loop, key_shifts; |
| static int leds_ok = TRUE; |
| static int in_a_terrupt = FALSE; |
| static volatile char pc_key[KEY_MAX]; |
| |
| |
| /* convert Allegro format scancodes into key_shifts flag bits */ |
| static unsigned short modifier_table[KEY_MAX - KEY_MODIFIERS] = { |
| KB_SHIFT_FLAG, KB_SHIFT_FLAG, KB_CTRL_FLAG, |
| KB_CTRL_FLAG, KB_ALT_FLAG, KB_ALT_FLAG, |
| KB_LWIN_FLAG, KB_RWIN_FLAG, KB_MENU_FLAG, |
| KB_SCROLOCK_FLAG, KB_NUMLOCK_FLAG, KB_CAPSLOCK_FLAG |
| }; |
| |
| |
| /* lookup table for converting hardware scancodes into Allegro format */ |
| static unsigned char hw_to_mycode[128] = { |
| /* 0x00 */ 0, KEY_ESC, KEY_1, KEY_2, |
| /* 0x04 */ KEY_3, KEY_4, KEY_5, KEY_6, |
| /* 0x08 */ KEY_7, KEY_8, KEY_9, KEY_0, |
| /* 0x0C */ KEY_MINUS, KEY_EQUALS, KEY_BACKSPACE, KEY_TAB, |
| /* 0x10 */ KEY_Q, KEY_W, KEY_E, KEY_R, |
| /* 0x14 */ KEY_T, KEY_Y, KEY_U, KEY_I, |
| /* 0x18 */ KEY_O, KEY_P, KEY_OPENBRACE, KEY_CLOSEBRACE, |
| /* 0x1C */ KEY_ENTER, KEY_LCONTROL, KEY_A, KEY_S, |
| /* 0x20 */ KEY_D, KEY_F, KEY_G, KEY_H, |
| /* 0x24 */ KEY_J, KEY_K, KEY_L, KEY_COLON, |
| /* 0x28 */ KEY_QUOTE, KEY_TILDE, KEY_LSHIFT, KEY_BACKSLASH, |
| /* 0x2C */ KEY_Z, KEY_X, KEY_C, KEY_V, |
| /* 0x30 */ KEY_B, KEY_N, KEY_M, KEY_COMMA, |
| /* 0x34 */ KEY_STOP, KEY_SLASH, KEY_RSHIFT, KEY_ASTERISK, |
| /* 0x38 */ KEY_ALT, KEY_SPACE, KEY_CAPSLOCK, KEY_F1, |
| /* 0x3C */ KEY_F2, KEY_F3, KEY_F4, KEY_F5, |
| /* 0x40 */ KEY_F6, KEY_F7, KEY_F8, KEY_F9, |
| /* 0x44 */ KEY_F10, KEY_NUMLOCK, KEY_SCRLOCK, KEY_7_PAD, |
| /* 0x48 */ KEY_8_PAD, KEY_9_PAD, KEY_MINUS_PAD, KEY_4_PAD, |
| /* 0x4C */ KEY_5_PAD, KEY_6_PAD, KEY_PLUS_PAD, KEY_1_PAD, |
| /* 0x50 */ KEY_2_PAD, KEY_3_PAD, KEY_0_PAD, KEY_DEL_PAD, |
| /* 0x54 */ KEY_PRTSCR, 0, KEY_BACKSLASH2, KEY_F11, |
| /* 0x58 */ KEY_F12, 0, 0, KEY_LWIN, |
| /* 0x5C */ KEY_RWIN, KEY_MENU, 0, 0, |
| /* 0x60 */ 0, 0, 0, 0, |
| /* 0x64 */ 0, 0, 0, 0, |
| /* 0x68 */ 0, 0, 0, 0, |
| /* 0x6C */ 0, 0, 0, 0, |
| /* 0x70 */ KEY_KANA, 0, 0, KEY_ABNT_C1, |
| /* 0x74 */ 0, 0, 0, 0, |
| /* 0x78 */ 0, KEY_CONVERT, 0, KEY_NOCONVERT, |
| /* 0x7C */ 0, KEY_YEN, 0, 0 |
| }; |
| |
| |
| /* lookup table for converting extended hardware codes into Allegro format */ |
| static unsigned char hw_to_mycode_ex[128] = { |
| /* 0x00 */ 0, KEY_ESC, KEY_1, KEY_2, |
| /* 0x04 */ KEY_3, KEY_4, KEY_5, KEY_6, |
| /* 0x08 */ KEY_7, KEY_8, KEY_9, KEY_0, |
| /* 0x0C */ KEY_MINUS, KEY_EQUALS, KEY_BACKSPACE, KEY_TAB, |
| /* 0x10 */ KEY_CIRCUMFLEX, KEY_AT, KEY_COLON2, KEY_R, |
| /* 0x14 */ KEY_KANJI, KEY_Y, KEY_U, KEY_I, |
| /* 0x18 */ KEY_O, KEY_P, KEY_OPENBRACE, KEY_CLOSEBRACE, |
| /* 0x1C */ KEY_ENTER_PAD, KEY_RCONTROL, KEY_A, KEY_S, |
| /* 0x20 */ KEY_D, KEY_F, KEY_G, KEY_H, |
| /* 0x24 */ KEY_J, KEY_K, KEY_L, KEY_COLON, |
| /* 0x28 */ KEY_QUOTE, KEY_TILDE, 0, KEY_BACKSLASH, |
| /* 0x2C */ KEY_Z, KEY_X, KEY_C, KEY_V, |
| /* 0x30 */ KEY_B, KEY_N, KEY_M, KEY_COMMA, |
| /* 0x34 */ KEY_STOP, KEY_SLASH_PAD, 0, KEY_PRTSCR, |
| /* 0x38 */ KEY_ALTGR, KEY_SPACE, KEY_CAPSLOCK, KEY_F1, |
| /* 0x3C */ KEY_F2, KEY_F3, KEY_F4, KEY_F5, |
| /* 0x40 */ KEY_F6, KEY_F7, KEY_F8, KEY_F9, |
| /* 0x44 */ KEY_F10, KEY_NUMLOCK, KEY_PAUSE, KEY_HOME, |
| /* 0x48 */ KEY_UP, KEY_PGUP, KEY_MINUS_PAD, KEY_LEFT, |
| /* 0x4C */ KEY_5_PAD, KEY_RIGHT, KEY_PLUS_PAD, KEY_END, |
| /* 0x50 */ KEY_DOWN, KEY_PGDN, KEY_INSERT, KEY_DEL, |
| /* 0x54 */ KEY_PRTSCR, 0, KEY_BACKSLASH2, KEY_F11, |
| /* 0x58 */ KEY_F12, 0, 0, KEY_LWIN, |
| /* 0x5C */ KEY_RWIN, KEY_MENU, 0, 0, |
| /* 0x60 */ 0, 0, 0, 0, |
| /* 0x64 */ 0, 0, 0, 0, |
| /* 0x68 */ 0, 0, 0, 0, |
| /* 0x6C */ 0, 0, 0, 0, |
| /* 0x70 */ 0, 0, 0, 0, |
| /* 0x74 */ 0, 0, 0, 0, |
| /* 0x78 */ 0, 0, 0, 0, |
| /* 0x7C */ 0, 0, 0, 0 |
| }; |
| |
| |
| /* default mapping table for the US keyboard layout */ |
| static unsigned short standard_key_ascii_table[KEY_MAX] = { |
| /* start */ 0, |
| /* alphabet */ 'a', 'b', 'c', 'd', 'e', 'f', 'g', 'h', 'i', 'j', 'k', 'l', 'm', 'n', 'o', 'p', 'q', 'r', 's', 't', 'u', 'v', 'w', 'x', 'y', 'z', |
| /* numbers */ '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', |
| /* numpad */ '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', |
| /* func keys */ 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, |
| /* misc chars */ 27, '`', '-', '=', 8, 9, '[', ']', 13, ';', '\'', '\\', '\\', ',', '.', '/', ' ', |
| /* controls */ 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, |
| /* numpad */ '/', '*', '-', '+', '.', 13, |
| /* modifiers */ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 |
| }; |
| |
| |
| /* capslock mapping table for the US keyboard layout */ |
| static unsigned short standard_key_capslock_table[KEY_MAX] = { |
| /* start */ 0, |
| /* alphabet */ 'A', 'B', 'C', 'D', 'E', 'F', 'G', 'H', 'I', 'J', 'K', 'L', 'M', 'N', 'O', 'P', 'Q', 'R', 'S', 'T', 'U', 'V', 'W', 'X', 'Y', 'Z', |
| /* numbers */ '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', |
| /* numpad */ '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', |
| /* func keys */ 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, |
| /* misc chars */ 27, '`', '-', '=', 8, 9, '[', ']', 13, ';', '\'', '\\', '\\', ',', '.', '/', ' ', |
| /* controls */ 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, |
| /* numpad */ '/', '*', '-', '+', '.', 13, |
| /* modifiers */ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 |
| }; |
| |
| |
| /* shifted mapping table for the US keyboard layout */ |
| static unsigned short standard_key_shift_table[KEY_MAX] = { |
| /* start */ 0, |
| /* alphabet */ 'A', 'B', 'C', 'D', 'E', 'F', 'G', 'H', 'I', 'J', 'K', 'L', 'M', 'N', 'O', 'P', 'Q', 'R', 'S', 'T', 'U', 'V', 'W', 'X', 'Y', 'Z', |
| /* numbers */ ')', '!', '@', '#', '$', '%', '^', '&', '*', '(', |
| /* numpad */ '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', |
| /* func keys */ 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, |
| /* misc chars */ 27, '~', '_', '+', 8, 9, '{', '}', 13, ':', '"', '|', '|', '<', '>', '?', ' ', |
| /* controls */ 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, |
| /* numpad */ '/', '*', '-', '+', '.', 13, |
| /* modifiers */ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 |
| }; |
| |
| |
| /* ctrl+key mapping table for the US keyboard layout */ |
| static unsigned short standard_key_control_table[KEY_MAX] = { |
| /* start */ 0, |
| /* alphabet */ 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, |
| /* numbers */ 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, |
| /* numpad */ '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', |
| /* func keys */ 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, |
| /* misc chars */ 27, 2, 2, 2, 127, 127, 2, 2, 10, 2, 2, 2, 2, 2, 2, 2, 2, |
| /* controls */ 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, 0xFFFF, |
| /* numpad */ 2, 2, 2, 2, 2, 10, |
| /* modifiers */ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 |
| }; |
| |
| |
| /* convert numeric pad scancodes into arrow codes */ |
| static unsigned char numlock_table[10] = { |
| KEY_INSERT, KEY_END, KEY_DOWN, KEY_PGDN, KEY_LEFT, |
| KEY_5_PAD, KEY_RIGHT, KEY_HOME, KEY_UP, KEY_PGUP |
| }; |
| |
| |
| /* kb_wait_for_write_ready: |
| * Wait for the keyboard controller to set the ready-for-write bit. |
| */ |
| static __inline int |
| kb_wait_for_write_ready (void) |
| { |
| int timeout = 4096; |
| |
| while ((timeout > 0) && (inportb(0x64) & 2)) timeout--; |
| |
| return (timeout > 0); |
| } |
| |
| |
| /* kb_wait_for_read_ready: |
| * Wait for the keyboard controller to set the ready-for-read bit. |
| */ |
| static __inline int |
| kb_wait_for_read_ready (void) |
| { |
| int timeout = 16384; |
| |
| while ((timeout > 0) && (!(inportb(0x64) & 1))) timeout--; |
| |
| return (timeout > 0); |
| } |
| |
| |
| /* kb_send_data: |
| * Sends a byte to the keyboard controller. Returns 1 if all OK. |
| */ |
| static __inline int |
| kb_send_data (unsigned char data) |
| { |
| int resends = 4; |
| int timeout, temp; |
| |
| do { |
| if (!kb_wait_for_write_ready()) |
| return 0; |
| |
| outportb(0x60, data); |
| timeout = 4096; |
| |
| while (--timeout > 0) { |
| if (!kb_wait_for_read_ready()) |
| return 0; |
| |
| temp = inportb(0x60); |
| |
| if (temp == 0xFA) |
| return 1; |
| |
| if (temp == 0xFE) |
| break; |
| } |
| } while ((resends-- > 0) && (timeout > 0)); |
| |
| return 0; |
| } |
| |
| |
| static void |
| update_leds (int leds) |
| { |
| if (leds_ok) { |
| if (!in_a_terrupt) |
| DISABLE(); |
| |
| if (!kb_send_data(0xED)) { |
| kb_send_data(0xF4); |
| leds_ok = FALSE; |
| } else if (!kb_send_data((leds >> 8) & 7)) { |
| kb_send_data(0xF4); |
| leds_ok = FALSE; |
| } |
| |
| if (!in_a_terrupt) |
| ENABLE(); |
| } |
| } ENDOFUNC(update_leds) |
| |
| |
| static void |
| inject_key (int scancode) |
| { |
| unsigned short *table; |
| |
| if ((scancode >= KEY_0_PAD) && (scancode <= KEY_9_PAD)) { |
| if (((key_shifts & KB_NUMLOCK_FLAG) != 0) == ((key_shifts & KB_SHIFT_FLAG) != 0)) { |
| scancode = numlock_table[scancode - KEY_0_PAD]; |
| } |
| table = standard_key_ascii_table; |
| } else if (key_shifts & KB_CTRL_FLAG) { |
| table = standard_key_control_table; |
| } else if (key_shifts & KB_SHIFT_FLAG) { |
| if (key_shifts & KB_CAPSLOCK_FLAG) { |
| if (standard_key_ascii_table[scancode] == standard_key_capslock_table[scancode]) { |
| table = standard_key_shift_table; |
| } else { |
| table = standard_key_ascii_table; |
| } |
| } else { |
| table = standard_key_shift_table; |
| } |
| } else if (key_shifts & KB_CAPSLOCK_FLAG) { |
| table = standard_key_capslock_table; |
| } else { |
| table = standard_key_ascii_table; |
| } |
| |
| key_buffer.key[key_buffer.end++] = (scancode << 16) | table[scancode]; |
| |
| if (key_buffer.end >= KEY_BUFFER_SIZE) |
| key_buffer.end = 0; |
| if (key_buffer.end == key_buffer.start) { |
| key_buffer.start++; |
| if (key_buffer.start >= KEY_BUFFER_SIZE) |
| key_buffer.start = 0; |
| } |
| } ENDOFUNC(inject_key) |
| |
| |
| static void |
| handle_code (int scancode, int keycode) |
| { |
| in_a_terrupt++; |
| |
| if (keycode == 0) { /* pause */ |
| inject_key(scancode); |
| pc_key[KEY_PAUSE] ^= TRUE; |
| } else if (scancode) { |
| int flag; |
| |
| if (scancode >= KEY_MODIFIERS) { |
| flag = modifier_table[scancode - KEY_MODIFIERS]; |
| } else { |
| flag = 0; |
| } |
| if ((char)keycode < 0) { /* release */ |
| pc_key[scancode] = FALSE; |
| if (flag & KB_MODIFIERS) { |
| key_shifts &= ~flag; |
| } |
| } else { /* keypress */ |
| pc_key[scancode] = TRUE; |
| if (flag & KB_MODIFIERS) { |
| key_shifts |= flag; |
| } |
| if (flag & KB_LED_FLAGS) { |
| key_shifts ^= flag; |
| update_leds(key_shifts); |
| } |
| if (scancode < KEY_MODIFIERS) { |
| inject_key(scancode); |
| } |
| } |
| } |
| |
| in_a_terrupt--; |
| } ENDOFUNC(handle_code) |
| |
| |
| static int |
| keyboard () |
| { |
| unsigned char temp, scancode; |
| |
| temp = inportb(0x60); |
| |
| if (temp <= 0xe1) { |
| if (key_pause_loop) { |
| if (!--key_pause_loop) handle_code(KEY_PAUSE, 0); |
| } else |
| switch (temp) { |
| case 0xe0: |
| key_enhanced = TRUE; |
| break; |
| case 0xe1: |
| key_pause_loop = 5; |
| break; |
| default: |
| if (key_enhanced) { |
| key_enhanced = FALSE; |
| scancode = hw_to_mycode_ex[temp & 0x7f]; |
| } else { |
| scancode = hw_to_mycode[temp & 0x7f]; |
| } |
| handle_code(scancode, temp); |
| } |
| } |
| |
| if (((temp==0x4F)||(temp==0x53))&&(key_shifts&KB_CTRL_FLAG)&&(key_shifts&KB_ALT_FLAG)) { |
| /* Hack alert: |
| * only SIGINT (but not Ctrl-Break) |
| * calls the destructors and will safely clean up |
| */ |
| __asm("\n\ |
| movb $0x79, %%al \n\ |
| call ___djgpp_hw_exception \n\ |
| ":::"%eax", "%ebx", "%ecx", "%edx", "%esi", "%edi", "memory"); |
| } |
| |
| __asm("\n\ |
| inb $0x61, %%al \n\ |
| movb %%al, %%ah \n\ |
| orb $0x80, %%al \n\ |
| outb %%al, $0x61 \n\ |
| xchgb %%al, %%ah \n\ |
| outb %%al, $0x61 \n\ |
| movb $0x20, %%al \n\ |
| outb %%al, $0x20 \n\ |
| ":::"%eax"); |
| return 0; |
| } ENDOFUNC(keyboard) |
| |
| |
| int |
| pc_keypressed (void) |
| { |
| return (key_buffer.start!=key_buffer.end); |
| } |
| |
| |
| int |
| pc_readkey (void) |
| { |
| if (keyboard_installed) { |
| int key; |
| |
| while (key_buffer.start == key_buffer.end) { |
| __dpmi_yield(); |
| } |
| |
| DISABLE(); |
| key = key_buffer.key[key_buffer.start++]; |
| if (key_buffer.start >= KEY_BUFFER_SIZE) |
| key_buffer.start = 0; |
| ENABLE(); |
| |
| return key; |
| } else { |
| return 0; |
| } |
| } |
| |
| |
| int |
| pc_keydown (int code) |
| { |
| return pc_key[code]; |
| } |
| |
| |
| int |
| pc_keyshifts (void) |
| { |
| return key_shifts; |
| } |
| |
| |
| void |
| pc_remove_keyb (void) |
| { |
| if (keyboard_installed) { |
| int s1, s2, s3; |
| |
| keyboard_installed = FALSE; |
| pc_clexit(pc_remove_keyb); |
| |
| DISABLE(); |
| _farsetsel(__djgpp_dos_sel); |
| _farnspokew(0x41c, _farnspeekw(0x41a)); |
| |
| s1 = _farnspeekb(0x417) & 0x80; |
| s2 = _farnspeekb(0x418) & 0xFC; |
| s3 = _farnspeekb(0x496) & 0xF3; |
| |
| if (pc_key[KEY_RSHIFT]) { s1 |= 1; } |
| if (pc_key[KEY_LSHIFT]) { s1 |= 2; } |
| if (pc_key[KEY_LCONTROL]) { s2 |= 1; s1 |= 4; } |
| if (pc_key[KEY_ALT]) { s1 |= 8; s2 |= 2; } |
| if (pc_key[KEY_RCONTROL]) { s1 |= 4; s3 |= 4; } |
| if (pc_key[KEY_ALTGR]) { s1 |= 8; s3 |= 8; } |
| |
| if (key_shifts & KB_SCROLOCK_FLAG) s1 |= 16; |
| if (key_shifts & KB_NUMLOCK_FLAG) s1 |= 32; |
| if (key_shifts & KB_CAPSLOCK_FLAG) s1 |= 64; |
| |
| _farnspokeb(0x417, s1); |
| _farnspokeb(0x418, s2); |
| _farnspokeb(0x496, s3); |
| update_leds(key_shifts); |
| |
| ENABLE(); |
| pc_remove_irq(KEYB_IRQ); |
| } |
| } |
| |
| |
| int |
| pc_install_keyb (void) |
| { |
| if (keyboard_installed || pc_install_irq(KEYB_IRQ, keyboard)) { |
| return -1; |
| } else { |
| int s1, s2, s3; |
| |
| LOCKDATA(key_buffer); |
| LOCKDATA(key_enhanced); |
| LOCKDATA(key_pause_loop); |
| LOCKDATA(key_shifts); |
| LOCKDATA(leds_ok); |
| LOCKDATA(in_a_terrupt); |
| LOCKDATA(pc_key); |
| LOCKDATA(modifier_table); |
| LOCKDATA(hw_to_mycode); |
| LOCKDATA(hw_to_mycode_ex); |
| LOCKDATA(standard_key_ascii_table); |
| LOCKDATA(standard_key_capslock_table); |
| LOCKDATA(standard_key_shift_table); |
| LOCKDATA(standard_key_control_table); |
| LOCKDATA(numlock_table); |
| LOCKFUNC(update_leds); |
| LOCKFUNC(inject_key); |
| LOCKFUNC(handle_code); |
| LOCKFUNC(keyboard); |
| |
| DISABLE(); |
| _farsetsel(__djgpp_dos_sel); |
| _farnspokew(0x41c, _farnspeekw(0x41a)); |
| |
| key_shifts = 0; |
| s1 = _farnspeekb(0x417); |
| s2 = _farnspeekb(0x418); |
| s3 = _farnspeekb(0x496); |
| |
| if (s1 & 1) { key_shifts |= KB_SHIFT_FLAG; pc_key[KEY_RSHIFT] = TRUE; } |
| if (s1 & 2) { key_shifts |= KB_SHIFT_FLAG; pc_key[KEY_LSHIFT] = TRUE; } |
| if (s2 & 1) { key_shifts |= KB_CTRL_FLAG; pc_key[KEY_LCONTROL] = TRUE; } |
| if (s2 & 2) { key_shifts |= KB_ALT_FLAG; pc_key[KEY_ALT] = TRUE; } |
| if (s3 & 4) { key_shifts |= KB_CTRL_FLAG; pc_key[KEY_RCONTROL] = TRUE; } |
| if (s3 & 8) { key_shifts |= KB_ALT_FLAG; pc_key[KEY_ALTGR] = TRUE; } |
| |
| if (s1 & 16) key_shifts |= KB_SCROLOCK_FLAG; |
| if (s1 & 32) key_shifts |= KB_NUMLOCK_FLAG; |
| if (s1 & 64) key_shifts |= KB_CAPSLOCK_FLAG; |
| update_leds(key_shifts); |
| |
| key_enhanced = key_pause_loop = 0; |
| key_buffer.start = key_buffer.end = 0; |
| ENABLE(); |
| |
| pc_atexit(pc_remove_keyb); |
| keyboard_installed = TRUE; |
| return 0; |
| } |
| } |
