|
|
|
@ -37,6 +37,11 @@ static uint8_t debouncing = DEBOUNCE;
|
|
|
|
|
static matrix_row_t matrix[MATRIX_ROWS];
|
|
|
|
|
static matrix_row_t matrix_debouncing[MATRIX_ROWS];
|
|
|
|
|
|
|
|
|
|
#if DIODE_DIRECTION == ROW2COL
|
|
|
|
|
static matrix_row_t matrix_reversed[MATRIX_COLS];
|
|
|
|
|
static matrix_row_t matrix_reversed_debouncing[MATRIX_COLS];
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
static matrix_row_t read_cols(void);
|
|
|
|
|
static void init_cols(void);
|
|
|
|
|
static void unselect_rows(void);
|
|
|
|
@ -80,6 +85,7 @@ void matrix_init(void)
|
|
|
|
|
|
|
|
|
|
uint8_t matrix_scan(void)
|
|
|
|
|
{
|
|
|
|
|
#if DIODE_DIRECTION == COL2ROW
|
|
|
|
|
for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
|
|
|
|
|
select_row(i);
|
|
|
|
|
_delay_us(30); // without this wait read unstable value.
|
|
|
|
@ -103,6 +109,38 @@ uint8_t matrix_scan(void)
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
#else
|
|
|
|
|
for (uint8_t i = 0; i < MATRIX_COLS; i++) {
|
|
|
|
|
select_row(i);
|
|
|
|
|
_delay_us(30); // without this wait read unstable value.
|
|
|
|
|
matrix_row_t rows = read_cols();
|
|
|
|
|
if (matrix_reversed_debouncing[i] != rows) {
|
|
|
|
|
matrix_reversed_debouncing[i] = rows;
|
|
|
|
|
if (debouncing) {
|
|
|
|
|
debug("bounce!: "); debug_hex(debouncing); debug("\n");
|
|
|
|
|
}
|
|
|
|
|
debouncing = DEBOUNCE;
|
|
|
|
|
}
|
|
|
|
|
unselect_rows();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (debouncing) {
|
|
|
|
|
if (--debouncing) {
|
|
|
|
|
_delay_ms(1);
|
|
|
|
|
} else {
|
|
|
|
|
for (uint8_t i = 0; i < MATRIX_COLS; i++) {
|
|
|
|
|
matrix_reversed[i] = matrix_reversed_debouncing[i];
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
for (uint8_t y = 0; y < MATRIX_ROWS; y++) {
|
|
|
|
|
matrix_row_t row = 0;
|
|
|
|
|
for (uint8_t x = 0; x < MATRIX_COLS; x++) {
|
|
|
|
|
row |= ((matrix_reversed[x] & (1<<y)) >> y) << x;
|
|
|
|
|
}
|
|
|
|
|
matrix[y] = row;
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
return 1;
|
|
|
|
|
}
|
|
|
|
@ -147,8 +185,14 @@ uint8_t matrix_key_count(void)
|
|
|
|
|
static void init_cols(void)
|
|
|
|
|
{
|
|
|
|
|
int B = 0, C = 0, D = 0, E = 0, F = 0;
|
|
|
|
|
|
|
|
|
|
#if DIODE_DIRECTION == COL2ROW
|
|
|
|
|
for(int x = 0; x < MATRIX_COLS; x++) {
|
|
|
|
|
int col = COLS[x];
|
|
|
|
|
#else
|
|
|
|
|
for(int x = 0; x < MATRIX_ROWS; x++) {
|
|
|
|
|
int col = ROWS[x];
|
|
|
|
|
#endif
|
|
|
|
|
if ((col & 0xF0) == 0x20) {
|
|
|
|
|
B |= (1<<(col & 0x0F));
|
|
|
|
|
} else if ((col & 0xF0) == 0x30) {
|
|
|
|
@ -171,8 +215,15 @@ static void init_cols(void)
|
|
|
|
|
static matrix_row_t read_cols(void)
|
|
|
|
|
{
|
|
|
|
|
matrix_row_t result = 0;
|
|
|
|
|
|
|
|
|
|
#if DIODE_DIRECTION == COL2ROW
|
|
|
|
|
for(int x = 0; x < MATRIX_COLS; x++) {
|
|
|
|
|
int col = COLS[x];
|
|
|
|
|
#else
|
|
|
|
|
for(int x = 0; x < MATRIX_ROWS; x++) {
|
|
|
|
|
int col = ROWS[x];
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
if ((col & 0xF0) == 0x20) {
|
|
|
|
|
result |= (PINB&(1<<(col & 0x0F)) ? 0 : (1<<x));
|
|
|
|
|
} else if ((col & 0xF0) == 0x30) {
|
|
|
|
@ -191,8 +242,14 @@ static matrix_row_t read_cols(void)
|
|
|
|
|
static void unselect_rows(void)
|
|
|
|
|
{
|
|
|
|
|
int B = 0, C = 0, D = 0, E = 0, F = 0;
|
|
|
|
|
|
|
|
|
|
#if DIODE_DIRECTION == COL2ROW
|
|
|
|
|
for(int x = 0; x < MATRIX_ROWS; x++) {
|
|
|
|
|
int row = ROWS[x];
|
|
|
|
|
#else
|
|
|
|
|
for(int x = 0; x < MATRIX_COLS; x++) {
|
|
|
|
|
int row = COLS[x];
|
|
|
|
|
#endif
|
|
|
|
|
if ((row & 0xF0) == 0x20) {
|
|
|
|
|
B |= (1<<(row & 0x0F));
|
|
|
|
|
} else if ((row & 0xF0) == 0x30) {
|
|
|
|
@ -214,7 +271,13 @@ static void unselect_rows(void)
|
|
|
|
|
|
|
|
|
|
static void select_row(uint8_t row)
|
|
|
|
|
{
|
|
|
|
|
|
|
|
|
|
#if DIODE_DIRECTION == COL2ROW
|
|
|
|
|
int row_pin = ROWS[row];
|
|
|
|
|
#else
|
|
|
|
|
int row_pin = COLS[row];
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
if ((row_pin & 0xF0) == 0x20) {
|
|
|
|
|
DDRB |= (1<<(row_pin & 0x0F));
|
|
|
|
|
PORTB &= ~(1<<(row_pin & 0x0F));
|
|
|
|
|