OSDev.org

Code: Select all

void init_keyboard()
{
   putstr("Initialize the Keyboard..................");

   enable_irq(1, keyboardInt, INT_GATE|BITS_32|PRESENT|RING_2);

   SendData(0xFF);      //Restart keyboard
   SendData(0xF4);      //Enables keyboard and Scanning
   SetRate(KDefault);   //Sets default scanning rate

   enable(); // if i don't call this function, i don't get the message

   putstr(".DONE\n");

   for(;;);    // this is to be sure nothing else create the triple fault
}

void SendData(unsigned char data) //Sends a command or data to keyboard
{
   WaitForReady();      //MicroDelay((unsigned long) 10);
   outportb(0x60, data);
}

void WaitForReady(void)   //determines if the keyboard is ready to accept a command
{
    volatile long i = MAX_TRYES_FOR_READY;
    while(i-- && (inportb(0x64) & 0x02));
}

inline static unsigned char inportb(int port)
{
   register unsigned char r;
   
      asm volatile
   ( 
      "inb %%dx, %%al\n\t" 
      : "=a" (r) 
      : "d" (port)
   );

      return (r);
}

inline static void outportb(int port, unsigned char data)
{
   asm volatile
   (
      "outb %%al, %%dx\n\t" 
      :
      : "a" (data), "d" (port)
   );
}

inline static void enable()
{
   asm volatile 
   (
      "sti"
      :
      :
   );
}

Code: Select all

void clock_handler()
{
  int value;

  outportb(0x70,0x0E);   // Tell the chip what to read

  value = inportb(0x71); // read it
  
  putint(value);
}

void init_clock()
{
  disable();
  putstr("Initialize the Clock.....................");
  
  enable_irq(8, clock_handler, INT_GATE|BITS_32|PRESENT|RING_2);

  outportb(0x70,0x0B); // Tell the chip what to write
  outportb(0x71,0x53); // 01010011
   
   putstr("...DONE\n");
   
   enable();
}

Code: Select all

current_mask = 0xffff; //disables all interrupts

outportb(PICMI, current_mask & 0xFF);
outportb(PICSI, (current_mask >> 8 ) & 0xFF);