arch/i386-pc/Drivers/keyboard/kbd_common.c

   1 /*
   2     Copyright © 1995-2001, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: PS/2 mouse driver.
   6     Lang: English.
   7 */
   8
   9 #include "kbd.h"
  10 #define TIMER_RPROK 3599597124UL
  11
  12 static ULONG usec2tick(ULONG usec)
  13 {
  14     ULONG ret;
  15     ULONG prok = TIMER_RPROK;
  16     asm volatile("movl $0,%%eax; divl %2":"=a"(ret):"d"(usec),"m"(prok));
  17     return ret;
  18 }
  19
  20 static void mouse_usleep(LONG usec)
  21 {
  22     int oldtick, tick;
  23     usec = usec2tick(usec);
  24
  25     outb(0x80, 0x43);
  26     oldtick = inb(0x42);
  27     oldtick += inb(0x42) << 8;
  28
  29     while (usec > 0)
  30     {
  31         outb(0x80, 0x43);
  32         tick = inb(0x42);
  33         tick += inb(0x42) << 8;
  34
  35         usec -= (oldtick - tick);
  36         if (tick > oldtick) usec -= 0x10000;
  37         oldtick = tick;
  38     }
  39 }
  40
  41
  42 unsigned char handle_kbd_event(void)
  43 {
  44     unsigned char status = kbd_read_status();
  45     unsigned int work = 10000;
  46
  47     while (status & KBD_STATUS_OBF)
  48     {
  49         unsigned char scancode;
  50
  51         scancode = kbd_read_input();
  52
  53         status = kbd_read_status();
  54         if(!work--)
  55         {
  56             //printf(KERN_ERR "pc_keyb: controller jammed (0x%02X).\n",status);
  57             break;
  58         }
  59     }
  60     return status;
  61 }
  62
  63 void kb_wait(void)
  64 {
  65     ULONG timeout = 1000; /* 1 sec should be enough */
  66
  67     do
  68     {
  69         unsigned char status = handle_kbd_event();
  70         if (! (status & KBD_STATUS_IBF))
  71             return;
  72
  73         mouse_usleep(1000);
  74         timeout--;
  75     } while (timeout);
  76 }
  77
  78 void kbd_write_cmd(int cmd)
  79 {
  80     kb_wait();
  81     kbd_write_command(KBD_CTRLCMD_WRITE_MODE);
  82     kb_wait();
  83     kbd_write_output(cmd);
  84 }
  85
  86 void aux_write_ack(int val)
  87 {
  88     kb_wait();
  89     kbd_write_command(KBD_CTRLCMD_WRITE_MOUSE);
  90     kb_wait();;
  91     kbd_write_output(val);
  92     kb_wait();
  93 }
  94
  95 void kbd_write_output_w(int data)
  96 {
  97     kb_wait();
  98     kbd_write_output(data);
  99 }
 100
 101 void kbd_write_command_w(int data)
 102 {
 103     kb_wait();
 104     kbd_write_command(data);
 105 }
 106
 107 #define KBD_NO_DATA     (-1)
 108 #define KBD_BAD_DATA    (-2)
 109
 110 int kbd_read_data(void)
 111 {
 112     LONG        retval = KBD_NO_DATA;
 113     UBYTE       status;
 114
 115     status = kbd_read_status();
 116     if (status & KBD_STATUS_OBF)
 117     {
 118         UBYTE   data = kbd_read_input();
 119
 120         retval = data;
 121         if (status & (KBD_STATUS_GTO | KBD_STATUS_PERR))
 122             retval = KBD_BAD_DATA;
 123     }
 124
 125     return retval;
 126 }
 127
 128 void kbd_clear_input(void)
 129 {
 130     int maxread = 100;
 131
 132     do
 133     {
 134         if (kbd_read_data() == KBD_NO_DATA)
 135             break;
 136     } while (--maxread);
 137 }
 138
 139 int kbd_wait_for_input(void)
 140 {
 141     ULONG timeout = 1000;
 142
 143     do
 144     {
 145         int retval = kbd_read_data();
 146         if (retval >= 0)
 147             return retval;
 148         mouse_usleep(1000);
 149     } while(--timeout);
 150     return -1;
 151 }
 152