2 Copyright 2011 Jun Wako <wakojun@gmail.com>
4 This program is free software: you can redistribute it and/or modify
5 it under the terms of the GNU General Public License as published by
6 the Free Software Foundation, either version 2 of the License, or
7 (at your option) any later version.
9 This program is distributed in the hope that it will be useful,
10 but WITHOUT ANY WARRANTY; without even the implied warranty of
11 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 GNU General Public License for more details.
14 You should have received a copy of the GNU General Public License
15 along with this program. If not, see <http://www.gnu.org/licenses/>.
28 static void matrix_make(uint8_t code);
29 static void matrix_break(uint8_t code);
30 static void matrix_clear(void);
31 #ifdef MATRIX_HAS_GHOST
32 static bool matrix_has_ghost_in_row(uint8_t row);
38 * 'Scan Code Set 2' is assigned into 256(32x8)cell matrix.
39 * Hmm, it is very sparse and not efficient :(
42 * Both 'Hanguel/English'(F1) and 'Hanja'(F2) collide with 'Delete'(E0 71) and 'Down'(E0 72).
43 * These two Korean keys need exceptional handling and are not supported for now. Sorry.
48 * :| XX | 00-7F for normal codes(without E0-prefix)
51 * :| E0 YY | 80-FF for E0-prefixed codes
52 * 1f| | (<YY>|0x80) is used as matrix position.
56 * 0x83: F7(0x83) This is a normal code but beyond 0x7F.
60 static uint8_t matrix[MATRIX_ROWS];
61 #define ROW(code) (code>>3)
62 #define COL(code) (code&0x07)
64 // matrix positions for exceptional keys
66 #define PRINT_SCREEN (0xFC)
69 static bool is_modified = false;
73 uint8_t matrix_rows(void)
79 uint8_t matrix_cols(void)
84 void matrix_init(void)
89 // initialize matrix state: all keys off
90 for (uint8_t i=0; i < MATRIX_ROWS; i++) matrix[i] = 0x00;
96 * PS/2 Scan Code Set 2: Exceptional Handling
98 * There are several keys to be handled exceptionally.
99 * The scan code for these keys are varied or prefix/postfix'd
100 * depending on modifier key state.
102 * Keyboard Scan Code Specification:
103 * http://www.microsoft.com/whdc/archive/scancode.mspx
104 * http://download.microsoft.com/download/1/6/1/161ba512-40e2-4cc9-843a-923143f3456c/scancode.doc
107 * 1) Insert, Delete, Home, End, PageUp, PageDown, Up, Down, Right, Left
108 * a) when Num Lock is off
109 * modifiers | make | break
110 * ----------+---------------------------+----------------------
111 * Ohter | <make> | <break>
112 * LShift | E0 F0 12 <make> | <break> E0 12
113 * RShift | E0 F0 59 <make> | <break> E0 59
114 * L+RShift | E0 F0 12 E0 F0 59 <make> | <break> E0 59 E0 12
116 * b) when Num Lock is on
117 * modifiers | make | break
118 * ----------+---------------------------+----------------------
119 * Other | E0 12 <make> | <break> E0 F0 12
120 * Shift'd | <make> | <break>
122 * Handling: These prefix/postfix codes are ignored.
126 * modifiers | make | break
127 * ----------+---------------------------+----------------------
128 * Ohter | <make> | <break>
129 * LShift | E0 F0 12 <make> | <break> E0 12
130 * RShift | E0 F0 59 <make> | <break> E0 59
131 * L+RShift | E0 F0 12 E0 F0 59 <make> | <break> E0 59 E0 12
133 * Handling: These prefix/postfix codes are ignored.
137 * modifiers | make | break
138 * ----------+--------------+-----------------------------------
139 * Other | E0 12 E0 7C | E0 F0 7C E0 F0 12
140 * Shift'd | E0 7C | E0 F0 7C
141 * Control'd | E0 7C | E0 F0 7C
144 * Handling: These prefix/postfix codes are ignored, and both scan codes
145 * 'E0 7C' and 84 are seen as PrintScreen.
148 * modifiers | make(no break code)
149 * ----------+--------------------------------------------------
150 * Other | E1 14 77 E1 F0 14 F0 77
151 * Control'd | E0 7E E0 F0 7E
153 * Handling: Both code sequences are treated as a whole.
154 * And we need a ad hoc 'pseudo break code' hack to get the key off
155 * because it has no break code.
158 uint8_t matrix_scan(void)
161 // scan code reading states
174 E1_14_77_E1_F0_14_F0,
184 // 'pseudo break code' hack
185 if (matrix_is_on(ROW(PAUSE), COL(PAUSE))) {
189 uint8_t code = ps2_host_recv();
190 if (code) xprintf("%i\r\n", code);
208 case 0x84: // Alt'd PrintScreen
209 matrix_make(PRINT_SCREEN);
212 case 0x00: // Overrun [3]p.25
218 default: // normal key make
224 xprintf("unexpected scan code at INIT: %02X\n", code);
229 case E0: // E0-Prefixed
231 case 0x12: // to be ignored
232 case 0x59: // to be ignored
235 case 0x7E: // Control'd Pause
243 matrix_make(code|0x80);
247 xprintf("unexpected scan code at E0: %02X\n", code);
252 case F0: // Break code
258 case 0x84: // Alt'd PrintScreen
259 matrix_break(PRINT_SCREEN);
265 xprintf("unexpected scan code at F0: F0(clear and cont.)\n");
273 xprintf("unexpected scan code at F0: %02X\n", code);
278 case E0_F0: // Break code of E0-prefixed
280 case 0x12: // to be ignored
281 case 0x59: // to be ignored
286 matrix_break(code|0x80);
290 xprintf("unexpected scan code at E0_F0: %02X\n", code);
295 // following are states of Pause
326 state = E1_14_77_E1_F0;
335 state = E1_14_77_E1_F0_14;
341 case E1_14_77_E1_F0_14:
344 state = E1_14_77_E1_F0_14_F0;
350 case E1_14_77_E1_F0_14_F0:
360 // Following are states of Control'd Pause
383 // TODO: request RESEND when error occurs?
385 if (PS2_IS_FAILED(ps2_error)) {
386 uint8_t ret = ps2_host_send(PS2_RESEND);
387 xprintf("Resend: %02X\n", ret);
393 bool matrix_is_modified(void)
399 bool matrix_has_ghost(void)
401 #ifdef MATRIX_HAS_GHOST
402 for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
403 if (matrix_has_ghost_in_row(i))
411 bool matrix_is_on(uint8_t row, uint8_t col)
413 return (matrix[row] & (1<<col));
417 uint8_t matrix_get_row(uint8_t row)
422 void matrix_print(void)
424 print("\nr/c 01234567\n");
425 for (uint8_t row = 0; row < matrix_rows(); row++) {
426 phex(row); print(": ");
427 pbin_reverse(matrix_get_row(row));
428 #ifdef MATRIX_HAS_GHOST
429 if (matrix_has_ghost_in_row(row)) {
437 uint8_t matrix_key_count(void)
440 for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
441 count += bitpop(matrix[i]);
446 #ifdef MATRIX_HAS_GHOST
448 static bool matrix_has_ghost_in_row(uint8_t row)
450 // no ghost exists in case less than 2 keys on
451 if (((matrix[row] - 1) & matrix[row]) == 0)
454 // ghost exists in case same state as other row
455 for (uint8_t i=0; i < MATRIX_ROWS; i++) {
456 if (i != row && (matrix[i] & matrix[row]) == matrix[row])
465 static void matrix_make(uint8_t code)
467 if (!matrix_is_on(ROW(code), COL(code))) {
468 matrix[ROW(code)] |= 1<<COL(code);
474 static void matrix_break(uint8_t code)
476 if (matrix_is_on(ROW(code), COL(code))) {
477 matrix[ROW(code)] &= ~(1<<COL(code));
483 static void matrix_clear(void)
485 for (uint8_t i=0; i < MATRIX_ROWS; i++) matrix[i] = 0x00;