Rev 1759 | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
1 | jermar | 1 | /* |
2 | * Copyright (C) 2001-2004 Jakub Jermar |
||
3 | * All rights reserved. |
||
4 | * |
||
5 | * Redistribution and use in source and binary forms, with or without |
||
6 | * modification, are permitted provided that the following conditions |
||
7 | * are met: |
||
8 | * |
||
9 | * - Redistributions of source code must retain the above copyright |
||
10 | * notice, this list of conditions and the following disclaimer. |
||
11 | * - Redistributions in binary form must reproduce the above copyright |
||
12 | * notice, this list of conditions and the following disclaimer in the |
||
13 | * documentation and/or other materials provided with the distribution. |
||
14 | * - The name of the author may not be used to endorse or promote products |
||
15 | * derived from this software without specific prior written permission. |
||
16 | * |
||
17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
||
18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
||
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
||
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
||
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
||
22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
||
23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
||
24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
||
25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
||
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
||
27 | */ |
||
28 | |||
1754 | jermar | 29 | /** @addtogroup genarch |
1702 | cejka | 30 | * @{ |
31 | */ |
||
1754 | jermar | 32 | /** |
1757 | jermar | 33 | * @file |
1754 | jermar | 34 | * @brief i8042 processor driver. |
35 | * |
||
36 | * It takes care of low-level keyboard functions. |
||
1702 | cejka | 37 | */ |
38 | |||
894 | jermar | 39 | #include <genarch/i8042/i8042.h> |
40 | #include <arch/drivers/i8042.h> |
||
1 | jermar | 41 | #include <arch/interrupt.h> |
42 | #include <cpu.h> |
||
43 | #include <arch/asm.h> |
||
44 | #include <arch.h> |
||
508 | jermar | 45 | #include <synch/spinlock.h> |
46 | #include <typedefs.h> |
||
511 | jermar | 47 | #include <console/chardev.h> |
48 | #include <console/console.h> |
||
517 | jermar | 49 | #include <macros.h> |
576 | palkovsky | 50 | #include <interrupt.h> |
1 | jermar | 51 | |
1754 | jermar | 52 | /* Keyboard commands. */ |
512 | jermar | 53 | #define KBD_ENABLE 0xf4 |
54 | #define KBD_DISABLE 0xf5 |
||
55 | #define KBD_ACK 0xfa |
||
56 | |||
670 | vana | 57 | /* |
893 | jermar | 58 | * 60 Write 8042 Command Byte: next data byte written to port 60h is |
895 | jermar | 59 | * placed in 8042 command register. Format: |
893 | jermar | 60 | * |
61 | * |7|6|5|4|3|2|1|0|8042 Command Byte |
||
62 | * | | | | | | | `---- 1=enable output register full interrupt |
||
63 | * | | | | | | `----- should be 0 |
||
64 | * | | | | | `------ 1=set status register system, 0=clear |
||
65 | * | | | | `------- 1=override keyboard inhibit, 0=allow inhibit |
||
66 | * | | | `-------- disable keyboard I/O by driving clock line low |
||
67 | * | | `--------- disable auxiliary device, drives clock line low |
||
68 | * | `---------- IBM scancode translation 0=AT, 1=PC/XT |
||
69 | * `----------- reserved, should be 0 |
||
70 | */ |
||
670 | vana | 71 | |
893 | jermar | 72 | #define i8042_SET_COMMAND 0x60 |
1759 | palkovsky | 73 | #define i8042_COMMAND 0x69 |
894 | jermar | 74 | |
75 | #define i8042_BUFFER_FULL_MASK 0x01 |
||
893 | jermar | 76 | #define i8042_WAIT_MASK 0x02 |
1759 | palkovsky | 77 | #define i8042_MOUSE_DATA 0x20 |
670 | vana | 78 | |
508 | jermar | 79 | #define SPECIAL '?' |
80 | #define KEY_RELEASE 0x80 |
||
81 | |||
895 | jermar | 82 | /** |
83 | * These codes read from i8042 data register are silently ignored. |
||
84 | */ |
||
85 | #define IGNORE_CODE 0x7f |
||
86 | |||
1780 | jermar | 87 | static void key_released(uint8_t sc); |
88 | static void key_pressed(uint8_t sc); |
||
878 | vana | 89 | static char key_read(chardev_t *d); |
508 | jermar | 90 | |
91 | #define PRESSED_SHIFT (1<<0) |
||
92 | #define PRESSED_CAPSLOCK (1<<1) |
||
93 | #define LOCKED_CAPSLOCK (1<<0) |
||
94 | |||
894 | jermar | 95 | #define ACTIVE_READ_BUFF_SIZE 16 /* Must be power of 2 */ |
878 | vana | 96 | |
1780 | jermar | 97 | static uint8_t active_read_buff[ACTIVE_READ_BUFF_SIZE]; |
878 | vana | 98 | |
623 | jermar | 99 | SPINLOCK_INITIALIZE(keylock); /**< keylock protects keyflags and lockflags. */ |
508 | jermar | 100 | static volatile int keyflags; /**< Tracking of multiple keypresses. */ |
509 | jermar | 101 | static volatile int lockflags; /**< Tracking of multiple keys lockings. */ |
508 | jermar | 102 | |
575 | palkovsky | 103 | static void i8042_suspend(chardev_t *); |
104 | static void i8042_resume(chardev_t *); |
||
511 | jermar | 105 | |
106 | static chardev_t kbrd; |
||
107 | static chardev_operations_t ops = { |
||
108 | .suspend = i8042_suspend, |
||
878 | vana | 109 | .resume = i8042_resume, |
110 | .read = key_read |
||
511 | jermar | 111 | }; |
112 | |||
508 | jermar | 113 | /** Primary meaning of scancodes. */ |
114 | static char sc_primary_map[] = { |
||
115 | SPECIAL, /* 0x00 */ |
||
116 | SPECIAL, /* 0x01 - Esc */ |
||
117 | '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '-', '=', |
||
588 | palkovsky | 118 | '\b', /* 0x0e - Backspace */ |
508 | jermar | 119 | '\t', 'q', 'w', 'e', 'r', 't', 'y', 'u', 'i', 'o', 'p', '[', ']', '\n', |
120 | SPECIAL, /* 0x1d - LCtrl */ |
||
121 | 'a', 's', 'd', 'f', 'g', 'h', 'j', 'k', 'l', ';', '\'', |
||
122 | '`', |
||
123 | SPECIAL, /* 0x2a - LShift */ |
||
124 | '\\', |
||
125 | 'z', 'x', 'c', 'v', 'b', 'n', 'm', ',', '.', '/', |
||
126 | SPECIAL, /* 0x36 - RShift */ |
||
127 | '*', |
||
128 | SPECIAL, /* 0x38 - LAlt */ |
||
129 | ' ', |
||
130 | SPECIAL, /* 0x3a - CapsLock */ |
||
131 | SPECIAL, /* 0x3b - F1 */ |
||
132 | SPECIAL, /* 0x3c - F2 */ |
||
133 | SPECIAL, /* 0x3d - F3 */ |
||
134 | SPECIAL, /* 0x3e - F4 */ |
||
135 | SPECIAL, /* 0x3f - F5 */ |
||
136 | SPECIAL, /* 0x40 - F6 */ |
||
137 | SPECIAL, /* 0x41 - F7 */ |
||
138 | SPECIAL, /* 0x42 - F8 */ |
||
139 | SPECIAL, /* 0x43 - F9 */ |
||
140 | SPECIAL, /* 0x44 - F10 */ |
||
141 | SPECIAL, /* 0x45 - NumLock */ |
||
142 | SPECIAL, /* 0x46 - ScrollLock */ |
||
143 | '7', '8', '9', '-', |
||
144 | '4', '5', '6', '+', |
||
145 | '1', '2', '3', |
||
146 | '0', '.', |
||
147 | SPECIAL, /* 0x54 - Alt-SysRq */ |
||
148 | SPECIAL, /* 0x55 - F11/F12/PF1/FN */ |
||
149 | SPECIAL, /* 0x56 - unlabelled key next to LAlt */ |
||
150 | SPECIAL, /* 0x57 - F11 */ |
||
151 | SPECIAL, /* 0x58 - F12 */ |
||
152 | SPECIAL, /* 0x59 */ |
||
153 | SPECIAL, /* 0x5a */ |
||
154 | SPECIAL, /* 0x5b */ |
||
155 | SPECIAL, /* 0x5c */ |
||
156 | SPECIAL, /* 0x5d */ |
||
157 | SPECIAL, /* 0x5e */ |
||
158 | SPECIAL, /* 0x5f */ |
||
159 | SPECIAL, /* 0x60 */ |
||
160 | SPECIAL, /* 0x61 */ |
||
161 | SPECIAL, /* 0x62 */ |
||
162 | SPECIAL, /* 0x63 */ |
||
163 | SPECIAL, /* 0x64 */ |
||
164 | SPECIAL, /* 0x65 */ |
||
165 | SPECIAL, /* 0x66 */ |
||
166 | SPECIAL, /* 0x67 */ |
||
167 | SPECIAL, /* 0x68 */ |
||
168 | SPECIAL, /* 0x69 */ |
||
169 | SPECIAL, /* 0x6a */ |
||
170 | SPECIAL, /* 0x6b */ |
||
171 | SPECIAL, /* 0x6c */ |
||
172 | SPECIAL, /* 0x6d */ |
||
173 | SPECIAL, /* 0x6e */ |
||
174 | SPECIAL, /* 0x6f */ |
||
175 | SPECIAL, /* 0x70 */ |
||
176 | SPECIAL, /* 0x71 */ |
||
177 | SPECIAL, /* 0x72 */ |
||
178 | SPECIAL, /* 0x73 */ |
||
179 | SPECIAL, /* 0x74 */ |
||
180 | SPECIAL, /* 0x75 */ |
||
181 | SPECIAL, /* 0x76 */ |
||
182 | SPECIAL, /* 0x77 */ |
||
183 | SPECIAL, /* 0x78 */ |
||
184 | SPECIAL, /* 0x79 */ |
||
185 | SPECIAL, /* 0x7a */ |
||
186 | SPECIAL, /* 0x7b */ |
||
187 | SPECIAL, /* 0x7c */ |
||
188 | SPECIAL, /* 0x7d */ |
||
189 | SPECIAL, /* 0x7e */ |
||
190 | SPECIAL, /* 0x7f */ |
||
191 | }; |
||
192 | |||
193 | /** Secondary meaning of scancodes. */ |
||
194 | static char sc_secondary_map[] = { |
||
195 | SPECIAL, /* 0x00 */ |
||
196 | SPECIAL, /* 0x01 - Esc */ |
||
197 | '!', '@', '#', '$', '%', '^', '&', '*', '(', ')', '_', '+', |
||
198 | SPECIAL, /* 0x0e - Backspace */ |
||
199 | '\t', 'Q', 'W', 'E', 'R', 'T', 'Y', 'U', 'I', 'O', 'P', '{', '}', '\n', |
||
200 | SPECIAL, /* 0x1d - LCtrl */ |
||
201 | 'A', 'S', 'D', 'F', 'G', 'H', 'J', 'K', 'L', ':', '"', |
||
202 | '~', |
||
203 | SPECIAL, /* 0x2a - LShift */ |
||
204 | '|', |
||
205 | 'Z', 'X', 'C', 'V', 'B', 'N', 'M', '<', '>', '?', |
||
206 | SPECIAL, /* 0x36 - RShift */ |
||
207 | '*', |
||
208 | SPECIAL, /* 0x38 - LAlt */ |
||
209 | ' ', |
||
210 | SPECIAL, /* 0x3a - CapsLock */ |
||
211 | SPECIAL, /* 0x3b - F1 */ |
||
212 | SPECIAL, /* 0x3c - F2 */ |
||
213 | SPECIAL, /* 0x3d - F3 */ |
||
214 | SPECIAL, /* 0x3e - F4 */ |
||
215 | SPECIAL, /* 0x3f - F5 */ |
||
216 | SPECIAL, /* 0x40 - F6 */ |
||
217 | SPECIAL, /* 0x41 - F7 */ |
||
218 | SPECIAL, /* 0x42 - F8 */ |
||
219 | SPECIAL, /* 0x43 - F9 */ |
||
220 | SPECIAL, /* 0x44 - F10 */ |
||
221 | SPECIAL, /* 0x45 - NumLock */ |
||
222 | SPECIAL, /* 0x46 - ScrollLock */ |
||
223 | '7', '8', '9', '-', |
||
224 | '4', '5', '6', '+', |
||
225 | '1', '2', '3', |
||
226 | '0', '.', |
||
227 | SPECIAL, /* 0x54 - Alt-SysRq */ |
||
228 | SPECIAL, /* 0x55 - F11/F12/PF1/FN */ |
||
229 | SPECIAL, /* 0x56 - unlabelled key next to LAlt */ |
||
230 | SPECIAL, /* 0x57 - F11 */ |
||
231 | SPECIAL, /* 0x58 - F12 */ |
||
232 | SPECIAL, /* 0x59 */ |
||
233 | SPECIAL, /* 0x5a */ |
||
234 | SPECIAL, /* 0x5b */ |
||
235 | SPECIAL, /* 0x5c */ |
||
236 | SPECIAL, /* 0x5d */ |
||
237 | SPECIAL, /* 0x5e */ |
||
238 | SPECIAL, /* 0x5f */ |
||
239 | SPECIAL, /* 0x60 */ |
||
240 | SPECIAL, /* 0x61 */ |
||
241 | SPECIAL, /* 0x62 */ |
||
242 | SPECIAL, /* 0x63 */ |
||
243 | SPECIAL, /* 0x64 */ |
||
244 | SPECIAL, /* 0x65 */ |
||
245 | SPECIAL, /* 0x66 */ |
||
246 | SPECIAL, /* 0x67 */ |
||
247 | SPECIAL, /* 0x68 */ |
||
248 | SPECIAL, /* 0x69 */ |
||
249 | SPECIAL, /* 0x6a */ |
||
250 | SPECIAL, /* 0x6b */ |
||
251 | SPECIAL, /* 0x6c */ |
||
252 | SPECIAL, /* 0x6d */ |
||
253 | SPECIAL, /* 0x6e */ |
||
254 | SPECIAL, /* 0x6f */ |
||
255 | SPECIAL, /* 0x70 */ |
||
256 | SPECIAL, /* 0x71 */ |
||
257 | SPECIAL, /* 0x72 */ |
||
258 | SPECIAL, /* 0x73 */ |
||
259 | SPECIAL, /* 0x74 */ |
||
260 | SPECIAL, /* 0x75 */ |
||
261 | SPECIAL, /* 0x76 */ |
||
262 | SPECIAL, /* 0x77 */ |
||
263 | SPECIAL, /* 0x78 */ |
||
264 | SPECIAL, /* 0x79 */ |
||
265 | SPECIAL, /* 0x7a */ |
||
266 | SPECIAL, /* 0x7b */ |
||
267 | SPECIAL, /* 0x7c */ |
||
268 | SPECIAL, /* 0x7d */ |
||
269 | SPECIAL, /* 0x7e */ |
||
270 | SPECIAL, /* 0x7f */ |
||
271 | }; |
||
272 | |||
958 | jermar | 273 | static void i8042_interrupt(int n, istate_t *istate); |
895 | jermar | 274 | static void i8042_wait(void); |
576 | palkovsky | 275 | |
1474 | palkovsky | 276 | static iroutine oldvector; |
277 | /** Initialize keyboard and service interrupts using kernel routine */ |
||
278 | void i8042_grab(void) |
||
1 | jermar | 279 | { |
1474 | palkovsky | 280 | oldvector = exc_register(VECTOR_KBD, "i8042_interrupt", (iroutine) i8042_interrupt); |
895 | jermar | 281 | i8042_wait(); |
894 | jermar | 282 | i8042_command_write(i8042_SET_COMMAND); |
895 | jermar | 283 | i8042_wait(); |
894 | jermar | 284 | i8042_data_write(i8042_COMMAND); |
895 | jermar | 285 | i8042_wait(); |
1474 | palkovsky | 286 | } |
287 | /** Resume the former interrupt vector */ |
||
288 | void i8042_release(void) |
||
289 | { |
||
290 | if (oldvector) |
||
291 | exc_register(VECTOR_KBD, "user_interrupt", oldvector); |
||
292 | } |
||
670 | vana | 293 | |
1474 | palkovsky | 294 | /** Initialize i8042. */ |
295 | void i8042_init(void) |
||
296 | { |
||
297 | int i; |
||
298 | |||
299 | i8042_grab(); |
||
300 | /* Prevent user from accidentaly releasing calling i8042_resume |
||
301 | * and disabling keyboard |
||
302 | */ |
||
303 | oldvector = NULL; |
||
304 | |||
512 | jermar | 305 | trap_virtual_enable_irqs(1<<IRQ_KBD); |
575 | palkovsky | 306 | chardev_initialize("i8042_kbd", &kbrd, &ops); |
511 | jermar | 307 | stdin = &kbrd; |
1195 | jermar | 308 | |
1194 | vana | 309 | /* |
1195 | jermar | 310 | * Clear input buffer. |
311 | * Number of iterations is limited to prevent infinite looping. |
||
312 | */ |
||
313 | for (i = 0; (i8042_status_read() & i8042_BUFFER_FULL_MASK) && i < 100; i++) { |
||
1194 | vana | 314 | i8042_data_read(); |
1195 | jermar | 315 | } |
1 | jermar | 316 | } |
317 | |||
508 | jermar | 318 | /** Process i8042 interrupt. |
319 | * |
||
320 | * @param n Interrupt vector. |
||
1708 | jermar | 321 | * @param istate Interrupted state. |
508 | jermar | 322 | */ |
958 | jermar | 323 | void i8042_interrupt(int n, istate_t *istate) |
1 | jermar | 324 | { |
1780 | jermar | 325 | uint8_t x; |
326 | uint8_t status; |
||
1 | jermar | 327 | |
1759 | palkovsky | 328 | while (((status=i8042_status_read()) & i8042_BUFFER_FULL_MASK)) { |
1753 | palkovsky | 329 | x = i8042_data_read(); |
1759 | palkovsky | 330 | |
331 | if ((status & i8042_MOUSE_DATA)) |
||
332 | continue; |
||
333 | |||
1753 | palkovsky | 334 | if (x & KEY_RELEASE) |
335 | key_released(x ^ KEY_RELEASE); |
||
336 | else |
||
337 | key_pressed(x); |
||
338 | } |
||
1 | jermar | 339 | trap_virtual_eoi(); |
340 | } |
||
508 | jermar | 341 | |
895 | jermar | 342 | /** Wait until the controller reads its data. */ |
343 | void i8042_wait(void) { |
||
344 | while (i8042_status_read() & i8042_WAIT_MASK) { |
||
345 | /* wait */ |
||
346 | } |
||
347 | } |
||
348 | |||
508 | jermar | 349 | /** Process release of key. |
350 | * |
||
351 | * @param sc Scancode of the key being released. |
||
352 | */ |
||
1780 | jermar | 353 | void key_released(uint8_t sc) |
508 | jermar | 354 | { |
355 | spinlock_lock(&keylock); |
||
356 | switch (sc) { |
||
357 | case SC_LSHIFT: |
||
358 | case SC_RSHIFT: |
||
359 | keyflags &= ~PRESSED_SHIFT; |
||
360 | break; |
||
361 | case SC_CAPSLOCK: |
||
362 | keyflags &= ~PRESSED_CAPSLOCK; |
||
363 | if (lockflags & LOCKED_CAPSLOCK) |
||
364 | lockflags &= ~LOCKED_CAPSLOCK; |
||
365 | else |
||
366 | lockflags |= LOCKED_CAPSLOCK; |
||
367 | break; |
||
368 | default: |
||
369 | break; |
||
370 | } |
||
371 | spinlock_unlock(&keylock); |
||
372 | } |
||
373 | |||
374 | /** Process keypress. |
||
375 | * |
||
376 | * @param sc Scancode of the key being pressed. |
||
377 | */ |
||
1780 | jermar | 378 | void key_pressed(uint8_t sc) |
508 | jermar | 379 | { |
380 | char *map = sc_primary_map; |
||
381 | char ascii = sc_primary_map[sc]; |
||
382 | bool shift, capslock; |
||
383 | bool letter = false; |
||
384 | |||
385 | spinlock_lock(&keylock); |
||
386 | switch (sc) { |
||
601 | palkovsky | 387 | case SC_LSHIFT: |
388 | case SC_RSHIFT: |
||
508 | jermar | 389 | keyflags |= PRESSED_SHIFT; |
390 | break; |
||
601 | palkovsky | 391 | case SC_CAPSLOCK: |
508 | jermar | 392 | keyflags |= PRESSED_CAPSLOCK; |
393 | break; |
||
601 | palkovsky | 394 | case SC_SPEC_ESCAPE: |
395 | break; |
||
396 | case SC_LEFTARR: |
||
397 | chardev_push_character(&kbrd, 0x1b); |
||
398 | chardev_push_character(&kbrd, 0x5b); |
||
399 | chardev_push_character(&kbrd, 0x44); |
||
400 | break; |
||
401 | case SC_RIGHTARR: |
||
402 | chardev_push_character(&kbrd, 0x1b); |
||
403 | chardev_push_character(&kbrd, 0x5b); |
||
404 | chardev_push_character(&kbrd, 0x43); |
||
405 | break; |
||
406 | case SC_UPARR: |
||
407 | chardev_push_character(&kbrd, 0x1b); |
||
408 | chardev_push_character(&kbrd, 0x5b); |
||
409 | chardev_push_character(&kbrd, 0x41); |
||
410 | break; |
||
411 | case SC_DOWNARR: |
||
412 | chardev_push_character(&kbrd, 0x1b); |
||
413 | chardev_push_character(&kbrd, 0x5b); |
||
414 | chardev_push_character(&kbrd, 0x42); |
||
415 | break; |
||
606 | palkovsky | 416 | case SC_HOME: |
417 | chardev_push_character(&kbrd, 0x1b); |
||
418 | chardev_push_character(&kbrd, 0x4f); |
||
419 | chardev_push_character(&kbrd, 0x48); |
||
420 | break; |
||
421 | case SC_END: |
||
422 | chardev_push_character(&kbrd, 0x1b); |
||
423 | chardev_push_character(&kbrd, 0x4f); |
||
424 | chardev_push_character(&kbrd, 0x46); |
||
425 | break; |
||
426 | case SC_DELETE: |
||
427 | chardev_push_character(&kbrd, 0x1b); |
||
428 | chardev_push_character(&kbrd, 0x5b); |
||
429 | chardev_push_character(&kbrd, 0x33); |
||
430 | chardev_push_character(&kbrd, 0x7e); |
||
431 | break; |
||
601 | palkovsky | 432 | default: |
517 | jermar | 433 | letter = is_lower(ascii); |
508 | jermar | 434 | capslock = (keyflags & PRESSED_CAPSLOCK) || (lockflags & LOCKED_CAPSLOCK); |
435 | shift = keyflags & PRESSED_SHIFT; |
||
436 | if (letter && capslock) |
||
437 | shift = !shift; |
||
438 | if (shift) |
||
439 | map = sc_secondary_map; |
||
511 | jermar | 440 | chardev_push_character(&kbrd, map[sc]); |
508 | jermar | 441 | break; |
442 | } |
||
443 | spinlock_unlock(&keylock); |
||
444 | } |
||
511 | jermar | 445 | |
446 | /* Called from getc(). */ |
||
575 | palkovsky | 447 | void i8042_resume(chardev_t *d) |
511 | jermar | 448 | { |
449 | } |
||
450 | |||
451 | /* Called from getc(). */ |
||
575 | palkovsky | 452 | void i8042_suspend(chardev_t *d) |
511 | jermar | 453 | { |
454 | } |
||
878 | vana | 455 | |
1780 | jermar | 456 | static uint8_t active_read_buff_read(void) |
878 | vana | 457 | { |
458 | static int i=0; |
||
894 | jermar | 459 | i &= (ACTIVE_READ_BUFF_SIZE-1); |
460 | if(!active_read_buff[i]) { |
||
878 | vana | 461 | return 0; |
462 | } |
||
463 | return active_read_buff[i++]; |
||
464 | } |
||
465 | |||
1780 | jermar | 466 | static void active_read_buff_write(uint8_t ch) |
878 | vana | 467 | { |
468 | static int i=0; |
||
894 | jermar | 469 | active_read_buff[i] = ch; |
878 | vana | 470 | i++; |
894 | jermar | 471 | i &= (ACTIVE_READ_BUFF_SIZE-1); |
878 | vana | 472 | active_read_buff[i]=0; |
473 | } |
||
474 | |||
475 | |||
1780 | jermar | 476 | static void active_read_key_pressed(uint8_t sc) |
878 | vana | 477 | { |
478 | char *map = sc_primary_map; |
||
479 | char ascii = sc_primary_map[sc]; |
||
480 | bool shift, capslock; |
||
481 | bool letter = false; |
||
482 | |||
483 | /*spinlock_lock(&keylock);*/ |
||
484 | switch (sc) { |
||
485 | case SC_LSHIFT: |
||
486 | case SC_RSHIFT: |
||
487 | keyflags |= PRESSED_SHIFT; |
||
488 | break; |
||
489 | case SC_CAPSLOCK: |
||
490 | keyflags |= PRESSED_CAPSLOCK; |
||
491 | break; |
||
492 | case SC_SPEC_ESCAPE: |
||
493 | break; |
||
494 | case SC_LEFTARR: |
||
495 | active_read_buff_write(0x1b); |
||
496 | active_read_buff_write(0x5b); |
||
497 | active_read_buff_write(0x44); |
||
498 | break; |
||
499 | case SC_RIGHTARR: |
||
500 | active_read_buff_write(0x1b); |
||
501 | active_read_buff_write(0x5b); |
||
502 | active_read_buff_write(0x43); |
||
503 | break; |
||
504 | case SC_UPARR: |
||
505 | active_read_buff_write(0x1b); |
||
506 | active_read_buff_write(0x5b); |
||
507 | active_read_buff_write(0x41); |
||
508 | break; |
||
509 | case SC_DOWNARR: |
||
510 | active_read_buff_write(0x1b); |
||
511 | active_read_buff_write(0x5b); |
||
512 | active_read_buff_write(0x42); |
||
513 | break; |
||
514 | case SC_HOME: |
||
515 | active_read_buff_write(0x1b); |
||
516 | active_read_buff_write(0x4f); |
||
517 | active_read_buff_write(0x48); |
||
518 | break; |
||
519 | case SC_END: |
||
520 | active_read_buff_write(0x1b); |
||
521 | active_read_buff_write(0x4f); |
||
522 | active_read_buff_write(0x46); |
||
523 | break; |
||
524 | case SC_DELETE: |
||
525 | active_read_buff_write(0x1b); |
||
526 | active_read_buff_write(0x5b); |
||
527 | active_read_buff_write(0x33); |
||
528 | active_read_buff_write(0x7e); |
||
529 | break; |
||
530 | default: |
||
531 | letter = is_lower(ascii); |
||
532 | capslock = (keyflags & PRESSED_CAPSLOCK) || (lockflags & LOCKED_CAPSLOCK); |
||
533 | shift = keyflags & PRESSED_SHIFT; |
||
534 | if (letter && capslock) |
||
535 | shift = !shift; |
||
536 | if (shift) |
||
537 | map = sc_secondary_map; |
||
538 | active_read_buff_write(map[sc]); |
||
539 | break; |
||
540 | } |
||
541 | /*spinlock_unlock(&keylock);*/ |
||
542 | |||
543 | } |
||
544 | |||
545 | static char key_read(chardev_t *d) |
||
546 | { |
||
547 | char ch; |
||
548 | |||
894 | jermar | 549 | while(!(ch = active_read_buff_read())) { |
1780 | jermar | 550 | uint8_t x; |
1753 | palkovsky | 551 | while (!(i8042_status_read() & i8042_BUFFER_FULL_MASK)) |
894 | jermar | 552 | ; |
553 | x = i8042_data_read(); |
||
895 | jermar | 554 | if (x != IGNORE_CODE) { |
555 | if (x & KEY_RELEASE) |
||
556 | key_released(x ^ KEY_RELEASE); |
||
557 | else |
||
558 | active_read_key_pressed(x); |
||
559 | } |
||
878 | vana | 560 | } |
561 | return ch; |
||
562 | } |
||
895 | jermar | 563 | |
564 | /** Poll for key press and release events. |
||
565 | * |
||
566 | * This function can be used to implement keyboard polling. |
||
567 | */ |
||
568 | void i8042_poll(void) |
||
569 | { |
||
1780 | jermar | 570 | uint8_t x; |
895 | jermar | 571 | |
572 | while (((x = i8042_status_read() & i8042_BUFFER_FULL_MASK))) { |
||
573 | x = i8042_data_read(); |
||
574 | if (x != IGNORE_CODE) { |
||
575 | if (x & KEY_RELEASE) |
||
576 | key_released(x ^ KEY_RELEASE); |
||
577 | else |
||
578 | key_pressed(x); |
||
579 | } |
||
580 | } |
||
581 | } |
||
1702 | cejka | 582 | |
1754 | jermar | 583 | /** @} |
1702 | cejka | 584 | */ |
585 |