14 * Column pins are input with internal pull-down.
15 * Row pins are output and strobe with high.
16 * Key is high or 1 when it turns on.
18 * col: { PA2, PA3, PA6, PB14, PB15, PA8, PA9, PA7, PB3, PB4, PC15, PC14, PC13, PB5, PB6 }
19 * row: { PB0, PB1, PB2, PA15, PA10 }
21 /* matrix state(1:on, 0:off) */
22 static matrix_row_t matrix[MATRIX_ROWS];
23 static matrix_row_t matrix_debouncing[MATRIX_COLS];
24 static bool debouncing = false;
25 static uint16_t debouncing_time = 0;
27 __attribute__ ((weak))
28 void matrix_init_user(void) {}
30 __attribute__ ((weak))
31 void matrix_scan_user(void) {}
33 __attribute__ ((weak))
34 void matrix_init_kb(void) {
38 __attribute__ ((weak))
39 void matrix_scan_kb(void) {
43 void matrix_init(void) {
44 printf("matrix init\n");
45 //debug_matrix = true;
48 palSetPadMode(GPIOA, 2, PAL_MODE_OUTPUT_PUSHPULL);
49 palSetPadMode(GPIOA, 3, PAL_MODE_OUTPUT_PUSHPULL);
50 palSetPadMode(GPIOA, 6, PAL_MODE_OUTPUT_PUSHPULL);
51 palSetPadMode(GPIOB, 14, PAL_MODE_OUTPUT_PUSHPULL);
52 palSetPadMode(GPIOB, 15, PAL_MODE_OUTPUT_PUSHPULL);
53 palSetPadMode(GPIOA, 8, PAL_MODE_OUTPUT_PUSHPULL);
54 palSetPadMode(GPIOA, 9, PAL_MODE_OUTPUT_PUSHPULL);
55 palSetPadMode(GPIOA, 7, PAL_MODE_OUTPUT_PUSHPULL);
56 palSetPadMode(GPIOB, 3, PAL_MODE_OUTPUT_PUSHPULL);
57 palSetPadMode(GPIOB, 4, PAL_MODE_OUTPUT_PUSHPULL);
58 palSetPadMode(GPIOC, 15, PAL_MODE_OUTPUT_PUSHPULL);
59 palSetPadMode(GPIOC, 14, PAL_MODE_OUTPUT_PUSHPULL);
60 palSetPadMode(GPIOC, 13, PAL_MODE_OUTPUT_PUSHPULL);
61 palSetPadMode(GPIOB, 5, PAL_MODE_OUTPUT_PUSHPULL);
62 palSetPadMode(GPIOB, 6, PAL_MODE_OUTPUT_PUSHPULL);
65 palSetPadMode(GPIOB, 0, PAL_MODE_INPUT_PULLDOWN);
66 palSetPadMode(GPIOB, 1, PAL_MODE_INPUT_PULLDOWN);
67 palSetPadMode(GPIOB, 2, PAL_MODE_INPUT_PULLDOWN);
68 palSetPadMode(GPIOA, 15, PAL_MODE_INPUT_PULLDOWN);
69 palSetPadMode(GPIOA, 10, PAL_MODE_INPUT_PULLDOWN);
71 memset(matrix, 0, MATRIX_ROWS * sizeof(matrix_row_t));
72 memset(matrix_debouncing, 0, MATRIX_COLS * sizeof(matrix_row_t));
74 palClearPad(GPIOB, 7); // Turn off capslock
75 matrix_init_quantum();
78 uint8_t matrix_scan(void) {
79 for (int col = 0; col < MATRIX_COLS; col++) {
80 matrix_row_t data = 0;
82 // strobe col { PA2, PA3, PA6, PB14, PB15, PA8, PA9, PA7, PB3, PB4, PC14, PC15, PC13, PB5, PB6 }
84 case 0: palSetPad(GPIOA, 2); break;
85 case 1: palSetPad(GPIOA, 3); break;
86 case 2: palSetPad(GPIOA, 6); break;
87 case 3: palSetPad(GPIOB, 14); break;
88 case 4: palSetPad(GPIOB, 15); break;
89 case 5: palSetPad(GPIOA, 8); break;
90 case 6: palSetPad(GPIOA, 9); break;
91 case 7: palSetPad(GPIOA, 7); break;
92 case 8: palSetPad(GPIOB, 3); break;
93 case 9: palSetPad(GPIOB, 4); break;
94 case 10: palSetPad(GPIOC, 15); break;
95 case 11: palSetPad(GPIOC, 14); break;
96 case 12: palSetPad(GPIOC, 13); break;
97 case 13: palSetPad(GPIOB, 5); break;
98 case 14: palSetPad(GPIOB, 6); break;
101 // need wait to settle pin state
104 // read row data { PB0, PB1, PB2, PA15, PA10 }
106 (palReadPad(GPIOB, 0) << 0 ) |
107 (palReadPad(GPIOB, 1) << 1 ) |
108 (palReadPad(GPIOB, 2) << 2 ) |
109 (palReadPad(GPIOA, 15) << 3 ) |
110 (palReadPad(GPIOA, 10) << 4 )
113 // unstrobe col { PA2, PA3, PA6, PB14, PB15, PA8, PA9, PA7, PB3, PB4, PC15, PC14, PC13, PB5, PB6 }
115 case 0: palClearPad(GPIOA, 2); break;
116 case 1: palClearPad(GPIOA, 3); break;
117 case 2: palClearPad(GPIOA, 6); break;
118 case 3: palClearPad(GPIOB, 14); break;
119 case 4: palClearPad(GPIOB, 15); break;
120 case 5: palClearPad(GPIOA, 8); break;
121 case 6: palClearPad(GPIOA, 9); break;
122 case 7: palClearPad(GPIOA, 7); break;
123 case 8: palClearPad(GPIOB, 3); break;
124 case 9: palClearPad(GPIOB, 4); break;
125 case 10: palClearPad(GPIOC, 15); break;
126 case 11: palClearPad(GPIOC, 14); break;
127 case 12: palClearPad(GPIOC, 13); break;
128 case 13: palClearPad(GPIOB, 5); break;
129 case 14: palClearPad(GPIOB, 6); break;
132 if (matrix_debouncing[col] != data) {
133 matrix_debouncing[col] = data;
135 debouncing_time = timer_read();
139 if (debouncing && timer_elapsed(debouncing_time) > DEBOUNCE) {
140 for (int row = 0; row < MATRIX_ROWS; row++) {
142 for (int col = 0; col < MATRIX_COLS; col++) {
143 matrix[row] |= ((matrix_debouncing[col] & (1 << row) ? 1 : 0) << col);
149 matrix_scan_quantum();
154 bool matrix_is_on(uint8_t row, uint8_t col) {
155 return (matrix[row] & (1<<col));
158 matrix_row_t matrix_get_row(uint8_t row) {
162 void matrix_print(void) {
163 printf("\nr/c 01234567\n");
164 for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
165 printf("%X0: ", row);
166 matrix_row_t data = matrix_get_row(row);
167 for (int col = 0; col < MATRIX_COLS; col++) {