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