Commit | Line | Data |
---|---|---|
e094cd42 VB |
1 | /* |
2 | Copyright 2017 Luiz Ribeiro <luizribeiro@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 <avr/io.h> | |
19 | #include <util/delay.h> | |
20 | ||
21 | #include "matrix.h" | |
22 | ||
23 | #ifndef DEBOUNCE | |
24 | # define DEBOUNCE 5 | |
25 | #endif | |
26 | ||
27 | static uint8_t debouncing = DEBOUNCE; | |
28 | ||
29 | static matrix_row_t matrix[MATRIX_ROWS]; | |
30 | static matrix_row_t matrix_debouncing[MATRIX_ROWS]; | |
31 | ||
365b8635 KA |
32 | void matrix_set_row_status(uint8_t row); |
33 | uint8_t bit_reverse(uint8_t x); | |
34 | ||
e094cd42 VB |
35 | void matrix_init(void) { |
36 | // all outputs for rows high | |
37 | DDRB = 0xFF; | |
38 | PORTB = 0xFF; | |
39 | // all inputs for columns | |
40 | DDRA = 0x00; | |
41 | DDRC &= ~(0x111111<<2); | |
42 | DDRD &= ~(1<<PIND7); | |
43 | // all columns are pulled-up | |
44 | PORTA = 0xFF; | |
45 | PORTC |= (0b111111<<2); | |
46 | PORTD |= (1<<PIND7); | |
47 | ||
48 | // initialize matrix state: all keys off | |
49 | for (uint8_t row = 0; row < MATRIX_ROWS; row++) { | |
50 | matrix[row] = 0x00; | |
51 | matrix_debouncing[row] = 0x00; | |
52 | } | |
e094cd42 | 53 | |
d2785566 | 54 | matrix_init_quantum(); |
e094cd42 VB |
55 | } |
56 | ||
57 | uint8_t matrix_scan(void) { | |
58 | for (uint8_t row = 0; row < MATRIX_ROWS; row++) { | |
59 | matrix_set_row_status(row); | |
60 | _delay_us(5); | |
61 | ||
62 | matrix_row_t cols = ( | |
63 | // cols 0..7, PORTA 0 -> 7 | |
64 | (~PINA) & 0xFF | |
65 | ) | ( | |
66 | // cols 8..13, PORTC 7 -> 0 | |
67 | bit_reverse((~PINC) & 0xFF) << 8 | |
68 | ) | ( | |
69 | // col 14, PORTD 7 | |
70 | ((~PIND) & (1 << PIND7)) << 7 | |
71 | ); | |
72 | ||
73 | if (matrix_debouncing[row] != cols) { | |
74 | matrix_debouncing[row] = cols; | |
75 | debouncing = DEBOUNCE; | |
76 | } | |
77 | } | |
78 | ||
79 | if (debouncing) { | |
80 | if (--debouncing) { | |
81 | _delay_ms(1); | |
82 | } else { | |
83 | for (uint8_t i = 0; i < MATRIX_ROWS; i++) { | |
84 | matrix[i] = matrix_debouncing[i]; | |
85 | } | |
86 | } | |
87 | } | |
88 | ||
d2785566 | 89 | matrix_scan_quantum(); |
e094cd42 VB |
90 | |
91 | return 1; | |
92 | } | |
93 | ||
365b8635 KA |
94 | // declarations |
95 | void matrix_set_row_status(uint8_t row) { | |
96 | DDRB = (1 << row); | |
97 | PORTB = ~(1 << row); | |
98 | } | |
99 | ||
100 | uint8_t bit_reverse(uint8_t x) { | |
101 | x = ((x >> 1) & 0x55) | ((x << 1) & 0xaa); | |
102 | x = ((x >> 2) & 0x33) | ((x << 2) & 0xcc); | |
103 | x = ((x >> 4) & 0x0f) | ((x << 4) & 0xf0); | |
104 | return x; | |
105 | } | |
106 | ||
e094cd42 VB |
107 | inline matrix_row_t matrix_get_row(uint8_t row) { |
108 | return matrix[row]; | |
109 | } | |
110 | ||
111 | void matrix_print(void) { | |
112 | } |