]>
Commit | Line | Data |
---|---|---|
c609719b WD |
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 | #include <i8042.h> | |
33 | ||
34 | /* defines */ | |
35 | ||
36 | #ifdef CONFIG_CONSOLE_CURSOR | |
37 | extern void console_cursor (int state); | |
38 | static int blinkCount = CFG_CONSOLE_BLINK_COUNT; | |
39 | static int cursor_state = 0; | |
40 | #endif | |
41 | ||
42 | /* locals */ | |
43 | ||
44 | static int kbd_input = -1; /* no input yet */ | |
45 | static int kbd_mapping = KBD_US; /* default US keyboard */ | |
46 | static int kbd_flags = NORMAL; /* after reset */ | |
47 | static int kbd_state = 0; /* unshift code */ | |
48 | ||
49 | static void kbd_conv_char (unsigned char scan_code); | |
50 | static void kbd_led_set (void); | |
51 | static void kbd_normal (unsigned char scan_code); | |
52 | static void kbd_shift (unsigned char scan_code); | |
53 | static void kbd_ctrl (unsigned char scan_code); | |
54 | static void kbd_num (unsigned char scan_code); | |
55 | static void kbd_caps (unsigned char scan_code); | |
56 | static void kbd_scroll (unsigned char scan_code); | |
57 | static void kbd_alt (unsigned char scan_code); | |
58 | static int kbd_input_empty (void); | |
59 | static int kbd_reset (void); | |
60 | ||
61 | static 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 | ||
83 | static 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 | ||
291 | static 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 | */ | |
316 | int 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 | { | |
8bde7f77 WD |
325 | if (strncmp (penv, "de", 3) == 0) |
326 | keymap = KBD_GER; | |
c609719b WD |
327 | } |
328 | ||
329 | for (try = 0; try < KBD_RESET_TRIES; try++) | |
330 | { | |
8bde7f77 WD |
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 | } | |
c609719b WD |
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 | */ | |
349 | int i8042_tstc (void) | |
350 | { | |
351 | unsigned char scan_code = 0; | |
352 | ||
353 | #ifdef CONFIG_CONSOLE_CURSOR | |
354 | if (--blinkCount == 0) | |
355 | { | |
8bde7f77 WD |
356 | cursor_state ^= 1; |
357 | console_cursor (cursor_state); | |
358 | blinkCount = CFG_CONSOLE_BLINK_COUNT; | |
359 | udelay (10); | |
c609719b WD |
360 | } |
361 | #endif | |
362 | ||
363 | if ((in8 (I8042_STATUS_REG) & 0x01) == 0) | |
8bde7f77 | 364 | return 0; |
c609719b WD |
365 | else |
366 | { | |
8bde7f77 WD |
367 | scan_code = in8 (I8042_DATA_REG); |
368 | if (scan_code == 0xfa) | |
369 | return 0; | |
c609719b | 370 | |
8bde7f77 | 371 | kbd_conv_char(scan_code); |
c609719b | 372 | |
8bde7f77 WD |
373 | if (kbd_input != -1) |
374 | return 1; | |
c609719b WD |
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 | */ | |
385 | int i8042_getc (void) | |
386 | { | |
387 | int ret_chr; | |
388 | unsigned char scan_code; | |
389 | ||
390 | while (kbd_input == -1) | |
391 | { | |
8bde7f77 WD |
392 | while ((in8 (I8042_STATUS_REG) & 0x01) == 0) |
393 | { | |
c609719b | 394 | #ifdef CONFIG_CONSOLE_CURSOR |
8bde7f77 WD |
395 | if (--blinkCount==0) |
396 | { | |
397 | cursor_state ^= 1; | |
398 | console_cursor (cursor_state); | |
399 | blinkCount = CFG_CONSOLE_BLINK_COUNT; | |
400 | } | |
401 | udelay (10); | |
c609719b | 402 | #endif |
8bde7f77 | 403 | } |
c609719b | 404 | |
8bde7f77 | 405 | scan_code = in8 (I8042_DATA_REG); |
c609719b | 406 | |
8bde7f77 WD |
407 | if (scan_code != 0xfa) |
408 | kbd_conv_char (scan_code); | |
c609719b WD |
409 | } |
410 | ret_chr = kbd_input; | |
411 | kbd_input = -1; | |
412 | return ret_chr; | |
413 | } | |
414 | ||
415 | ||
416 | /******************************************************************************/ | |
417 | ||
418 | static void kbd_conv_char (unsigned char scan_code) | |
419 | { | |
420 | if (scan_code == 0xe0) | |
421 | { | |
8bde7f77 WD |
422 | kbd_flags |= EXT; |
423 | return; | |
c609719b WD |
424 | } |
425 | ||
426 | /* if high bit of scan_code, set break flag */ | |
427 | if (scan_code & 0x80) | |
8bde7f77 | 428 | kbd_flags |= BRK; |
c609719b | 429 | else |
8bde7f77 | 430 | kbd_flags &= ~BRK; |
c609719b WD |
431 | |
432 | if ((scan_code == 0xe1) || (kbd_flags & E1)) | |
433 | { | |
8bde7f77 WD |
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; | |
c609719b WD |
440 | } |
441 | ||
442 | scan_code &= 0x7f; | |
443 | ||
444 | if (kbd_flags & EXT) | |
445 | { | |
8bde7f77 WD |
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; | |
c609719b WD |
460 | } |
461 | ||
462 | switch (kbd_fct_map [scan_code]) | |
463 | { | |
464 | case AS: kbd_normal (scan_code); | |
8bde7f77 | 465 | break; |
c609719b | 466 | case SH: kbd_shift (scan_code); |
8bde7f77 | 467 | break; |
c609719b | 468 | case CN: kbd_ctrl (scan_code); |
8bde7f77 | 469 | break; |
c609719b | 470 | case NM: kbd_num (scan_code); |
8bde7f77 | 471 | break; |
c609719b | 472 | case CP: kbd_caps (scan_code); |
8bde7f77 | 473 | break; |
c609719b | 474 | case ST: kbd_scroll (scan_code); |
8bde7f77 | 475 | break; |
c609719b | 476 | case AK: kbd_alt (scan_code); |
8bde7f77 | 477 | break; |
c609719b WD |
478 | } |
479 | return; | |
480 | } | |
481 | ||
482 | ||
483 | /******************************************************************************/ | |
484 | ||
485 | static 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)) | |
8bde7f77 WD |
493 | { |
494 | return; | |
495 | } | |
c609719b | 496 | |
8bde7f77 WD |
497 | /* if caps lock convert upper to lower */ |
498 | if (((kbd_flags & CAPS) == CAPS) && (chr >= 'a' && chr <= 'z')) | |
c609719b | 499 | { |
8bde7f77 | 500 | chr -= 'a' - 'A'; |
c609719b WD |
501 | } |
502 | kbd_input = chr; | |
503 | } | |
504 | } | |
505 | ||
506 | ||
507 | /******************************************************************************/ | |
508 | ||
509 | static void kbd_shift (unsigned char scan_code) | |
510 | { | |
511 | if ((kbd_flags & BRK) == BRK) | |
512 | { | |
8bde7f77 WD |
513 | kbd_state = AS; |
514 | kbd_flags &= (~SHIFT); | |
c609719b WD |
515 | } |
516 | else | |
517 | { | |
518 | kbd_state = SH; | |
519 | kbd_flags |= SHIFT; | |
520 | } | |
521 | } | |
522 | ||
523 | ||
524 | /******************************************************************************/ | |
525 | ||
526 | static 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 | ||
543 | static 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 | ||
555 | static 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 | ||
568 | static void kbd_scroll (unsigned char scan_code) | |
569 | { | |
570 | if ((kbd_flags & BRK) == NORMAL) | |
571 | { | |
8bde7f77 WD |
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; | |
c609719b WD |
578 | } |
579 | } | |
580 | ||
581 | /******************************************************************************/ | |
582 | ||
583 | static void kbd_alt (unsigned char scan_code) | |
584 | { | |
585 | if ((kbd_flags & BRK) == BRK) | |
586 | { | |
8bde7f77 WD |
587 | kbd_state = AS; |
588 | kbd_flags &= (~ALT); | |
c609719b WD |
589 | } |
590 | else | |
591 | { | |
8bde7f77 WD |
592 | kbd_state = AK; |
593 | kbd_flags &= ALT; | |
c609719b WD |
594 | } |
595 | } | |
596 | ||
597 | ||
598 | /******************************************************************************/ | |
599 | ||
600 | static 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 | ||
611 | static 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--) | |
8bde7f77 | 617 | udelay(1000); |
c609719b WD |
618 | |
619 | return kbdTimeout; | |
620 | } | |
621 | ||
622 | /******************************************************************************/ | |
623 | ||
624 | static int kbd_reset (void) | |
625 | { | |
626 | if (kbd_input_empty() == 0) | |
8bde7f77 | 627 | return -1; |
c609719b WD |
628 | |
629 | out8 (I8042_DATA_REG, 0xff); | |
630 | ||
631 | udelay(250000); | |
632 | ||
633 | if (kbd_input_empty() == 0) | |
8bde7f77 | 634 | return -1; |
c609719b WD |
635 | |
636 | out8 (I8042_DATA_REG, 0x60); | |
637 | ||
638 | if (kbd_input_empty() == 0) | |
8bde7f77 | 639 | return -1; |
c609719b WD |
640 | |
641 | out8 (I8042_DATA_REG, 0x45); | |
642 | ||
643 | ||
644 | if (kbd_input_empty() == 0) | |
8bde7f77 | 645 | return -1; |
c609719b WD |
646 | |
647 | out8 (I8042_COMMAND_REG, 0xae); | |
648 | ||
649 | if (kbd_input_empty() == 0) | |
8bde7f77 | 650 | return -1; |
c609719b WD |
651 | |
652 | return 0; | |
653 | } | |
654 | ||
655 | #endif /* CONFIG_I8042_KBD */ |