diff --git a/macway/config.h b/macway/config.h index 546067beb1d..2e68bf252fb 100644 --- a/macway/config.h +++ b/macway/config.h @@ -33,6 +33,8 @@ along with this program. If not, see . #define MATRIX_COLS 8 /* define if matrix has ghost */ #define MATRIX_HAS_GHOST +/* Set 0 if need no debouncing */ +#define DEBOUNCE 5 /* key combination for command */ diff --git a/macway/matrix.c b/macway/matrix.c index 20cfd9dd60f..56fb8589602 100644 --- a/macway/matrix.c +++ b/macway/matrix.c @@ -23,6 +23,7 @@ along with this program. If not, see . #include #include #include "print.h" +#include "debug.h" #include "util.h" #include "matrix.h" @@ -35,6 +36,11 @@ along with this program. If not, see . #endif +#ifndef DEBOUNCE +# define DEBOUNCE 0 +#endif +static uint8_t debouncing = DEBOUNCE; + // matrix state buffer(1:on, 0:off) #if (MATRIX_COLS <= 8) static uint8_t *matrix; @@ -85,27 +91,40 @@ void matrix_init(void) uint8_t matrix_scan(void) { - uint8_t *tmp; - - tmp = matrix_prev; - matrix_prev = matrix; - matrix = tmp; + if (!debouncing) { + uint8_t *tmp = matrix_prev; + matrix_prev = matrix; + matrix = tmp; + } for (uint8_t i = 0; i < MATRIX_ROWS; i++) { unselect_rows(); select_row(i); _delay_us(30); // without this wait read unstable value. - matrix[i] = ~read_col(); + if (matrix[i] != (uint8_t)~read_col()) { + matrix[i] = (uint8_t)~read_col(); + if (debouncing) { + debug("bounce!: "); debug_hex(debouncing); print("\n"); + } + debouncing = DEBOUNCE; + } } unselect_rows(); + + if (debouncing) { + debouncing--; + } + return 1; } bool matrix_is_modified(void) { + if (debouncing) return false; for (uint8_t i = 0; i < MATRIX_ROWS; i++) { - if (matrix[i] != matrix_prev[i]) + if (matrix[i] != matrix_prev[i]) { return true; + } } return false; }