arch/ppc/boot/lib/kbd.c

   1 #include <linux/keyboard.h>
   2
   3 #include "defkeymap.c"  /* yeah I know it's bad -- Cort */
   4
   5
   6 unsigned char shfts, ctls, alts, caps;
   7
   8 #define KBDATAP         0x60    /* kbd data port */
   9 #define KBSTATUSPORT    0x61    /* kbd status */
  10 #define KBSTATP         0x64    /* kbd status port */
  11 #define KBINRDY         0x01
  12 #define KBOUTRDY        0x02
  13
  14 extern unsigned char inb(int port);
  15 extern void outb(int port, char val);
  16 extern void puts(const char *);
  17 extern void puthex(unsigned long val);
  18 extern void udelay(long x);
  19
  20 static int kbd(int noblock)
  21 {
  22         unsigned char dt, brk, val;
  23         unsigned code;
  24 loop:
  25         if (noblock) {
  26             if ((inb(KBSTATP) & KBINRDY) == 0)
  27                 return (-1);
  28         } else while((inb(KBSTATP) & KBINRDY) == 0) ;
  29
  30         dt = inb(KBDATAP);
  31
  32         brk = dt & 0x80;        /* brk == 1 on key release */
  33         dt = dt & 0x7f;         /* keycode */
  34
  35         if (shfts)
  36             code = shift_map[dt];
  37         else if (ctls)
  38             code = ctrl_map[dt];
  39         else
  40             code = plain_map[dt];
  41
  42         val = KVAL(code);
  43         switch (KTYP(code) & 0x0f) {
  44             case KT_LATIN:
  45                 if (brk)
  46                     break;
  47                 if (alts)
  48                     val |= 0x80;
  49                 if (val == 0x7f)        /* map delete to backspace */
  50                     val = '\b';
  51                 return val;
  52
  53             case KT_LETTER:
  54                 if (brk)
  55                     break;
  56                 if (caps)
  57                     val -= 'a'-'A';
  58                 return val;
  59
  60             case KT_SPEC:
  61                 if (brk)
  62                     break;
  63                 if (val == KVAL(K_CAPS))
  64                     caps = !caps;
  65                 else if (val == KVAL(K_ENTER)) {
  66 enter:              /* Wait for key up */
  67                     while (1) {
  68                         while((inb(KBSTATP) & KBINRDY) == 0) ;
  69                         dt = inb(KBDATAP);
  70                         if (dt & 0x80) /* key up */ break;
  71                     }
  72                     return 10;
  73                 }
  74                 break;
  75
  76             case KT_PAD:
  77                 if (brk)
  78                     break;
  79                 if (val < 10)
  80                     return val;
  81                 if (val == KVAL(K_PENTER))
  82                     goto enter;
  83                 break;
  84
  85             case KT_SHIFT:
  86                 switch (val) {
  87                     case KG_SHIFT:
  88                     case KG_SHIFTL:
  89                     case KG_SHIFTR:
  90                         shfts = brk ? 0 : 1;
  91                         break;
  92                     case KG_ALT:
  93                     case KG_ALTGR:
  94                         alts = brk ? 0 : 1;
  95                         break;
  96                     case KG_CTRL:
  97                     case KG_CTRLL:
  98                     case KG_CTRLR:
  99                         ctls = brk ? 0 : 1;
 100                         break;
 101                 }
 102                 break;
 103
 104             case KT_LOCK:
 105                 switch (val) {
 106                     case KG_SHIFT:
 107                     case KG_SHIFTL:
 108                     case KG_SHIFTR:
 109                         if (brk)
 110                             shfts = !shfts;
 111                         break;
 112                     case KG_ALT:
 113                     case KG_ALTGR:
 114                         if (brk)
 115                             alts = !alts;
 116                         break;
 117                     case KG_CTRL:
 118                     case KG_CTRLL:
 119                     case KG_CTRLR:
 120                         if (brk)
 121                             ctls = !ctls;
 122                         break;
 123                 }
 124                 break;
 125         }
 126         if (brk) return (-1);  /* Ignore initial 'key up' codes */
 127         goto loop;
 128 }
 129
 130 static int __kbdreset(void)
 131 {
 132         unsigned char c;
 133         int i, t;
 134
 135         /* flush input queue */
 136         t = 2000;
 137         while ((inb(KBSTATP) & KBINRDY))
 138         {
 139                 (void)inb(KBDATAP);
 140                 if (--t == 0)
 141                         return 1;
 142         }
 143         /* Send self-test */
 144         t = 20000;
 145         while (inb(KBSTATP) & KBOUTRDY)
 146                 if (--t == 0)
 147                         return 2;
 148         outb(KBSTATP,0xAA);
 149         t = 200000;
 150         while ((inb(KBSTATP) & KBINRDY) == 0)   /* wait input ready */
 151                 if (--t == 0)
 152                         return 3;
 153         if ((c = inb(KBDATAP)) != 0x55)
 154         {
 155                 puts("Keyboard self test failed - result:");
 156                 puthex(c);
 157                 puts("\n");
 158         }
 159         /* Enable interrupts and keyboard controller */
 160         t = 20000;
 161         while (inb(KBSTATP) & KBOUTRDY)
 162                 if (--t == 0) return 4;
 163         outb(KBSTATP,0x60);
 164         t = 20000;
 165         while (inb(KBSTATP) & KBOUTRDY)
 166                 if (--t == 0) return 5;
 167         outb(KBDATAP,0x45);
 168         for (i = 0;  i < 10000;  i++) udelay(1);
 169
 170         t = 20000;
 171         while (inb(KBSTATP) & KBOUTRDY)
 172                 if (--t == 0) return 6;
 173         outb(KBSTATP,0x20);
 174         t = 200000;
 175         while ((inb(KBSTATP) & KBINRDY) == 0)   /* wait input ready */
 176                 if (--t == 0) return 7;
 177         if (! (inb(KBDATAP) & 0x40)) {
 178                 /*
 179                  * Quote from PS/2 System Reference Manual:
 180                  *
 181                  * "Address hex 0060 and address hex 0064 should be
 182                  * written only when the input-buffer-full bit and
 183                  * output-buffer-full bit in the Controller Status
 184                  * register are set 0." (KBINRDY and KBOUTRDY)
 185                  */
 186                 t = 200000;
 187                 while (inb(KBSTATP) & (KBINRDY | KBOUTRDY))
 188                         if (--t == 0) return 8;
 189                 outb(KBDATAP,0xF0);
 190                 t = 200000;
 191                 while (inb(KBSTATP) & (KBINRDY | KBOUTRDY))
 192                         if (--t == 0) return 9;
 193                 outb(KBDATAP,0x01);
 194         }
 195         t = 20000;
 196         while (inb(KBSTATP) & KBOUTRDY)
 197                 if (--t == 0) return 10;
 198         outb(KBSTATP,0xAE);
 199         return 0;
 200 }
 201
 202 static void kbdreset(void)
 203 {
 204         int ret = __kbdreset();
 205
 206         if (ret) {
 207                 puts("__kbdreset failed: ");
 208                 puthex(ret);
 209                 puts("\n");
 210         }
 211 }
 212
 213 /* We have to actually read the keyboard when CRT_tstc is called,
 214  * since the pending data might be a key release code, and therefore
 215  * not valid data.  In this case, kbd() will return -1, even though there's
 216  * data to be read.  Of course, we might actually read a valid key press,
 217  * in which case it gets queued into key_pending for use by CRT_getc.
 218  */
 219
 220 static int kbd_reset = 0;
 221
 222 static int key_pending = -1;
 223
 224 int CRT_getc(void)
 225 {
 226         int c;
 227         if (!kbd_reset) {kbdreset(); kbd_reset++; }
 228
 229         if (key_pending != -1) {
 230                 c = key_pending;
 231                 key_pending = -1;
 232                 return c;
 233         } else {
 234         while ((c = kbd(0)) == 0) ;
 235                 return c;
 236         }
 237 }
 238
 239 int CRT_tstc(void)
 240 {
 241         if (!kbd_reset) {kbdreset(); kbd_reset++; }
 242
 243         while (key_pending == -1 && ((inb(KBSTATP) & KBINRDY) != 0)) {
 244                 key_pending = kbd(1);
 245         }
 246
 247         return (key_pending != -1);
 248 }