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