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 = CONFIG_SYS_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 */
i8042_kbd_init(void)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 */
i8042_tstc(void)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 = CONFIG_SYS_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 */
i8042_getc(void)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 = CONFIG_SYS_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
kbd_conv_char(unsigned char scan_code)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
kbd_normal(unsigned char scan_code)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
kbd_shift(unsigned char scan_code)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
kbd_ctrl(unsigned char scan_code)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
kbd_caps(unsigned char scan_code)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
kbd_num(unsigned char scan_code)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
kbd_scroll(unsigned char scan_code)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
kbd_alt(unsigned char scan_code)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
kbd_led_set(void)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
kbd_input_empty(void)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
kbd_reset(void)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 }
671