2 Copyright 2017 Danny Nguyen <danny@keeb.io>
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/>.
29 #include "split_util.h"
30 #include "pro_micro.h"
34 #ifdef BACKLIGHT_ENABLE
35 #include "backlight.h"
36 extern backlight_config_t backlight_config;
46 static uint16_t debouncing_time;
47 static bool debouncing = false;
50 #if (MATRIX_COLS <= 8)
51 # define print_matrix_header() print("\nr/c 01234567\n")
52 # define print_matrix_row(row) print_bin_reverse8(matrix_get_row(row))
53 # define matrix_bitpop(i) bitpop(matrix[i])
54 # define ROW_SHIFTER ((uint8_t)1)
56 # error "Currently only supports 8 COLS"
58 static matrix_row_t matrix_debouncing[MATRIX_ROWS];
60 #define ERROR_DISCONNECT_COUNT 5
62 #define SERIAL_LED_ADDR 0x00
64 #define ROWS_PER_HAND (MATRIX_ROWS/2)
66 static uint8_t error_count = 0;
68 static const uint8_t row_pins[MATRIX_ROWS] = MATRIX_ROW_PINS;
69 static const uint8_t col_pins[MATRIX_COLS] = MATRIX_COL_PINS;
71 /* matrix state(1:on, 0:off) */
72 static matrix_row_t matrix[MATRIX_ROWS];
73 static matrix_row_t matrix_debouncing[MATRIX_ROWS];
75 #if (DIODE_DIRECTION == COL2ROW)
76 static void init_cols(void);
77 static bool read_cols_on_row(matrix_row_t current_matrix[], uint8_t current_row);
78 static void unselect_rows(void);
79 static void select_row(uint8_t row);
80 static void unselect_row(uint8_t row);
81 #elif (DIODE_DIRECTION == ROW2COL)
82 static void init_rows(void);
83 static bool read_rows_on_col(matrix_row_t current_matrix[], uint8_t current_col);
84 static void unselect_cols(void);
85 static void unselect_col(uint8_t col);
86 static void select_col(uint8_t col);
90 __attribute__ ((weak))
91 void matrix_init_kb(void) {
95 __attribute__ ((weak))
96 void matrix_scan_kb(void) {
100 __attribute__ ((weak))
101 void matrix_init_user(void) {
104 __attribute__ ((weak))
105 void matrix_scan_user(void) {
109 uint8_t matrix_rows(void)
115 uint8_t matrix_cols(void)
120 void matrix_init(void)
125 // initialize row and col
131 // initialize matrix state: all keys off
132 for (uint8_t i=0; i < MATRIX_ROWS; i++) {
134 matrix_debouncing[i] = 0;
137 matrix_init_quantum();
141 uint8_t _matrix_scan(void)
143 int offset = isLeftHand ? 0 : (ROWS_PER_HAND);
144 #if (DIODE_DIRECTION == COL2ROW)
145 // Set row, read cols
146 for (uint8_t current_row = 0; current_row < ROWS_PER_HAND; current_row++) {
148 bool matrix_changed = read_cols_on_row(matrix_debouncing+offset, current_row);
150 if (matrix_changed) {
152 debouncing_time = timer_read();
156 read_cols_on_row(matrix+offset, current_row);
161 #elif (DIODE_DIRECTION == ROW2COL)
162 // Set col, read rows
163 for (uint8_t current_col = 0; current_col < MATRIX_COLS; current_col++) {
165 bool matrix_changed = read_rows_on_col(matrix_debouncing+offset, current_col);
166 if (matrix_changed) {
168 debouncing_time = timer_read();
171 read_rows_on_col(matrix+offset, current_col);
178 if (debouncing && (timer_elapsed(debouncing_time) > DEBOUNCE)) {
179 for (uint8_t i = 0; i < ROWS_PER_HAND; i++) {
180 matrix[i+offset] = matrix_debouncing[i+offset];
189 int serial_transaction(void) {
190 int slaveOffset = (isLeftHand) ? (ROWS_PER_HAND) : 0;
192 if (serial_update_buffers()) {
196 for (int i = 0; i < ROWS_PER_HAND; ++i) {
197 matrix[slaveOffset+i] = serial_slave_buffer[i];
200 #ifdef BACKLIGHT_ENABLE
201 // Write backlight level for slave to read
202 serial_master_buffer[SERIAL_LED_ADDR] = backlight_config.enable ? backlight_config.level : 0;
208 uint8_t matrix_scan(void)
210 uint8_t ret = _matrix_scan();
212 if( serial_transaction() ) {
213 // turn on the indicator led when halves are disconnected
218 if (error_count > ERROR_DISCONNECT_COUNT) {
219 // reset other half if disconnected
220 int slaveOffset = (isLeftHand) ? (ROWS_PER_HAND) : 0;
221 for (int i = 0; i < ROWS_PER_HAND; ++i) {
222 matrix[slaveOffset+i] = 0;
226 // turn off the indicator led on no error
230 matrix_scan_quantum();
234 void matrix_slave_scan(void) {
237 int offset = (isLeftHand) ? 0 : ROWS_PER_HAND;
239 for (int i = 0; i < ROWS_PER_HAND; ++i) {
240 serial_slave_buffer[i] = matrix[offset+i];
243 #ifdef BACKLIGHT_ENABLE
244 // Read backlight level sent from master and update level on slave
245 backlight_set(serial_master_buffer[SERIAL_LED_ADDR]);
249 bool matrix_is_modified(void)
251 if (debouncing) return false;
256 bool matrix_is_on(uint8_t row, uint8_t col)
258 return (matrix[row] & ((matrix_row_t)1<<col));
262 matrix_row_t matrix_get_row(uint8_t row)
267 void matrix_print(void)
269 print("\nr/c 0123456789ABCDEF\n");
270 for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
271 phex(row); print(": ");
272 pbin_reverse16(matrix_get_row(row));
277 uint8_t matrix_key_count(void)
280 for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
281 count += bitpop16(matrix[i]);
286 #if (DIODE_DIRECTION == COL2ROW)
288 static void init_cols(void)
290 for(uint8_t x = 0; x < MATRIX_COLS; x++) {
291 uint8_t pin = col_pins[x];
292 _SFR_IO8((pin >> 4) + 1) &= ~_BV(pin & 0xF); // IN
293 _SFR_IO8((pin >> 4) + 2) |= _BV(pin & 0xF); // HI
297 static bool read_cols_on_row(matrix_row_t current_matrix[], uint8_t current_row)
299 // Store last value of row prior to reading
300 matrix_row_t last_row_value = current_matrix[current_row];
302 // Clear data in matrix row
303 current_matrix[current_row] = 0;
305 // Select row and wait for row selecton to stabilize
306 select_row(current_row);
310 for(uint8_t col_index = 0; col_index < MATRIX_COLS; col_index++) {
312 // Select the col pin to read (active low)
313 uint8_t pin = col_pins[col_index];
314 uint8_t pin_state = (_SFR_IO8(pin >> 4) & _BV(pin & 0xF));
316 // Populate the matrix row with the state of the col pin
317 current_matrix[current_row] |= pin_state ? 0 : (ROW_SHIFTER << col_index);
321 unselect_row(current_row);
323 return (last_row_value != current_matrix[current_row]);
326 static void select_row(uint8_t row)
328 uint8_t pin = row_pins[row];
329 _SFR_IO8((pin >> 4) + 1) |= _BV(pin & 0xF); // OUT
330 _SFR_IO8((pin >> 4) + 2) &= ~_BV(pin & 0xF); // LOW
333 static void unselect_row(uint8_t row)
335 uint8_t pin = row_pins[row];
336 _SFR_IO8((pin >> 4) + 1) &= ~_BV(pin & 0xF); // IN
337 _SFR_IO8((pin >> 4) + 2) |= _BV(pin & 0xF); // HI
340 static void unselect_rows(void)
342 for(uint8_t x = 0; x < ROWS_PER_HAND; x++) {
343 uint8_t pin = row_pins[x];
344 _SFR_IO8((pin >> 4) + 1) &= ~_BV(pin & 0xF); // IN
345 _SFR_IO8((pin >> 4) + 2) |= _BV(pin & 0xF); // HI
349 #elif (DIODE_DIRECTION == ROW2COL)
351 static void init_rows(void)
353 for(uint8_t x = 0; x < ROWS_PER_HAND; x++) {
354 uint8_t pin = row_pins[x];
355 _SFR_IO8((pin >> 4) + 1) &= ~_BV(pin & 0xF); // IN
356 _SFR_IO8((pin >> 4) + 2) |= _BV(pin & 0xF); // HI
360 static bool read_rows_on_col(matrix_row_t current_matrix[], uint8_t current_col)
362 bool matrix_changed = false;
364 // Select col and wait for col selecton to stabilize
365 select_col(current_col);
369 for(uint8_t row_index = 0; row_index < ROWS_PER_HAND; row_index++)
372 // Store last value of row prior to reading
373 matrix_row_t last_row_value = current_matrix[row_index];
375 // Check row pin state
376 if ((_SFR_IO8(row_pins[row_index] >> 4) & _BV(row_pins[row_index] & 0xF)) == 0)
378 // Pin LO, set col bit
379 current_matrix[row_index] |= (ROW_SHIFTER << current_col);
383 // Pin HI, clear col bit
384 current_matrix[row_index] &= ~(ROW_SHIFTER << current_col);
387 // Determine if the matrix changed state
388 if ((last_row_value != current_matrix[row_index]) && !(matrix_changed))
390 matrix_changed = true;
395 unselect_col(current_col);
397 return matrix_changed;
400 static void select_col(uint8_t col)
402 uint8_t pin = col_pins[col];
403 _SFR_IO8((pin >> 4) + 1) |= _BV(pin & 0xF); // OUT
404 _SFR_IO8((pin >> 4) + 2) &= ~_BV(pin & 0xF); // LOW
407 static void unselect_col(uint8_t col)
409 uint8_t pin = col_pins[col];
410 _SFR_IO8((pin >> 4) + 1) &= ~_BV(pin & 0xF); // IN
411 _SFR_IO8((pin >> 4) + 2) |= _BV(pin & 0xF); // HI
414 static void unselect_cols(void)
416 for(uint8_t x = 0; x < MATRIX_COLS; x++) {
417 uint8_t pin = col_pins[x];
418 _SFR_IO8((pin >> 4) + 1) &= ~_BV(pin & 0xF); // IN
419 _SFR_IO8((pin >> 4) + 2) |= _BV(pin & 0xF); // HI