luxos/keyus.c

unsigned char kbdus[128] =
{
    0,  27, '1', '2', '3', '4', '5', '6', '7', '8',	/* 9 */
  '9', '0', '-', '=', '\b',	/* Backspace */
  '\t',			/* Tab */
  'q', 'w', 'e', 'r',	/* 19 */
  't', 'y', 'u', 'i', 'o', 'p', '[', ']', '\n',	/* Enter key */
    0,			/* 29   - Control */
  'a', 's', 'd', 'f', 'g', 'h', 'j', 'k', 'l', ';',	/* 39 */
 '\'', '`',   0,		/* Left shift */
 '\\', 'z', 'x', 'c', 'v', 'b', 'n',			/* 49 */
  'm', ',', '.', '/',   0,				/* Right shift */
  '*',
    0,	/* Alt */
  ' ',	/* Space bar */
    0,	/* Caps lock */
    0,	/* 59 - F1 key ... > */
    0,   0,   0,   0,   0,   0,   0,   0,
    0,	/* < ... F10 */
    0,	/* 69 - Num lock*/
    0,	/* Scroll Lock */
    0,	/* Home key */
    0,	/* Up Arrow */
    0,	/* Page Up */
  '-',
    0,	/* Left Arrow */
    0,
    0,	/* Right Arrow */
  '+',
    0,	/* 79 - End key*/
    0,	/* Down Arrow */
    0,	/* Page Down */
    0,	/* Insert Key */
    0,	/* Delete Key */
    0,   0,   0,
    0,	/* F11 Key */
    0,	/* F12 Key */
    0,	/* All other keys are undefined */
};

unsigned char kbdus_shift[128] =
{
    0,  27, '!', '@', '#', '$', '%', '^', '&', '*',	/* 9 */
  '(', ')', '_', '+', '\b',	/* Backspace */
  '\t',			/* Tab */
  'Q', 'W', 'E', 'R',	/* 19 */
  'T', 'Y', 'U', 'I', 'O', 'P', '{', '}', '\n',	/* Enter key */
    0,			/* 29   - Control */
  'A', 'S', 'D', 'F', 'G', 'H', 'J', 'K', 'L', ':',	/* 39 */
 '\"', '~',   0,		/* Left shift */
 '|', 'Z', 'X', 'C', 'V', 'B', 'N',			/* 49 */
  'M', '<', '>', '?',   0,				/* Right shift */
  '*',
    0,	/* Alt */
  ' ',	/* Space bar */
    0,	/* Caps lock */
    0,	/* 59 - F1 key ... > */
    0,   0,   0,   0,   0,   0,   0,   0,
    0,	/* < ... F10 */
    0,	/* 69 - Num lock*/
    0,	/* Scroll Lock */
    0,	/* Home key */
    0,	/* Up Arrow */
    0,	/* Page Up */
  '-',
    0,	/* Left Arrow */
    0,
    0,	/* Right Arrow */
  '+',
    0,	/* 79 - End key*/
    0,	/* Down Arrow */
    0,	/* Page Down */
    0,	/* Insert Key */
    0,	/* Delete Key */
    0,   0,   0,
    0,	/* F11 Key */
    0,	/* F12 Key */
    0,	/* All other keys are undefined */
};



/* kb_modifier_status:
    BIT |    Description
    ----+-----------------------------------
     0  | Left Shift
     1  | Right Shift
     2  | Left Alt
     3  | Right Alt
     4  | Left CTRL
     5  | Right CTRL
     6  | Fake Shift
     7  | Special     */
unsigned char kb_modifier_status;

/* kb_lights_status
    BIT |    Description
    ----+-----------------------------------
     0  | SCROLLOCK
     1  | NUMLOCK
     2  | CAPSLOCK */
unsigned char kb_lights_status;

void kb_update_LED()
{
    while ((inportb (0x64)&2)!=0);
    outportb (0x60, 0xED);
  
    while ((inportb (0x64)&2)!=0);
    outportb (0x60, kb_lights_status);
}

/* kb_toggle_LED
 Toggle NUM/CAPS/SCROLL LOCK LEDs. 0 to ignore. If all 0, reset; */
void kb_toggle_LED(int NUM, int CAPS, int SCROLL)
{
      if (NUM) kb_lights_status ^= 1<<1;
      if (CAPS) kb_lights_status ^= 1<<2;
      if (SCROLL) kb_lights_status ^= 1;
      if ((!NUM) && (!CAPS) && (!SCROLL)) kb_lights_status = 0;
      kb_update_LED();
}

byte prev, scancode;
void kb_handler(regs *r) {
      scancode = inportb(0x60);
     
      puts_pos(0, 0, "Key Pressed ");put_hex(30, 0, scancode);

      switch (scancode) {
        // Special
        case 0x0E: kb_modifier_status |= 1<<7;
                    break;
            
        // Left Shift or fake shift make
        case 0x2A: if (kb_modifier_status && 128) kb_modifier_status |= 1<<6;
                    else kb_modifier_status |= 1;
                    break;
                    
        // Left Shift or fake shift release
        case 0xAA: if (kb_modifier_status && 128) kb_modifier_status &= (1<<6) ^0xFF;
                    else kb_modifier_status &= 1 ^0xFF;
                    break;
                    
        // Right Shift make
        case 0x36: kb_modifier_status |= 1<<1;
                    break;
        
        // Right shift release
        case 0xB6: kb_modifier_status &= (1<<1) ^0xFF;
                    break;
                    
        // Left Alt or Right Alt make
        case 0x38: if (kb_modifier_status && 128) kb_modifier_status |= 1<<3;
                    else kb_modifier_status |= 1<<2;
                    break;
        
        // Left Alt or Right Alt release            
        case 0xB8: if (kb_modifier_status && 128) kb_modifier_status &= (1<<3) ^0xFF;
                    else kb_modifier_status &= (1<<2) ^0xFF;
                    break;
                    
        // Left Ctrl or Right Ctrl make
        case 0x1D: if (kb_modifier_status && 128) kb_modifier_status |= 1<<5;
                    else kb_modifier_status |= 1<<4;
                    break;
                    
        // Left Ctrl or Right Ctrl release
        case 0x9D: if (kb_modifier_status && 128) kb_modifier_status &= (1<<5) ^0xFF;
                    else kb_modifier_status &= (1<<5) ^0xFF;
                    break;

        // Caps, Num and Scroll (in this order)
        case 0x3A: kb_toggle_LED (0,1,0); break;
        case 0x45: kb_toggle_LED (1,0,0); break;
        case 0x46: kb_toggle_LED (0,0,1); break;

        default: if (scancode & 0x80) break;
                  if (scancode != prev) kb_modifier_status &= (1<<7) ^0xFF;
                  if ((kb_modifier_status && 1) || (kb_modifier_status && 2))
                        putc_pos(50, 0, kbdus_shift[scancode]);
                  else putc_pos (50, 0, kbdus[scancode]);
                  break;
      }
      
      outportb(0x20, 0x20);
}


char kb_getch()
{
      regs *r = 0;
      do {
            prev = scancode; kb_handler(r); }
      while (prev == scancode || prev+0x80 == scancode);
      
            
      if ((kb_modifier_status && 1) || (kb_modifier_status && 2))
                  return kbdus_shift[scancode];

      return kbdus[scancode];
}

void kb_get_status()
{
      byte a = inportb(0x64);
      puts_pos(0, 8, "KeyBrd Status: ");
      put_bin(0, 9, a);
}