f25452d596c0c47e32d6e705b1a4920aae8efe2c
[tmk_keyboard.git] / converter / ibm4704_usb / matrix.c
1 /*
2 Copyright 2014 Jun Wako <wakojun@gmail.com>
3
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.
8
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.
13
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/>.
16 */
17
18 #include <stdint.h>
19 #include <stdbool.h>
20 #include <avr/io.h>
21 #include <util/delay.h>
22 #include "action.h"
23 #include "print.h"
24 #include "debug.h"
25 #include "util.h"
26 #include "ibm4704.h"
27 #include "matrix.h"
28
29
30 static void matrix_make(uint8_t code);
31 static void matrix_break(uint8_t code);
32 static void matrix_clear(void);
33
34
35 /*
36 * Matrix Array usage:
37 * IBM 4704 scan codes are assigned into 128(16x8)-cell matrix.
38 *
39 * 8bit wide
40 * +---------+
41 * 0| |
42 * :| XX | 00-7F
43 * f| |
44 * +---------+
45 *
46 * Exceptions:
47 */
48 static uint8_t matrix[MATRIX_ROWS];
49
50 // scan code bits 7654 3210
51 // R:row/C:column -RRR RCCC
52 #define ROW(code) ((code>>3)&0x0f)
53 #define COL(code) (code&0x07)
54
55
56 inline
57 uint8_t matrix_rows(void)
58 {
59 return MATRIX_ROWS;
60 }
61
62 inline
63 uint8_t matrix_cols(void)
64 {
65 return MATRIX_COLS;
66 }
67
68 static void enable_break(void)
69 {
70 print("Enable break: ");
71 while (ibm4704_send(0xFC)) { _delay_ms(10); }
72 // valid scancode: 00-79h
73 for (uint8_t code = 0; code < 0x7F; code++) {
74 while (ibm4704_send(0x80|code)) _delay_ms(10);
75 _delay_ms(5); // wait for response
76 // No response(FF) when ok, FD when out of bound
77 xprintf("s%02X:r%02X ", code, ibm4704_recv());
78 }
79 while (ibm4704_send(0xFF)) { _delay_ms(10); } // End
80 print("End\n");
81 }
82
83
84 void matrix_setup(void)
85 {
86 ibm4704_init();
87 }
88
89 void matrix_init(void)
90 {
91 debug_enable = true;
92
93 print("IBM 4704 converter\n");
94 matrix_clear();
95 _delay_ms(2000); // wait for keyboard starting up
96 xprintf("Keyboard ID: %02X\n", ibm4704_recv());
97 enable_break();
98 }
99
100 /*
101 * IBM 4704 Scan Code
102 */
103 uint8_t matrix_scan(void)
104 {
105 uint8_t code = ibm4704_recv();
106 if (code==0xFF) {
107 // Not receivd
108 return 0;
109 } else if ((code&0x7F) >= 0x7C) {
110 // 0xFF-FC and 0x7F-7C is not scancode
111 xprintf("Error: %02X\n", code);
112 matrix_clear();
113 return 0;
114 } else if (code&0x80) {
115 dprintf("%02X\n", code);
116 matrix_make(code);
117 } else {
118 dprintf("%02X\n", code);
119 matrix_break(code);
120 }
121 return 1;
122 }
123
124 inline
125 bool matrix_is_on(uint8_t row, uint8_t col)
126 {
127 return (matrix[row] & (1<<col));
128 }
129
130 inline
131 uint8_t matrix_get_row(uint8_t row)
132 {
133 return matrix[row];
134 }
135
136 void matrix_print(void)
137 {
138 print("\nr/c 01234567\n");
139 for (uint8_t row = 0; row < matrix_rows(); row++) {
140 xprintf("%02X: %08b\n", row, bitrev(matrix_get_row(row)));
141 }
142 }
143
144
145
146 inline
147 static void matrix_make(uint8_t code)
148 {
149 matrix[ROW(code)] |= 1<<COL(code);
150 }
151
152 inline
153 static void matrix_break(uint8_t code)
154 {
155 matrix[ROW(code)] &= ~(1<<COL(code));
156 }
157
158 inline
159 static void matrix_clear(void)
160 {
161 for (uint8_t i=0; i < MATRIX_ROWS; i++) matrix[i] = 0x00;
162 }
Imprint / Impressum