]> git.donarmstrong.com Git - qmk_firmware.git/blob - keyboards/k_type/matrix.c
[Keyboard] fixed pins for numpad_5x4 layout (#6311)
[qmk_firmware.git] / keyboards / k_type / matrix.c
1 //#include <stdint.h>
2 //#include <stdbool.h>
3 #include <string.h>
4 #include "hal.h"
5 #include "timer.h"
6 #include "wait.h"
7 #include "print.h"
8 #include "matrix.h"
9 #include "debug.h"
10
11 /* matrix state(1:on, 0:off) */
12 static matrix_row_t matrix[MATRIX_ROWS];
13 static matrix_row_t matrix_debouncing[MATRIX_ROWS];
14 static bool debouncing = false;
15 static uint16_t debouncing_time = 0;
16
17 void matrix_init(void)
18 {
19     debug_matrix = true;
20
21     /* Column(sense) */
22     palSetPadMode(GPIOD, 5,  PAL_MODE_INPUT_PULLDOWN);
23     palSetPadMode(GPIOD, 6,  PAL_MODE_INPUT_PULLDOWN);
24     palSetPadMode(GPIOD, 7,  PAL_MODE_INPUT_PULLDOWN);
25     palSetPadMode(GPIOC, 1,  PAL_MODE_INPUT_PULLDOWN);
26     palSetPadMode(GPIOC, 2,  PAL_MODE_INPUT_PULLDOWN);
27     palSetPadMode(GPIOC, 3,  PAL_MODE_INPUT_PULLDOWN);
28     palSetPadMode(GPIOC, 4,  PAL_MODE_INPUT_PULLDOWN);
29     palSetPadMode(GPIOC, 5,  PAL_MODE_INPUT_PULLDOWN);
30     palSetPadMode(GPIOC, 6,  PAL_MODE_INPUT_PULLDOWN);
31     palSetPadMode(GPIOC, 7,  PAL_MODE_INPUT_PULLDOWN);
32
33     /* Row(strobe) */
34     palSetPadMode(GPIOB, 2,   PAL_MODE_OUTPUT_PUSHPULL);
35     palSetPadMode(GPIOB, 3,   PAL_MODE_OUTPUT_PUSHPULL);
36     palSetPadMode(GPIOB, 18,  PAL_MODE_OUTPUT_PUSHPULL);
37     palSetPadMode(GPIOB, 19,  PAL_MODE_OUTPUT_PUSHPULL);
38     palSetPadMode(GPIOC, 0,   PAL_MODE_OUTPUT_PUSHPULL);
39     palSetPadMode(GPIOC, 8,   PAL_MODE_OUTPUT_PUSHPULL);
40     palSetPadMode(GPIOC, 9,   PAL_MODE_OUTPUT_PUSHPULL);
41     palSetPadMode(GPIOD, 0,   PAL_MODE_OUTPUT_PUSHPULL);
42     palSetPadMode(GPIOD, 1,   PAL_MODE_OUTPUT_PUSHPULL);
43     palSetPadMode(GPIOD, 4,   PAL_MODE_OUTPUT_PUSHPULL);
44
45     memset(matrix, 0, MATRIX_ROWS * sizeof(matrix_row_t));
46     memset(matrix_debouncing, 0, MATRIX_ROWS * sizeof(matrix_row_t));
47
48     matrix_init_quantum();
49 }
50
51 uint8_t matrix_scan(void)
52 {
53     for (int row = 0; row < MATRIX_ROWS; row++) {
54         matrix_row_t data = 0;
55         // strobe row
56         switch (row) {
57             case 0: palSetPad(GPIOB, 2);    break;
58             case 1: palSetPad(GPIOB, 3);    break;
59             case 2: palSetPad(GPIOB, 18);   break;
60             case 3: palSetPad(GPIOB, 19);   break;
61             case 4: palSetPad(GPIOC, 0);    break;
62             case 5: palSetPad(GPIOC, 8);    break;
63             case 6: palSetPad(GPIOC, 9);    break;
64             case 7: palSetPad(GPIOD, 0);    break;
65             case 8: palSetPad(GPIOD, 1);    break;
66             case 9: palSetPad(GPIOD, 4);    break;
67         }
68
69         // need wait to settle pin state
70         // if you wait too short, or have a too high update rate
71         // the keyboard might freeze, or there might not be enough
72         // processing power to update the LCD screen properly.
73         // 20us, or two ticks at 100000Hz seems to be OK
74         wait_us(20);
75
76         // read col data: { PTD5, PTD6, PTD7, PTC1, PTC2, PTC3, PTC4, PTC5, PTC6, PTC7 }
77         data = ((palReadPort(GPIOC) & 0xFEUL) << 2) |
78                ((palReadPort(GPIOD) & 0xE0UL) >> 5);
79
80         // un-strobe row
81         switch (row) {
82             case 0: palClearPad(GPIOB, 2);  break;
83             case 1: palClearPad(GPIOB, 3);  break;
84             case 2: palClearPad(GPIOB, 18); break;
85             case 3: palClearPad(GPIOB, 19); break;
86             case 4: palClearPad(GPIOC, 0);  break;
87             case 5: palClearPad(GPIOC, 8);  break;
88             case 6: palClearPad(GPIOC, 9);  break;
89             case 7: palClearPad(GPIOD, 0);  break;
90             case 8: palClearPad(GPIOD, 1);  break;
91             case 9: palClearPad(GPIOD, 4);  break;
92         }
93
94         if (matrix_debouncing[row] != data) {
95             matrix_debouncing[row] = data;
96             debouncing = true;
97             debouncing_time = timer_read();
98         }
99     }
100
101     if (debouncing && timer_elapsed(debouncing_time) > DEBOUNCE) {
102         for (int row = 0; row < MATRIX_ROWS; row++) {
103             matrix[row] = matrix_debouncing[row];
104         }
105         debouncing = false;
106     }
107
108     matrix_scan_quantum();
109     return 1;
110 }
111
112 bool matrix_is_on(uint8_t row, uint8_t col)
113 {
114     return (matrix[row] & (1 << col));
115 }
116
117 matrix_row_t matrix_get_row(uint8_t row)
118 {
119     return matrix[row];
120 }
121
122 void matrix_print(void)
123 {
124     xprintf("\nr/c 01234567\n");
125     for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
126         xprintf("%02X: ", row);
127         matrix_row_t data = matrix_get_row(row);
128         for (int col = 0; col < MATRIX_COLS; col++) {
129             if (data & (1<<col))
130                 xprintf("1");
131             else
132                 xprintf("0");
133         }
134         xprintf("\n");
135     }
136
137     wait_ms(50);
138 }