Subversion Repositories HelenOS

Rev

Rev 1787 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

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