2 Copyright 2012 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/>.
24 // provides memcpy for copying TWI slave buffer
25 // #include <string.h>
29 #include <avr/interrupt.h>
30 #include <util/delay.h>
35 #include "split_util.h"
36 #include "pro_micro.h"
49 #define ERROR_DISCONNECT_COUNT 5
51 static uint8_t debouncing = DEBOUNCE;
52 static const int ROWS_PER_HAND = MATRIX_ROWS/2;
53 static uint8_t error_count = 0;
55 static const uint8_t row_pins[MATRIX_ROWS] = MATRIX_ROW_PINS;
56 static const uint8_t col_pins[MATRIX_COLS] = MATRIX_COL_PINS;
58 /* matrix state(1:on, 0:off) */
59 static matrix_row_t matrix[MATRIX_ROWS];
60 static matrix_row_t matrix_debouncing[MATRIX_ROWS];
62 static matrix_row_t read_cols(void);
63 static void init_cols(void);
64 static void unselect_rows(void);
65 static void select_row(uint8_t row);
67 __attribute__ ((weak))
68 void matrix_init_quantum(void) {
72 __attribute__ ((weak))
73 void matrix_scan_quantum(void) {
77 __attribute__ ((weak))
78 void matrix_init_kb(void) {
82 __attribute__ ((weak))
83 void matrix_scan_kb(void) {
87 __attribute__ ((weak))
88 void matrix_init_user(void) {
91 __attribute__ ((weak))
92 void matrix_scan_user(void) {
96 uint8_t matrix_rows(void)
102 uint8_t matrix_cols(void)
107 void matrix_init(void)
112 // initialize row and col
118 // initialize matrix state: all keys off
119 for (uint8_t i=0; i < MATRIX_ROWS; i++) {
121 matrix_debouncing[i] = 0;
124 matrix_init_quantum();
127 uint8_t _matrix_scan(void)
129 // Right hand is stored after the left in the matrix so, we need to offset it
130 int offset = isLeftHand ? 0 : (ROWS_PER_HAND);
132 for (uint8_t i = 0; i < ROWS_PER_HAND; i++) {
134 _delay_us(30); // without this wait read unstable value.
135 matrix_row_t cols = read_cols();
136 if (matrix_debouncing[i+offset] != cols) {
137 matrix_debouncing[i+offset] = cols;
138 debouncing = DEBOUNCE;
147 for (uint8_t i = 0; i < ROWS_PER_HAND; i++) {
148 matrix[i+offset] = matrix_debouncing[i+offset];
158 // Get rows from other half over i2c
159 int i2c_transaction(void) {
160 int slaveOffset = (isLeftHand) ? (ROWS_PER_HAND) : 0;
162 int err = i2c_master_start(SLAVE_I2C_ADDRESS + I2C_WRITE);
163 if (err) goto i2c_error;
165 // start of matrix stored at 0x00
166 err = i2c_master_write(0x00);
167 if (err) goto i2c_error;
170 err = i2c_master_start(SLAVE_I2C_ADDRESS + I2C_READ);
171 if (err) goto i2c_error;
175 // read from TWI byte-by-byte into matrix_row_t memory space
177 for (i = 0; i < SLAVE_BUFFER_SIZE-1; ++i) {
178 *((uint8_t*)&matrix[slaveOffset]+i) = i2c_master_read(I2C_ACK);
180 // last byte to be read / end of chunk
181 *((uint8_t*)&matrix[slaveOffset]+i) = i2c_master_read(I2C_NACK);
184 // kludge for column #9: unpack bits for keys (2,9) and (3,9) from (1,7) and (1,8)
185 // i2c_master_read(I2C_ACK);
186 matrix[slaveOffset+0] = i2c_master_read(I2C_ACK);
187 // i2c_master_read(I2C_ACK);
188 matrix[slaveOffset+1] = (matrix_row_t)i2c_master_read(I2C_ACK)\
189 | (matrix[slaveOffset+0]&0x40U)<<2;
190 // i2c_master_read(I2C_ACK);
191 matrix[slaveOffset+2] = (matrix_row_t)i2c_master_read(I2C_NACK)\
192 | (matrix[slaveOffset+0]&0x80U)<<1;
193 // clear highest two bits on row 1, where the col9 bits were transported
194 matrix[slaveOffset+0] &= 0x3F;
198 i2c_error: // the cable is disconnected, or something else went wrong
208 int serial_transaction(void) {
209 int slaveOffset = (isLeftHand) ? (ROWS_PER_HAND) : 0;
211 if (serial_update_buffers()) {
215 for (int i = 0; i < ROWS_PER_HAND; ++i) {
216 matrix[slaveOffset+i] = serial_slave_buffer[i];
222 uint8_t matrix_scan(void)
224 int ret = _matrix_scan();
229 if( i2c_transaction() ) {
231 if( serial_transaction() ) {
233 // turn on the indicator led when halves are disconnected
238 if (error_count > ERROR_DISCONNECT_COUNT) {
239 // reset other half if disconnected
240 int slaveOffset = (isLeftHand) ? (ROWS_PER_HAND) : 0;
241 for (int i = 0; i < ROWS_PER_HAND; ++i) {
242 matrix[slaveOffset+i] = 0;
246 // turn off the indicator led on no error
250 matrix_scan_quantum();
254 void matrix_slave_scan(void) {
257 int offset = (isLeftHand) ? 0 : ROWS_PER_HAND;
260 // SLAVE_BUFFER_SIZE is from i2c.h
261 // (MATRIX_ROWS/2*sizeof(matrix_row_t))
262 // memcpy((void*)i2c_slave_buffer, (const void*)&matrix[offset], (ROWS_PER_HAND*sizeof(matrix_row_t)));
264 // kludge for column #9: put bits for keys (2,9) and (3,9) into (1,7) and (1,8)
265 i2c_slave_buffer[0] = (uint8_t)(matrix[offset+0])\
266 | (matrix[offset+1]&0x100U)>>2\
267 | (matrix[offset+2]&0x100U)>>1;
268 i2c_slave_buffer[1] = (uint8_t)(matrix[offset+1]);
269 i2c_slave_buffer[2] = (uint8_t)(matrix[offset+2]);
270 // note: looks like a possible operator-precedence bug here, in last version?
272 i2c_slave_buffer[1] = (uint8_t)matrix[offset+0];
273 i2c_slave_buffer[2] = (uint8_t)(matrix[offset+1]>>8);
274 i2c_slave_buffer[3] = (uint8_t)(matrix[offset+1]>>8);
275 i2c_slave_buffer[4] = (uint8_t)(matrix[offset+2]>>8);
276 i2c_slave_buffer[5] = (uint8_t)matrix[offset+2];
279 for (int i = 0; i < ROWS_PER_HAND; ++i) {
280 serial_slave_buffer[i] = matrix[offset+i];
285 bool matrix_is_modified(void)
287 if (debouncing) return false;
292 bool matrix_is_on(uint8_t row, uint8_t col)
294 return (matrix[row] & ((matrix_row_t)1<<col));
298 matrix_row_t matrix_get_row(uint8_t row)
303 void matrix_print(void)
305 print("\nr/c 0123456789ABCDEF\n");
306 for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
307 phex(row); print(": ");
308 pbin_reverse16(matrix_get_row(row));
313 uint8_t matrix_key_count(void)
316 for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
317 count += bitpop16(matrix[i]);
322 static void init_cols(void)
324 for(int x = 0; x < MATRIX_COLS; x++) {
325 _SFR_IO8((col_pins[x] >> 4) + 1) &= ~_BV(col_pins[x] & 0xF);
326 _SFR_IO8((col_pins[x] >> 4) + 2) |= _BV(col_pins[x] & 0xF);
330 static matrix_row_t read_cols(void)
332 matrix_row_t result = 0;
333 for(int x = 0; x < MATRIX_COLS; x++) {
334 result |= (_SFR_IO8(col_pins[x] >> 4) & _BV(col_pins[x] & 0xF)) ? 0 : (1 << x);
339 static void unselect_rows(void)
341 for(int x = 0; x < ROWS_PER_HAND; x++) {
342 _SFR_IO8((row_pins[x] >> 4) + 1) &= ~_BV(row_pins[x] & 0xF);
343 _SFR_IO8((row_pins[x] >> 4) + 2) |= _BV(row_pins[x] & 0xF);
347 static void select_row(uint8_t row)
349 _SFR_IO8((row_pins[row] >> 4) + 1) |= _BV(row_pins[row] & 0xF);
350 _SFR_IO8((row_pins[row] >> 4) + 2) &= ~_BV(row_pins[row] & 0xF);