git.sur5r.net Git - u-boot/blob - drivers/input/i8042.c

   1 /*
   2  * (C) Copyright 2002 ELTEC Elektronik AG
   3  * Frank Gottschling <fgottschling@eltec.de>
   4  *
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation; either version 2 of
  11  * the License, or (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21  * MA 02111-1307 USA
  22  */
  23
  24 /* i8042.c - Intel 8042 keyboard driver routines */
  25
  26 /* includes */
  27
  28 #include <common.h>
  29
  30 #ifdef CONFIG_USE_CPCIDVI
  31 extern u8  gt_cpcidvi_in8(u32 offset);
  32 extern void gt_cpcidvi_out8(u32 offset, u8 data);
  33
  34 #define in8(a)     gt_cpcidvi_in8(a)
  35 #define out8(a, b) gt_cpcidvi_out8(a,b)
  36 #endif
  37
  38 #include <i8042.h>
  39
  40 /* defines */
  41
  42 #ifdef CONFIG_CONSOLE_CURSOR
  43 extern void console_cursor (int state);
  44 static int blinkCount = CFG_CONSOLE_BLINK_COUNT;
  45 static int cursor_state = 0;
  46 #endif
  47
  48 /* locals */
  49
  50 static int  kbd_input    = -1;          /* no input yet */
  51 static int  kbd_mapping  = KBD_US;      /* default US keyboard */
  52 static int  kbd_flags    = NORMAL;      /* after reset */
  53 static int  kbd_state    = 0;           /* unshift code */
  54
  55 static void kbd_conv_char (unsigned char scan_code);
  56 static void kbd_led_set (void);
  57 static void kbd_normal (unsigned char scan_code);
  58 static void kbd_shift (unsigned char scan_code);
  59 static void kbd_ctrl (unsigned char scan_code);
  60 static void kbd_num (unsigned char scan_code);
  61 static void kbd_caps (unsigned char scan_code);
  62 static void kbd_scroll (unsigned char scan_code);
  63 static void kbd_alt (unsigned char scan_code);
  64 static int  kbd_input_empty (void);
  65 static int  kbd_reset (void);
  66
  67 static unsigned char kbd_fct_map [144] =
  68     { /* kbd_fct_map table for scan code */
  69     0,   AS,   AS,   AS,   AS,   AS,   AS,   AS, /* scan  0- 7 */
  70    AS,   AS,   AS,   AS,   AS,   AS,   AS,   AS, /* scan  8- F */
  71    AS,   AS,   AS,   AS,   AS,   AS,   AS,   AS, /* scan 10-17 */
  72    AS,   AS,   AS,   AS,   AS,   CN,   AS,   AS, /* scan 18-1F */
  73    AS,   AS,   AS,   AS,   AS,   AS,   AS,   AS, /* scan 20-27 */
  74    AS,   AS,   SH,   AS,   AS,   AS,   AS,   AS, /* scan 28-2F */
  75    AS,   AS,   AS,   AS,   AS,   AS,   SH,   AS, /* scan 30-37 */
  76    AS,   AS,   CP,   0,    0,    0,    0,     0, /* scan 38-3F */
  77     0,   0,    0,    0,    0,    NM,   ST,   ES, /* scan 40-47 */
  78    ES,   ES,   ES,   ES,   ES,   ES,   ES,   ES, /* scan 48-4F */
  79    ES,   ES,   ES,   ES,   0,    0,    AS,    0, /* scan 50-57 */
  80     0,   0,    0,    0,    0,    0,    0,     0, /* scan 58-5F */
  81     0,   0,    0,    0,    0,    0,    0,     0, /* scan 60-67 */
  82     0,   0,    0,    0,    0,    0,    0,     0, /* scan 68-6F */
  83    AS,   0,    0,    AS,   0,    0,    AS,    0, /* scan 70-77 */
  84     0,   AS,   0,    0,    0,    AS,   0,     0, /* scan 78-7F */
  85    AS,   CN,   AS,   AS,   AK,   ST,   EX,   EX, /* enhanced   */
  86    AS,   EX,   EX,   AS,   EX,   AS,   EX,   EX  /* enhanced   */
  87     };
  88
  89 static unsigned char kbd_key_map [2][5][144] =
  90     {
  91     { /* US keyboard */
  92     { /* unshift code */
  93     0,  0x1b,   '1',   '2',   '3',   '4',   '5',   '6',    /* scan  0- 7 */
  94   '7',   '8',   '9',   '0',   '-',   '=',  0x08,  '\t',    /* scan  8- F */
  95   'q',   'w',   'e',   'r',   't',   'y',   'u',   'i',    /* scan 10-17 */
  96   'o',   'p',   '[',   ']',  '\r',   CN,    'a',   's',    /* scan 18-1F */
  97   'd',   'f',   'g',   'h',   'j',   'k',   'l',   ';',    /* scan 20-27 */
  98  '\'',   '`',   SH,   '\\',   'z',   'x',   'c',   'v',    /* scan 28-2F */
  99   'b',   'n',   'm',   ',',   '.',   '/',   SH,    '*',    /* scan 30-37 */
 100   ' ',   ' ',   CP,      0,     0,     0,     0,     0,    /* scan 38-3F */
 101     0,     0,     0,     0,     0,   NM,    ST,    '7',    /* scan 40-47 */
 102   '8',   '9',   '-',   '4',   '5',   '6',   '+',   '1',    /* scan 48-4F */
 103   '2',   '3',   '0',   '.',     0,     0,     0,     0,    /* scan 50-57 */
 104     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 58-5F */
 105     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 60-67 */
 106     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 68-6F */
 107     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 70-77 */
 108     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 78-7F */
 109   '\r',   CN,   '/',   '*',   ' ',    ST,   'F',   'A',    /* extended */
 110     0,   'D',   'C',     0,   'B',     0,    '@',  'P'     /* extended */
 111     },
 112     { /* shift code */
 113     0,  0x1b,   '!',   '@',   '#',   '$',   '%',   '^',    /* scan  0- 7 */
 114   '&',   '*',   '(',   ')',   '_',   '+',  0x08,  '\t',    /* scan  8- F */
 115   'Q',   'W',   'E',   'R',   'T',   'Y',   'U',   'I',    /* scan 10-17 */
 116   'O',   'P',   '{',   '}',  '\r',   CN,    'A',   'S',    /* scan 18-1F */
 117   'D',   'F',   'G',   'H',   'J',   'K',   'L',   ':',    /* scan 20-27 */
 118   '"',   '~',   SH,    '|',   'Z',   'X',   'C',   'V',    /* scan 28-2F */
 119   'B',   'N',   'M',   '<',   '>',   '?',   SH,    '*',    /* scan 30-37 */
 120   ' ',   ' ',   CP,      0,     0,     0,     0,     0,    /* scan 38-3F */
 121     0,     0,     0,     0,     0,   NM,    ST,    '7',    /* scan 40-47 */
 122   '8',   '9',   '-',   '4',   '5',   '6',   '+',   '1',    /* scan 48-4F */
 123   '2',   '3',   '0',   '.',     0,     0,     0,     0,    /* scan 50-57 */
 124     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 58-5F */
 125     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 60-67 */
 126     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 68-6F */
 127     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 70-77 */
 128     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 78-7F */
 129   '\r',   CN,   '/',   '*',   ' ',    ST,   'F',   'A',    /* extended */
 130     0,   'D',   'C',     0,   'B',     0,   '@',   'P'     /* extended */
 131     },
 132     { /* control code */
 133  0xff,  0x1b,  0xff,  0x00,  0xff,  0xff,  0xff,  0xff,    /* scan  0- 7 */
 134  0x1e,  0xff,  0xff,  0xff,  0x1f,  0xff,  0xff,  '\t',    /* scan  8- F */
 135  0x11,  0x17,  0x05,  0x12,  0x14,  0x19,  0x15,  0x09,    /* scan 10-17 */
 136  0x0f,  0x10,  0x1b,  0x1d,  '\r',   CN,   0x01,  0x13,    /* scan 18-1F */
 137  0x04,  0x06,  0x07,  0x08,  0x0a,  0x0b,  0x0c,  0xff,    /* scan 20-27 */
 138  0xff,  0x1c,   SH,   0xff,  0x1a,  0x18,  0x03,  0x16,    /* scan 28-2F */
 139  0x02,  0x0e,  0x0d,  0xff,  0xff,  0xff,   SH,   0xff,    /* scan 30-37 */
 140  0xff,  0xff,   CP,   0xff,  0xff,  0xff,  0xff,  0xff,    /* scan 38-3F */
 141  0xff,  0xff,  0xff,  0xff,  0xff,   NM,    ST,   0xff,    /* scan 40-47 */
 142  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,    /* scan 48-4F */
 143  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,    /* scan 50-57 */
 144  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,    /* scan 58-5F */
 145  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,    /* scan 60-67 */
 146  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,    /* scan 68-6F */
 147  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,    /* scan 70-77 */
 148  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,    /* scan 78-7F */
 149   '\r',   CN,   '/',   '*',   ' ',    ST,  0xff,  0xff,    /* extended */
 150  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff     /* extended */
 151     },
 152     { /* non numeric code */
 153     0,  0x1b,   '1',   '2',   '3',   '4',   '5',   '6',    /* scan  0- 7 */
 154   '7',   '8',   '9',   '0',   '-',   '=',  0x08,  '\t',    /* scan  8- F */
 155   'q',   'w',   'e',   'r',   't',   'y',   'u',   'i',    /* scan 10-17 */
 156   'o',   'p',   '[',   ']',  '\r',   CN,    'a',   's',    /* scan 18-1F */
 157   'd',   'f',   'g',   'h',   'j',   'k',   'l',   ';',    /* scan 20-27 */
 158  '\'',   '`',   SH,   '\\',   'z',   'x',   'c',   'v',    /* scan 28-2F */
 159   'b',   'n',   'm',   ',',   '.',   '/',   SH,    '*',    /* scan 30-37 */
 160   ' ',   ' ',   CP,      0,     0,     0,     0,     0,    /* scan 38-3F */
 161     0,     0,     0,     0,     0,   NM,    ST,    'w',    /* scan 40-47 */
 162   'x',   'y',   'l',   't',   'u',   'v',   'm',   'q',    /* scan 48-4F */
 163   'r',   's',   'p',   'n',     0,     0,     0,     0,    /* scan 50-57 */
 164     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 58-5F */
 165     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 60-67 */
 166     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 68-6F */
 167     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 70-77 */
 168     0,     0,     0,     0,     0,     0,     0,     0,    /* scan 78-7F */
 169   '\r',   CN,   '/',   '*',   ' ',    ST,   'F',   'A',    /* extended */
 170     0,   'D',   'C',     0,   'B',     0,    '@',  'P'     /* extended */
 171     },
 172     { /* right alt mode - not used in US keyboard */
 173  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan  0 - 7 */
 174  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan  8 - F */
 175  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 10 -17 */
 176  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 18 -1F */
 177  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 20 -27 */
 178  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 28 -2F */
 179  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 30 -37 */
 180  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 38 -3F */
 181  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 40 -47 */
 182  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 48 -4F */
 183  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 50 -57 */
 184  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 58 -5F */
 185  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 60 -67 */
 186  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 68 -6F */
 187  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 70 -77 */
 188  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 78 -7F */
 189  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* extended    */
 190  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff  /* extended    */
 191     }
 192     },
 193     { /* german keyboard */
 194     { /* unshift code */
 195     0,  0x1b,   '1',   '2',   '3',   '4',   '5',   '6', /* scan  0- 7 */
 196   '7',   '8',   '9',   '0',  0xe1,  '\'',  0x08,  '\t', /* scan  8- F */
 197   'q',   'w',   'e',   'r',   't',   'z',   'u',   'i', /* scan 10-17 */
 198   'o',   'p',  0x81,   '+',  '\r',   CN,    'a',   's', /* scan 18-1F */
 199   'd',   'f',   'g',   'h',   'j',   'k',   'l',  0x94, /* scan 20-27 */
 200  0x84,   '^',   SH,    '#',   'y',   'x',   'c',   'v', /* scan 28-2F */
 201   'b',   'n',   'm',   ',',   '.',   '-',   SH,    '*', /* scan 30-37 */
 202   ' ',   ' ',   CP,      0,     0,     0,     0,     0, /* scan 38-3F */
 203     0,     0,     0,     0,     0,   NM,    ST,    '7', /* scan 40-47 */
 204   '8',   '9',   '-',   '4',   '5',   '6',   '+',   '1', /* scan 48-4F */
 205   '2',   '3',   '0',   ',',     0,     0,   '<',     0, /* scan 50-57 */
 206     0,     0,     0,     0,     0,     0,     0,     0, /* scan 58-5F */
 207     0,     0,     0,     0,     0,     0,     0,     0, /* scan 60-67 */
 208     0,     0,     0,     0,     0,     0,     0,     0, /* scan 68-6F */
 209     0,     0,     0,     0,     0,     0,     0,     0, /* scan 70-77 */
 210     0,     0,     0,     0,     0,     0,     0,     0, /* scan 78-7F */
 211   '\r',   CN,   '/',   '*',   ' ',    ST,   'F',   'A', /* extended */
 212     0,   'D',   'C',     0,   'B',     0,    '@',  'P'  /* extended */
 213     },
 214     { /* shift code */
 215     0,  0x1b,   '!',   '"',  0x15,   '$',   '%',   '&', /* scan  0- 7 */
 216   '/',   '(',   ')',   '=',   '?',   '`',  0x08,  '\t', /* scan  8- F */
 217   'Q',   'W',   'E',   'R',   'T',   'Z',   'U',   'I', /* scan 10-17 */
 218   'O',   'P',  0x9a,   '*',  '\r',   CN,    'A',   'S', /* scan 18-1F */
 219   'D',   'F',   'G',   'H',   'J',   'K',   'L',  0x99, /* scan 20-27 */
 220  0x8e,  0xf8,   SH,   '\'',   'Y',   'X',   'C',   'V', /* scan 28-2F */
 221   'B',   'N',   'M',   ';',   ':',   '_',   SH,    '*', /* scan 30-37 */
 222   ' ',   ' ',   CP,      0,     0,     0,     0,     0, /* scan 38-3F */
 223     0,     0,     0,     0,     0,   NM,    ST,    '7', /* scan 40-47 */
 224   '8',   '9',   '-',   '4',   '5',   '6',   '+',   '1', /* scan 48-4F */
 225   '2',   '3',   '0',   ',',     0,     0,   '>',     0, /* scan 50-57 */
 226     0,     0,     0,     0,     0,     0,     0,     0, /* scan 58-5F */
 227     0,     0,     0,     0,     0,     0,     0,     0, /* scan 60-67 */
 228     0,     0,     0,     0,     0,     0,     0,     0, /* scan 68-6F */
 229     0,     0,     0,     0,     0,     0,     0,     0, /* scan 70-77 */
 230     0,     0,     0,     0,     0,     0,     0,     0, /* scan 78-7F */
 231   '\r',   CN,   '/',   '*',   ' ',    ST,   'F',   'A', /* extended */
 232     0,   'D',   'C',     0,   'B',     0,   '@',   'P'  /* extended */
 233     },
 234     { /* control code */
 235  0xff,  0x1b,  0xff,  0x00,  0xff,  0xff,  0xff,  0xff, /* scan  0- 7 */
 236  0x1e,  0xff,  0xff,  0xff,  0x1f,  0xff,  0xff,  '\t', /* scan  8- F */
 237  0x11,  0x17,  0x05,  0x12,  0x14,  0x19,  0x15,  0x09, /* scan 10-17 */
 238  0x0f,  0x10,  0x1b,  0x1d,  '\r',   CN,   0x01,  0x13, /* scan 18-1F */
 239  0x04,  0x06,  0x07,  0x08,  0x0a,  0x0b,  0x0c,  0xff, /* scan 20-27 */
 240  0xff,  0x1c,   SH,   0xff,  0x1a,  0x18,  0x03,  0x16, /* scan 28-2F */
 241  0x02,  0x0e,  0x0d,  0xff,  0xff,  0xff,   SH,   0xff, /* scan 30-37 */
 242  0xff,  0xff,   CP,   0xff,  0xff,  0xff,  0xff,  0xff, /* scan 38-3F */
 243  0xff,  0xff,  0xff,  0xff,  0xff,   NM,    ST,   0xff, /* scan 40-47 */
 244  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 48-4F */
 245  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 50-57 */
 246  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 58-5F */
 247  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 60-67 */
 248  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 68-6F */
 249  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 70-77 */
 250  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 78-7F */
 251   '\r',   CN,   '/',   '*',   ' ',    ST,  0xff,  0xff, /* extended */
 252  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff  /* extended */
 253     },
 254     { /* non numeric code */
 255     0,  0x1b,   '1',   '2',   '3',   '4',   '5',   '6', /* scan  0- 7 */
 256   '7',   '8',   '9',   '0',  0xe1,  '\'',  0x08,  '\t', /* scan  8- F */
 257   'q',   'w',   'e',   'r',   't',   'z',   'u',   'i', /* scan 10-17 */
 258   'o',   'p',  0x81,   '+',  '\r',   CN,    'a',   's', /* scan 18-1F */
 259   'd',   'f',   'g',   'h',   'j',   'k',   'l',  0x94, /* scan 20-27 */
 260  0x84,   '^',   SH,      0,   'y',   'x',   'c',   'v', /* scan 28-2F */
 261   'b',   'n',   'm',   ',',   '.',   '-',   SH,    '*', /* scan 30-37 */
 262   ' ',   ' ',   CP,      0,     0,     0,     0,     0, /* scan 38-3F */
 263     0,     0,     0,     0,     0,   NM,    ST,    'w', /* scan 40-47 */
 264   'x',   'y',   'l',   't',   'u',   'v',   'm',   'q', /* scan 48-4F */
 265   'r',   's',   'p',   'n',     0,     0,   '<',     0, /* scan 50-57 */
 266     0,     0,     0,     0,     0,     0,     0,     0, /* scan 58-5F */
 267     0,     0,     0,     0,     0,     0,     0,     0, /* scan 60-67 */
 268     0,     0,     0,     0,     0,     0,     0,     0, /* scan 68-6F */
 269     0,     0,     0,     0,     0,     0,     0,     0, /* scan 70-77 */
 270     0,     0,     0,     0,     0,     0,     0,     0, /* scan 78-7F */
 271   '\r',   CN,   '/',   '*',   ' ',    ST,   'F',   'A', /* extended */
 272     0,   'D',   'C',     0,   'B',     0,    '@',  'P'  /* extended */
 273     },
 274     { /* Right alt mode - is used in German keyboard */
 275  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan  0 - 7 */
 276   '{',   '[',   ']',   '}',  '\\',  0xff,  0xff,  0xff, /* scan  8 - F */
 277   '@',  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 10 -17 */
 278  0xff,  0xff,  0xff,   '~',  0xff,  0xff,  0xff,  0xff, /* scan 18 -1F */
 279  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 20 -27 */
 280  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 28 -2F */
 281  0xff,  0xff,  0xe6,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 30 -37 */
 282  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 38 -3F */
 283  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 40 -47 */
 284  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 48 -4F */
 285  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,   '|',  0xff, /* scan 50 -57 */
 286  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 58 -5F */
 287  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 60 -67 */
 288  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 68 -6F */
 289  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 70 -77 */
 290  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* scan 78 -7F */
 291  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff, /* extended    */
 292  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff,  0xff  /* extended    */
 293     }
 294     }
 295     };
 296
 297 static unsigned char ext_key_map [] =
 298     {
 299     0x1c,   /* keypad enter */
 300     0x1d,   /* right control */
 301     0x35,   /* keypad slash */
 302     0x37,   /* print screen */
 303     0x38,   /* right alt */
 304     0x46,   /* break */
 305     0x47,   /* editpad home */
 306     0x48,   /* editpad up */
 307     0x49,   /* editpad pgup */
 308     0x4b,   /* editpad left */
 309     0x4d,   /* editpad right */
 310     0x4f,   /* editpad end */
 311     0x50,   /* editpad dn */
 312     0x51,   /* editpad pgdn */
 313     0x52,   /* editpad ins */
 314     0x53,   /* editpad del */
 315     0x00    /* map end */
 316     };
 317
 318 /*******************************************************************************
 319  *
 320  * i8042_kbd_init - reset keyboard and init state flags
 321  */
 322 int i8042_kbd_init (void)
 323 {
 324     int keymap, try;
 325     char *penv;
 326
 327 #ifdef CONFIG_USE_CPCIDVI
 328     if ((penv = getenv ("console")) != NULL) {
 329             if (strncmp (penv, "serial", 7) == 0) {
 330                     return -1;
 331             }
 332     }
 333 #endif
 334     /* Init keyboard device (default US layout) */
 335     keymap = KBD_US;
 336     if ((penv = getenv ("keymap")) != NULL)
 337     {
 338         if (strncmp (penv, "de", 3) == 0)
 339         keymap = KBD_GER;
 340     }
 341
 342     for (try = 0; try < KBD_RESET_TRIES; try++)
 343     {
 344         if (kbd_reset() == 0)
 345         {
 346             kbd_mapping   = keymap;
 347             kbd_flags     = NORMAL;
 348             kbd_state     = 0;
 349             kbd_led_set();
 350             return 0;
 351             }
 352     }
 353     return -1;
 354 }
 355
 356
 357 /*******************************************************************************
 358  *
 359  * i8042_tstc - test if keyboard input is available
 360  *              option: cursor blinking if called in a loop
 361  */
 362 int i8042_tstc (void)
 363 {
 364     unsigned char scan_code = 0;
 365
 366 #ifdef CONFIG_CONSOLE_CURSOR
 367     if (--blinkCount == 0)
 368     {
 369         cursor_state ^= 1;
 370         console_cursor (cursor_state);
 371         blinkCount = CFG_CONSOLE_BLINK_COUNT;
 372         udelay (10);
 373     }
 374 #endif
 375
 376     if ((in8 (I8042_STATUS_REG) & 0x01) == 0)
 377         return 0;
 378     else
 379     {
 380         scan_code = in8 (I8042_DATA_REG);
 381         if (scan_code == 0xfa)
 382             return 0;
 383
 384         kbd_conv_char(scan_code);
 385
 386         if (kbd_input != -1)
 387             return 1;
 388     }
 389     return 0;
 390 }
 391
 392
 393 /*******************************************************************************
 394  *
 395  * i8042_getc - wait till keyboard input is available
 396  *              option: turn on/off cursor while waiting
 397  */
 398 int i8042_getc (void)
 399 {
 400     int ret_chr;
 401     unsigned char scan_code;
 402
 403     while (kbd_input == -1)
 404     {
 405         while ((in8 (I8042_STATUS_REG) & 0x01) == 0)
 406         {
 407 #ifdef CONFIG_CONSOLE_CURSOR
 408             if (--blinkCount==0)
 409             {
 410                 cursor_state ^= 1;
 411                 console_cursor (cursor_state);
 412                 blinkCount = CFG_CONSOLE_BLINK_COUNT;
 413             }
 414             udelay (10);
 415 #endif
 416         }
 417
 418         scan_code = in8 (I8042_DATA_REG);
 419
 420         if (scan_code != 0xfa)
 421         kbd_conv_char (scan_code);
 422     }
 423     ret_chr = kbd_input;
 424     kbd_input = -1;
 425     return ret_chr;
 426 }
 427
 428
 429 /******************************************************************************/
 430
 431 static void kbd_conv_char (unsigned char scan_code)
 432 {
 433     if (scan_code == 0xe0)
 434     {
 435         kbd_flags |= EXT;
 436         return;
 437     }
 438
 439     /* if high bit of scan_code, set break flag */
 440     if (scan_code & 0x80)
 441         kbd_flags |=  BRK;
 442     else
 443         kbd_flags &= ~BRK;
 444
 445     if ((scan_code == 0xe1) || (kbd_flags & E1))
 446     {
 447         if (scan_code == 0xe1)
 448         {
 449             kbd_flags ^= BRK;     /* reset the break flag */
 450             kbd_flags ^= E1;      /* bitwise EXOR with E1 flag */
 451         }
 452         return;
 453     }
 454
 455     scan_code &= 0x7f;
 456
 457     if (kbd_flags & EXT)
 458     {
 459         int i;
 460
 461         kbd_flags ^= EXT;
 462         for (i=0; ext_key_map[i]; i++)
 463         {
 464             if (ext_key_map[i] == scan_code)
 465             {
 466                 scan_code = 0x80 + i;
 467                 break;
 468             }
 469         }
 470         /* not found ? */
 471         if (!ext_key_map[i])
 472             return;
 473     }
 474
 475     switch (kbd_fct_map [scan_code])
 476     {
 477     case AS:  kbd_normal (scan_code);
 478         break;
 479     case SH:  kbd_shift (scan_code);
 480         break;
 481     case CN:  kbd_ctrl (scan_code);
 482         break;
 483     case NM:  kbd_num (scan_code);
 484         break;
 485     case CP:  kbd_caps (scan_code);
 486         break;
 487     case ST:  kbd_scroll (scan_code);
 488         break;
 489     case AK:  kbd_alt (scan_code);
 490         break;
 491     }
 492     return;
 493 }
 494
 495
 496 /******************************************************************************/
 497
 498 static void kbd_normal (unsigned char scan_code)
 499 {
 500     unsigned char chr;
 501
 502     if ((kbd_flags & BRK) == NORMAL)
 503     {
 504        chr = kbd_key_map [kbd_mapping][kbd_state][scan_code];
 505        if ((chr == 0xff) || (chr == 0x00))
 506         {
 507             return;
 508         }
 509
 510         /* if caps lock convert upper to lower */
 511         if (((kbd_flags & CAPS) == CAPS) && (chr >= 'a' && chr <= 'z'))
 512        {
 513            chr -= 'a' - 'A';
 514        }
 515        kbd_input = chr;
 516     }
 517 }
 518
 519
 520 /******************************************************************************/
 521
 522 static void kbd_shift (unsigned char scan_code)
 523 {
 524     if ((kbd_flags & BRK) == BRK)
 525     {
 526         kbd_state = AS;
 527         kbd_flags &= (~SHIFT);
 528     }
 529     else
 530     {
 531        kbd_state = SH;
 532        kbd_flags |= SHIFT;
 533     }
 534 }
 535
 536
 537 /******************************************************************************/
 538
 539 static void kbd_ctrl (unsigned char scan_code)
 540 {
 541     if ((kbd_flags & BRK) == BRK)
 542     {
 543        kbd_state = AS;
 544        kbd_flags &= (~CTRL);
 545     }
 546     else
 547     {
 548        kbd_state = CN;
 549        kbd_flags |= CTRL;
 550     }
 551 }
 552
 553
 554 /******************************************************************************/
 555
 556 static void kbd_caps (unsigned char scan_code)
 557 {
 558     if ((kbd_flags & BRK) == NORMAL)
 559     {
 560        kbd_flags ^= CAPS;
 561        kbd_led_set ();            /* update keyboard LED */
 562     }
 563 }
 564
 565
 566 /******************************************************************************/
 567
 568 static void kbd_num (unsigned char scan_code)
 569 {
 570     if ((kbd_flags & BRK) == NORMAL)
 571     {
 572        kbd_flags ^= NUM;
 573        kbd_state = (kbd_flags & NUM) ? AS : NM;
 574        kbd_led_set ();            /* update keyboard LED */
 575     }
 576 }
 577
 578
 579 /******************************************************************************/
 580
 581 static void kbd_scroll (unsigned char scan_code)
 582 {
 583     if ((kbd_flags & BRK) == NORMAL)
 584     {
 585         kbd_flags ^= STP;
 586         kbd_led_set ();            /* update keyboard LED */
 587         if (kbd_flags & STP)
 588             kbd_input = 0x13;
 589         else
 590             kbd_input = 0x11;
 591     }
 592 }
 593
 594 /******************************************************************************/
 595
 596 static void kbd_alt (unsigned char scan_code)
 597 {
 598     if ((kbd_flags & BRK) == BRK)
 599     {
 600         kbd_state = AS;
 601         kbd_flags &= (~ALT);
 602     }
 603     else
 604     {
 605         kbd_state = AK;
 606         kbd_flags &= ALT;
 607     }
 608 }
 609
 610
 611 /******************************************************************************/
 612
 613 static void kbd_led_set (void)
 614 {
 615     kbd_input_empty();
 616     out8 (I8042_DATA_REG, 0xed);        /* SET LED command */
 617     kbd_input_empty();
 618     out8 (I8042_DATA_REG, (kbd_flags & 0x7));    /* LED bits only */
 619 }
 620
 621
 622 /******************************************************************************/
 623
 624 static int kbd_input_empty (void)
 625 {
 626     int kbdTimeout = KBD_TIMEOUT;
 627
 628     /* wait for input buf empty */
 629     while ((in8 (I8042_STATUS_REG) & 0x02) && kbdTimeout--)
 630         udelay(1000);
 631
 632     return kbdTimeout;
 633 }
 634
 635 /******************************************************************************/
 636
 637 static int kbd_reset (void)
 638 {
 639     if (kbd_input_empty() == 0)
 640         return -1;
 641
 642     out8 (I8042_DATA_REG, 0xff);
 643
 644     udelay(250000);
 645
 646     if (kbd_input_empty() == 0)
 647         return -1;
 648
 649 #ifdef CONFIG_USE_CPCIDVI
 650     out8 (I8042_COMMAND_REG, 0x60);
 651 #else
 652     out8 (I8042_DATA_REG, 0x60);
 653 #endif
 654
 655     if (kbd_input_empty() == 0)
 656         return -1;
 657
 658     out8 (I8042_DATA_REG, 0x45);
 659
 660
 661     if (kbd_input_empty() == 0)
 662         return -1;
 663
 664     out8 (I8042_COMMAND_REG, 0xae);
 665
 666     if (kbd_input_empty() == 0)
 667         return -1;
 668
 669     return 0;
 670 }