]> git.friedersdorff.com Git - max/tmk_keyboard.git/blob - keyboard/teensy_lc_onekey/matrix.c
adb_usb: Fix Power key mapping for Windows
[max/tmk_keyboard.git] / keyboard / teensy_lc_onekey / matrix.c
1 /*
2 Copyright 2012 Jun Wako <wakojun@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 "ch.h"
19 #include "hal.h"
20
21 /*
22  * scan matrix
23  */
24 #include "print.h"
25 #include "debug.h"
26 #include "util.h"
27 #include "matrix.h"
28 #include "wait.h"
29
30 #ifndef DEBOUNCE
31 #   define DEBOUNCE 5
32 #endif
33 static uint8_t debouncing = DEBOUNCE;
34
35 /* matrix state(1:on, 0:off) */
36 static matrix_row_t matrix[MATRIX_ROWS];
37 static matrix_row_t matrix_debouncing[MATRIX_ROWS];
38
39 static matrix_row_t read_cols(void);
40 static void init_cols(void);
41 static void unselect_rows(void);
42 static void select_row(uint8_t row);
43
44
45 inline
46 uint8_t matrix_rows(void)
47 {
48     return MATRIX_ROWS;
49 }
50
51 inline
52 uint8_t matrix_cols(void)
53 {
54     return MATRIX_COLS;
55 }
56
57 #define LED_ON()    do { palSetPad(TEENSY_PIN13_IOPORT, TEENSY_PIN13) ;} while (0)
58 #define LED_OFF()   do { palClearPad(TEENSY_PIN13_IOPORT, TEENSY_PIN13); } while (0)
59 #define LED_TGL()   do { palTogglePad(TEENSY_PIN13_IOPORT, TEENSY_PIN13); } while (0)
60
61 void matrix_init(void)
62 {
63     // initialize row and col
64     unselect_rows();
65     init_cols();
66
67     // initialize matrix state: all keys off
68     for (uint8_t i=0; i < MATRIX_ROWS; i++) {
69         matrix[i] = 0;
70         matrix_debouncing[i] = 0;
71     }
72
73     //debug
74     debug_matrix = true;
75     LED_ON();
76     wait_ms(500);
77     LED_OFF();
78 }
79
80 uint8_t matrix_scan(void)
81 {
82     for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
83         select_row(i);
84         wait_us(30);  // without this wait read unstable value.
85         matrix_row_t cols = read_cols();
86         if (matrix_debouncing[i] != cols) {
87             matrix_debouncing[i] = cols;
88             if (debouncing) {
89                 debug("bounce!: "); debug_hex(debouncing); debug("\n");
90             }
91             debouncing = DEBOUNCE;
92         }
93         unselect_rows();
94     }
95
96     if (debouncing) {
97         if (--debouncing) {
98             wait_ms(1);
99         } else {
100             for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
101                 matrix[i] = matrix_debouncing[i];
102             }
103         }
104     }
105
106     return 1;
107 }
108
109 inline
110 bool matrix_is_on(uint8_t row, uint8_t col)
111 {
112     return (matrix[row] & ((matrix_row_t)1<<col));
113 }
114
115 inline
116 matrix_row_t matrix_get_row(uint8_t row)
117 {
118     return matrix[row];
119 }
120
121 void matrix_print(void)
122 {
123     print("\nr/c 0123456789ABCDEF\n");
124     for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
125         phex(row); print(": ");
126         pbin_reverse16(matrix_get_row(row));
127         print("\n");
128     }
129 }
130
131 /* Column pin configuration
132  */
133 static void  init_cols(void)
134 {
135     // internal pull-up
136     palSetPadMode(TEENSY_PIN2_IOPORT, TEENSY_PIN2, PAL_MODE_INPUT_PULLUP);
137 }
138
139 /* Returns status of switches(1:on, 0:off) */
140 static matrix_row_t read_cols(void)
141 {
142     return ((palReadPad(TEENSY_PIN2_IOPORT, TEENSY_PIN2)==PAL_HIGH) ? 0 : (1<<0));
143     // | ((palReadPad(...)==PAL_HIGH) ? 0 : (1<<1))
144 }
145
146 /* Row pin configuration
147  */
148 static void unselect_rows(void)
149 {
150     palSetPadMode(TEENSY_PIN5_IOPORT, TEENSY_PIN5, PAL_MODE_INPUT); // hi-Z
151 }
152
153 static void select_row(uint8_t row)
154 {
155     (void)row;
156     // Output low to select
157     switch (row) {
158         case 0:
159             palSetPadMode(TEENSY_PIN5_IOPORT, TEENSY_PIN5, PAL_MODE_OUTPUT_PUSHPULL);
160             palClearPad(TEENSY_PIN5_IOPORT, TEENSY_PIN5);
161             break;
162     }
163 }