]>
Commit | Line | Data |
---|---|---|
c609719b WD |
1 | /* |
2 | * (C) Copyright 2002 ELTEC Elektronik AG | |
3 | * Frank Gottschling <[email protected]> | |
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 | |
bfc81252 | 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
c609719b WD |
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 | ||
a7b9fb91 SR |
30 | #ifdef CONFIG_USE_CPCIDVI |
31 | extern u8 gt_cpcidvi_in8(u32 offset); | |
32 | extern void gt_cpcidvi_out8(u32 offset, u8 data); | |
33 | ||
bfc81252 | 34 | #define in8(a) gt_cpcidvi_in8(a) |
a7b9fb91 SR |
35 | #define out8(a, b) gt_cpcidvi_out8(a,b) |
36 | #endif | |
37 | ||
c609719b WD |
38 | #include <i8042.h> |
39 | ||
40 | /* defines */ | |
41 | ||
42 | #ifdef CONFIG_CONSOLE_CURSOR | |
43 | extern void console_cursor (int state); | |
6d0f6bcf | 44 | static int blinkCount = CONFIG_SYS_CONSOLE_BLINK_COUNT; |
c609719b WD |
45 | static int cursor_state = 0; |
46 | #endif | |
47 | ||
48 | /* locals */ | |
49 | ||
bfc81252 WD |
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 */ | |
c609719b WD |
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 */ | |
bfc81252 WD |
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 */ | |
c609719b WD |
87 | }; |
88 | ||
89 | static unsigned char kbd_key_map [2][5][144] = | |
90 | { | |
91 | { /* US keyboard */ | |
92 | { /* unshift code */ | |
bfc81252 WD |
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 */ | |
c609719b WD |
111 | }, |
112 | { /* shift code */ | |
bfc81252 WD |
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 */ | |
c609719b WD |
131 | }, |
132 | { /* control code */ | |
bfc81252 WD |
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 */ | |
c609719b WD |
151 | }, |
152 | { /* non numeric code */ | |
bfc81252 WD |
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 */ | |
c609719b WD |
171 | }, |
172 | { /* right alt mode - not used in US keyboard */ | |
bfc81252 WD |
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 */ | |
c609719b WD |
191 | } |
192 | }, | |
193 | { /* german keyboard */ | |
194 | { /* unshift code */ | |
bfc81252 WD |
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 */ | |
c609719b WD |
213 | }, |
214 | { /* shift code */ | |
bfc81252 WD |
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 */ | |
c609719b WD |
233 | }, |
234 | { /* control code */ | |
bfc81252 WD |
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 */ | |
c609719b WD |
253 | }, |
254 | { /* non numeric code */ | |
bfc81252 WD |
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 */ | |
c609719b WD |
273 | }, |
274 | { /* Right alt mode - is used in German keyboard */ | |
bfc81252 WD |
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 */ | |
c609719b WD |
293 | } |
294 | } | |
295 | }; | |
296 | ||
297 | static unsigned char ext_key_map [] = | |
298 | { | |
299 | 0x1c, /* keypad enter */ | |
300 | 0x1d, /* right control */ | |
301 | 0x35, /* keypad slash */ | |
302 | 0x37, /* print screen */ | |
303 | 0x38, /* right alt */ | |
304 | 0x46, /* break */ | |
305 | 0x47, /* editpad home */ | |
306 | 0x48, /* editpad up */ | |
307 | 0x49, /* editpad pgup */ | |
308 | 0x4b, /* editpad left */ | |
309 | 0x4d, /* editpad right */ | |
310 | 0x4f, /* editpad end */ | |
311 | 0x50, /* editpad dn */ | |
312 | 0x51, /* editpad pgdn */ | |
313 | 0x52, /* editpad ins */ | |
314 | 0x53, /* editpad del */ | |
315 | 0x00 /* map end */ | |
316 | }; | |
317 | ||
318 | /******************************************************************************* | |
319 | * | |
320 | * i8042_kbd_init - reset keyboard and init state flags | |
321 | */ | |
322 | int i8042_kbd_init (void) | |
323 | { | |
324 | int keymap, try; | |
325 | char *penv; | |
326 | ||
a7b9fb91 SR |
327 | #ifdef CONFIG_USE_CPCIDVI |
328 | if ((penv = getenv ("console")) != NULL) { | |
bfc81252 WD |
329 | if (strncmp (penv, "serial", 7) == 0) { |
330 | return -1; | |
a7b9fb91 SR |
331 | } |
332 | } | |
333 | #endif | |
c609719b WD |
334 | /* Init keyboard device (default US layout) */ |
335 | keymap = KBD_US; | |
336 | if ((penv = getenv ("keymap")) != NULL) | |
337 | { | |
8bde7f77 WD |
338 | if (strncmp (penv, "de", 3) == 0) |
339 | keymap = KBD_GER; | |
c609719b WD |
340 | } |
341 | ||
342 | for (try = 0; try < KBD_RESET_TRIES; try++) | |
343 | { | |
8bde7f77 WD |
344 | if (kbd_reset() == 0) |
345 | { | |
bfc81252 WD |
346 | kbd_mapping = keymap; |
347 | kbd_flags = NORMAL; | |
348 | kbd_state = 0; | |
8bde7f77 WD |
349 | kbd_led_set(); |
350 | return 0; | |
351 | } | |
c609719b WD |
352 | } |
353 | return -1; | |
354 | } | |
355 | ||
356 | ||
357 | /******************************************************************************* | |
358 | * | |
359 | * i8042_tstc - test if keyboard input is available | |
bfc81252 | 360 | * option: cursor blinking if called in a loop |
c609719b WD |
361 | */ |
362 | int i8042_tstc (void) | |
363 | { | |
364 | unsigned char scan_code = 0; | |
365 | ||
366 | #ifdef CONFIG_CONSOLE_CURSOR | |
367 | if (--blinkCount == 0) | |
368 | { | |
8bde7f77 WD |
369 | cursor_state ^= 1; |
370 | console_cursor (cursor_state); | |
6d0f6bcf | 371 | blinkCount = CONFIG_SYS_CONSOLE_BLINK_COUNT; |
8bde7f77 | 372 | udelay (10); |
c609719b WD |
373 | } |
374 | #endif | |
375 | ||
376 | if ((in8 (I8042_STATUS_REG) & 0x01) == 0) | |
8bde7f77 | 377 | return 0; |
c609719b WD |
378 | else |
379 | { | |
8bde7f77 WD |
380 | scan_code = in8 (I8042_DATA_REG); |
381 | if (scan_code == 0xfa) | |
382 | return 0; | |
c609719b | 383 | |
8bde7f77 | 384 | kbd_conv_char(scan_code); |
c609719b | 385 | |
8bde7f77 WD |
386 | if (kbd_input != -1) |
387 | return 1; | |
c609719b WD |
388 | } |
389 | return 0; | |
390 | } | |
391 | ||
392 | ||
393 | /******************************************************************************* | |
394 | * | |
395 | * i8042_getc - wait till keyboard input is available | |
bfc81252 | 396 | * option: turn on/off cursor while waiting |
c609719b WD |
397 | */ |
398 | int i8042_getc (void) | |
399 | { | |
400 | int ret_chr; | |
401 | unsigned char scan_code; | |
402 | ||
403 | while (kbd_input == -1) | |
404 | { | |
8bde7f77 WD |
405 | while ((in8 (I8042_STATUS_REG) & 0x01) == 0) |
406 | { | |
c609719b | 407 | #ifdef CONFIG_CONSOLE_CURSOR |
8bde7f77 WD |
408 | if (--blinkCount==0) |
409 | { | |
410 | cursor_state ^= 1; | |
411 | console_cursor (cursor_state); | |
6d0f6bcf | 412 | blinkCount = CONFIG_SYS_CONSOLE_BLINK_COUNT; |
8bde7f77 WD |
413 | } |
414 | udelay (10); | |
c609719b | 415 | #endif |
8bde7f77 | 416 | } |
c609719b | 417 | |
8bde7f77 | 418 | scan_code = in8 (I8042_DATA_REG); |
c609719b | 419 | |
8bde7f77 WD |
420 | if (scan_code != 0xfa) |
421 | kbd_conv_char (scan_code); | |
c609719b WD |
422 | } |
423 | ret_chr = kbd_input; | |
424 | kbd_input = -1; | |
425 | return ret_chr; | |
426 | } | |
427 | ||
428 | ||
429 | /******************************************************************************/ | |
430 | ||
431 | static void kbd_conv_char (unsigned char scan_code) | |
432 | { | |
433 | if (scan_code == 0xe0) | |
434 | { | |
8bde7f77 WD |
435 | kbd_flags |= EXT; |
436 | return; | |
c609719b WD |
437 | } |
438 | ||
439 | /* if high bit of scan_code, set break flag */ | |
440 | if (scan_code & 0x80) | |
8bde7f77 | 441 | kbd_flags |= BRK; |
c609719b | 442 | else |
8bde7f77 | 443 | kbd_flags &= ~BRK; |
c609719b WD |
444 | |
445 | if ((scan_code == 0xe1) || (kbd_flags & E1)) | |
446 | { | |
8bde7f77 WD |
447 | if (scan_code == 0xe1) |
448 | { | |
bfc81252 WD |
449 | kbd_flags ^= BRK; /* reset the break flag */ |
450 | kbd_flags ^= E1; /* bitwise EXOR with E1 flag */ | |
8bde7f77 WD |
451 | } |
452 | return; | |
c609719b WD |
453 | } |
454 | ||
455 | scan_code &= 0x7f; | |
456 | ||
457 | if (kbd_flags & EXT) | |
458 | { | |
8bde7f77 WD |
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; | |
c609719b WD |
473 | } |
474 | ||
475 | switch (kbd_fct_map [scan_code]) | |
476 | { | |
477 | case AS: kbd_normal (scan_code); | |
8bde7f77 | 478 | break; |
c609719b | 479 | case SH: kbd_shift (scan_code); |
8bde7f77 | 480 | break; |
c609719b | 481 | case CN: kbd_ctrl (scan_code); |
8bde7f77 | 482 | break; |
c609719b | 483 | case NM: kbd_num (scan_code); |
8bde7f77 | 484 | break; |
c609719b | 485 | case CP: kbd_caps (scan_code); |
8bde7f77 | 486 | break; |
c609719b | 487 | case ST: kbd_scroll (scan_code); |
8bde7f77 | 488 | break; |
c609719b | 489 | case AK: kbd_alt (scan_code); |
8bde7f77 | 490 | break; |
c609719b WD |
491 | } |
492 | return; | |
493 | } | |
494 | ||
495 | ||
496 | /******************************************************************************/ | |
497 | ||
498 | static void kbd_normal (unsigned char scan_code) | |
499 | { | |
500 | unsigned char chr; | |
501 | ||
502 | if ((kbd_flags & BRK) == NORMAL) | |
503 | { | |
504 | chr = kbd_key_map [kbd_mapping][kbd_state][scan_code]; | |
505 | if ((chr == 0xff) || (chr == 0x00)) | |
8bde7f77 WD |
506 | { |
507 | return; | |
508 | } | |
c609719b | 509 | |
8bde7f77 WD |
510 | /* if caps lock convert upper to lower */ |
511 | if (((kbd_flags & CAPS) == CAPS) && (chr >= 'a' && chr <= 'z')) | |
c609719b | 512 | { |
8bde7f77 | 513 | chr -= 'a' - 'A'; |
c609719b WD |
514 | } |
515 | kbd_input = chr; | |
516 | } | |
517 | } | |
518 | ||
519 | ||
520 | /******************************************************************************/ | |
521 | ||
522 | static void kbd_shift (unsigned char scan_code) | |
523 | { | |
524 | if ((kbd_flags & BRK) == BRK) | |
525 | { | |
8bde7f77 WD |
526 | kbd_state = AS; |
527 | kbd_flags &= (~SHIFT); | |
c609719b WD |
528 | } |
529 | else | |
530 | { | |
531 | kbd_state = SH; | |
532 | kbd_flags |= SHIFT; | |
533 | } | |
534 | } | |
535 | ||
536 | ||
537 | /******************************************************************************/ | |
538 | ||
539 | static void kbd_ctrl (unsigned char scan_code) | |
540 | { | |
541 | if ((kbd_flags & BRK) == BRK) | |
542 | { | |
543 | kbd_state = AS; | |
544 | kbd_flags &= (~CTRL); | |
545 | } | |
546 | else | |
547 | { | |
548 | kbd_state = CN; | |
549 | kbd_flags |= CTRL; | |
550 | } | |
551 | } | |
552 | ||
553 | ||
554 | /******************************************************************************/ | |
555 | ||
556 | static void kbd_caps (unsigned char scan_code) | |
557 | { | |
558 | if ((kbd_flags & BRK) == NORMAL) | |
559 | { | |
560 | kbd_flags ^= CAPS; | |
bfc81252 | 561 | kbd_led_set (); /* update keyboard LED */ |
c609719b WD |
562 | } |
563 | } | |
564 | ||
565 | ||
566 | /******************************************************************************/ | |
567 | ||
568 | static void kbd_num (unsigned char scan_code) | |
569 | { | |
570 | if ((kbd_flags & BRK) == NORMAL) | |
571 | { | |
572 | kbd_flags ^= NUM; | |
573 | kbd_state = (kbd_flags & NUM) ? AS : NM; | |
bfc81252 | 574 | kbd_led_set (); /* update keyboard LED */ |
c609719b WD |
575 | } |
576 | } | |
577 | ||
578 | ||
579 | /******************************************************************************/ | |
580 | ||
581 | static void kbd_scroll (unsigned char scan_code) | |
582 | { | |
583 | if ((kbd_flags & BRK) == NORMAL) | |
584 | { | |
8bde7f77 | 585 | kbd_flags ^= STP; |
bfc81252 | 586 | kbd_led_set (); /* update keyboard LED */ |
8bde7f77 WD |
587 | if (kbd_flags & STP) |
588 | kbd_input = 0x13; | |
589 | else | |
590 | kbd_input = 0x11; | |
c609719b WD |
591 | } |
592 | } | |
593 | ||
594 | /******************************************************************************/ | |
595 | ||
596 | static void kbd_alt (unsigned char scan_code) | |
597 | { | |
598 | if ((kbd_flags & BRK) == BRK) | |
599 | { | |
8bde7f77 WD |
600 | kbd_state = AS; |
601 | kbd_flags &= (~ALT); | |
c609719b WD |
602 | } |
603 | else | |
604 | { | |
8bde7f77 WD |
605 | kbd_state = AK; |
606 | kbd_flags &= ALT; | |
c609719b WD |
607 | } |
608 | } | |
609 | ||
610 | ||
611 | /******************************************************************************/ | |
612 | ||
613 | static void kbd_led_set (void) | |
614 | { | |
615 | kbd_input_empty(); | |
bfc81252 | 616 | out8 (I8042_DATA_REG, 0xed); /* SET LED command */ |
c609719b | 617 | kbd_input_empty(); |
bfc81252 | 618 | out8 (I8042_DATA_REG, (kbd_flags & 0x7)); /* LED bits only */ |
c609719b WD |
619 | } |
620 | ||
621 | ||
622 | /******************************************************************************/ | |
623 | ||
624 | static int kbd_input_empty (void) | |
625 | { | |
626 | int kbdTimeout = KBD_TIMEOUT; | |
627 | ||
628 | /* wait for input buf empty */ | |
629 | while ((in8 (I8042_STATUS_REG) & 0x02) && kbdTimeout--) | |
8bde7f77 | 630 | udelay(1000); |
c609719b WD |
631 | |
632 | return kbdTimeout; | |
633 | } | |
634 | ||
635 | /******************************************************************************/ | |
636 | ||
637 | static int kbd_reset (void) | |
638 | { | |
639 | if (kbd_input_empty() == 0) | |
8bde7f77 | 640 | return -1; |
c609719b WD |
641 | |
642 | out8 (I8042_DATA_REG, 0xff); | |
643 | ||
644 | udelay(250000); | |
645 | ||
646 | if (kbd_input_empty() == 0) | |
8bde7f77 | 647 | return -1; |
c609719b | 648 | |
a7b9fb91 SR |
649 | #ifdef CONFIG_USE_CPCIDVI |
650 | out8 (I8042_COMMAND_REG, 0x60); | |
651 | #else | |
c609719b | 652 | out8 (I8042_DATA_REG, 0x60); |
a7b9fb91 | 653 | #endif |
c609719b WD |
654 | |
655 | if (kbd_input_empty() == 0) | |
8bde7f77 | 656 | return -1; |
c609719b WD |
657 | |
658 | out8 (I8042_DATA_REG, 0x45); | |
659 | ||
660 | ||
661 | if (kbd_input_empty() == 0) | |
8bde7f77 | 662 | return -1; |
c609719b WD |
663 | |
664 | out8 (I8042_COMMAND_REG, 0xae); | |
665 | ||
666 | if (kbd_input_empty() == 0) | |
8bde7f77 | 667 | return -1; |
c609719b WD |
668 | |
669 | return 0; | |
670 | } |