Guest User

Untitled

a guest
Jun 22nd, 2012
32
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 3.50 KB | None | 0 0
  1. #include "keyboard.h"
  2. #include "../idt.h"
  3. #include "../ports.h"
  4. #include "../console.h"
  5.  
  6. static uint8_t sc_to_kc[][128] = {
  7.     {
  8.           0,   1,   2,   3,   4,   5,   6,   7,   8,   9,
  9.          10,  11,  12,  13,  14,  15,  16,  17,  18,  19,
  10.          20,  21,  22,  23,  24,  25,  26,  27,  28,  29,
  11.          30,  31,  32,  33,  34,  35,  36,  37,  38,  39,
  12.          40,  41,  42,  43,  44,  45,  46,  47,  48,  49,
  13.          50,  51,  52,  53,  54,  55,  56,  57,  58,  59,
  14.          60,  61,  62,  63,  64,  65,  66,  67,  68,  69,
  15.          70,  71,  72,  73,  74,  75,  76,  77,  78,  79,
  16.          80,  81,  82,  84,  00,  00,  86,  87,  88,  00,
  17.          00,  00,  00,  00,  00,  00,  00,  00,  00,  00,
  18.          00,  00,  00,  00,  00,  00,  00,  00,  00,  00,
  19.          00,  00,  00,  00,  00,  00,  00,  00,  00,  00,
  20.          00,  00,  00,  00,  00,  00,  00,  00
  21.     },
  22.     {
  23.          00,  00,  00,  00,  00,  00,  00,  00,  00,  00,
  24.          00,  00,  00,  00,  00,  00,  00,  00,  00,  00,
  25.          00,  00,  00,  00,  00,  00,  00,  00,  00,  97,
  26.          00,  00,  00,  00,  00,  00,  00,  00,  00,  00,
  27.          00,  00,  00,  00,  00,  00,  00,  00,  00,  00,
  28.          00,  00,  00,  00,  00,  00, 100,  00,  00,  00,
  29.          00,  00,  00,  00,  00,  00,  00,  00,  00,  00,
  30.          00, 102, 103, 104,  00, 105,  00, 106,  00, 107,
  31.         108, 109, 110, 111,  00,  00,  00,  00,  00,  00,
  32.          00,  00,  00,  00,  00,  00,  00,  00,  00,  00,
  33.          00,  00,  00,  00,  00,  00,  00,  00,  00,  00,
  34.          00,  00,  00,  00,  00,  00,  00,  00,  00,  00,
  35.          00,  00,  00,  00,  00,  00,  00,  00
  36.     },
  37. };
  38.  
  39. uint8_t translate_scancode(int set, uint16_t scancode)
  40. {
  41.     uint8_t keycode = 0;
  42.  
  43.     switch (set) {
  44.         case 0:
  45.             keycode = sc_to_kc[0][scancode];
  46.             break;
  47.         case 1:
  48.             keycode = sc_to_kc[1][scancode];
  49.             break;
  50.         case 2:
  51.             switch (scancode) {
  52.                 case 0x451D:
  53.                     keycode = 119;
  54.                     break;
  55.  
  56.                 default:
  57.                     keycode = 0x0;
  58.             };
  59.             break;
  60.     }
  61.  
  62.     if (keycode == 0) {
  63.         kprintf("kbc: Unbekannter Scancode: 0x%x (%d)\n", scancode, set);
  64.     }
  65.  
  66.     return keycode;
  67. }
  68.  
  69. void keyboard_handler() {    
  70.     uint8_t scancode;
  71.   uint8_t keycode = 0;
  72.   int break_code = 1;
  73.  
  74.   static int     e0_code = 1;
  75.   static int      e1_code = 0;
  76.   static uint16_t  e1_prev = 0;
  77.  
  78.   scancode = inb(0x60);
  79.  
  80.   if ((scancode & 0x80) &&
  81.       (e1_code || (scancode != 0xE1)) &&
  82.       (e0_code || (scancode != 0xE0)))
  83.     {
  84.     break_code = 0;
  85.     scancode &= ~0x80;
  86.         return;
  87.   }
  88.  
  89.   if (e0_code) {
  90.     if ((scancode == 0x2A) || (scancode == 0x36)) {
  91.       e0_code = 1;
  92.       return;
  93.     }
  94.  
  95.     keycode = translate_scancode(1, scancode);
  96.     e0_code = 1;
  97.   } else if (e1_code == 2) {
  98.     e1_prev |= ((uint16_t) scancode << 8);
  99.     keycode = translate_scancode(2, e1_prev);
  100.     e1_code = 0;
  101.   } else if (e1_code == 1) {
  102.     e1_prev = scancode;
  103.     e1_code++;
  104.   } else if (scancode == 0xE0) {
  105.     e0_code = 0;
  106.   } else if (scancode == 0xE1) {
  107.     e1_code = 1;
  108.   } else {
  109.     keycode = translate_scancode(0, scancode);
  110.   }
  111.  
  112.     kprintf("%c", keycode);
  113. }
  114.  
  115. void send_command(uint8_t command) {
  116.     while((inb(0x64) & 0x2)) { }
  117.     outb(0x60, command);
  118. }
  119.  
  120. void init_keyboard_drv() {
  121.     register_intr_handler(0x21, &keyboard_handler);
  122.  
  123.     while(inb(0x64) & 0x1) {
  124.         inb(0x60);
  125.     }
  126.  
  127.     send_command(0xF4);
  128. }
Advertisement
Add Comment
Please, Sign In to add comment