13 * Column pins are input with internal pull-down. Row pins are output and strobe with high.
14 * Key is high or 1 when it turns on.
15 * INFINITY PRODUCTION (NO LED)
16 * col: { PTD1, PTD2, PTD3, PTD4, PTD5, PTD6, PTD7 }
17 * row: { PTB0, PTB1, PTB2, PTB3, PTB16, PTB17, PTC4, PTC5, PTD0 }
18 * INFINITY PRODUCTION (WITH LED)
19 * col: { PTD1, PTD2, PTD3, PTD4, PTD5, PTD6, PTD7 }
20 * row: { PTC0, PTC1, PTC2, PTC3, PTC4, PTC5, PTC6, PTC7, PTD0 }
22 /* matrix state(1:on, 0:off) */
23 static matrix_row_t matrix[MATRIX_ROWS];
24 static matrix_row_t matrix_debouncing[MATRIX_ROWS];
25 static bool debouncing = false;
26 static uint16_t debouncing_time = 0;
29 void matrix_init(void)
32 palSetPadMode(GPIOD, 1, PAL_MODE_INPUT_PULLDOWN);
33 palSetPadMode(GPIOD, 2, PAL_MODE_INPUT_PULLDOWN);
34 palSetPadMode(GPIOD, 3, PAL_MODE_INPUT_PULLDOWN);
35 palSetPadMode(GPIOD, 4, PAL_MODE_INPUT_PULLDOWN);
36 palSetPadMode(GPIOD, 5, PAL_MODE_INPUT_PULLDOWN);
37 palSetPadMode(GPIOD, 6, PAL_MODE_INPUT_PULLDOWN);
38 palSetPadMode(GPIOD, 7, PAL_MODE_INPUT_PULLDOWN);
42 palSetPadMode(GPIOC, 0, PAL_MODE_OUTPUT_PUSHPULL);
43 palSetPadMode(GPIOC, 1, PAL_MODE_OUTPUT_PUSHPULL);
44 palSetPadMode(GPIOC, 2, PAL_MODE_OUTPUT_PUSHPULL);
45 palSetPadMode(GPIOC, 3, PAL_MODE_OUTPUT_PUSHPULL);
46 palSetPadMode(GPIOC, 4, PAL_MODE_OUTPUT_PUSHPULL);
47 palSetPadMode(GPIOC, 5, PAL_MODE_OUTPUT_PUSHPULL);
48 palSetPadMode(GPIOC, 6, PAL_MODE_OUTPUT_PUSHPULL);
49 palSetPadMode(GPIOC, 7, PAL_MODE_OUTPUT_PUSHPULL);
50 palSetPadMode(GPIOD, 0, PAL_MODE_OUTPUT_PUSHPULL);
53 palSetPadMode(GPIOB, 0, PAL_MODE_OUTPUT_PUSHPULL);
54 palSetPadMode(GPIOB, 1, PAL_MODE_OUTPUT_PUSHPULL);
55 palSetPadMode(GPIOB, 2, PAL_MODE_OUTPUT_PUSHPULL);
56 palSetPadMode(GPIOB, 3, PAL_MODE_OUTPUT_PUSHPULL);
57 palSetPadMode(GPIOB, 16, PAL_MODE_OUTPUT_PUSHPULL);
58 palSetPadMode(GPIOB, 17, PAL_MODE_OUTPUT_PUSHPULL);
59 palSetPadMode(GPIOC, 4, PAL_MODE_OUTPUT_PUSHPULL);
60 palSetPadMode(GPIOC, 5, PAL_MODE_OUTPUT_PUSHPULL);
61 palSetPadMode(GPIOD, 0, PAL_MODE_OUTPUT_PUSHPULL);
63 memset(matrix, 0, MATRIX_ROWS);
64 memset(matrix_debouncing, 0, MATRIX_ROWS);
67 uint8_t matrix_scan(void)
69 for (int row = 0; row < MATRIX_ROWS; row++) {
70 matrix_row_t data = 0;
74 case 0: palSetPad(GPIOC, 0); break;
75 case 1: palSetPad(GPIOC, 1); break;
76 case 2: palSetPad(GPIOC, 2); break;
77 case 3: palSetPad(GPIOC, 3); break;
78 case 4: palSetPad(GPIOC, 4); break;
79 case 5: palSetPad(GPIOC, 5); break;
80 case 6: palSetPad(GPIOC, 6); break;
81 case 7: palSetPad(GPIOC, 7); break;
82 case 8: palSetPad(GPIOD, 0); break;
87 case 0: palSetPad(GPIOB, 0); break;
88 case 1: palSetPad(GPIOB, 1); break;
89 case 2: palSetPad(GPIOB, 2); break;
90 case 3: palSetPad(GPIOB, 3); break;
91 case 4: palSetPad(GPIOB, 16); break;
92 case 5: palSetPad(GPIOB, 17); break;
93 case 6: palSetPad(GPIOC, 4); break;
94 case 7: palSetPad(GPIOC, 5); break;
95 case 8: palSetPad(GPIOD, 0); break;
99 wait_us(1); // need wait to settle pin state
102 data = (palReadPort(GPIOD)>>1);
106 case 0: palClearPad(GPIOC, 0); break;
107 case 1: palClearPad(GPIOC, 1); break;
108 case 2: palClearPad(GPIOC, 2); break;
109 case 3: palClearPad(GPIOC, 3); break;
110 case 4: palClearPad(GPIOC, 4); break;
111 case 5: palClearPad(GPIOC, 5); break;
112 case 6: palClearPad(GPIOC, 6); break;
113 case 7: palClearPad(GPIOC, 7); break;
114 case 8: palClearPad(GPIOD, 0); break;
119 case 0: palClearPad(GPIOB, 0); break;
120 case 1: palClearPad(GPIOB, 1); break;
121 case 2: palClearPad(GPIOB, 2); break;
122 case 3: palClearPad(GPIOB, 3); break;
123 case 4: palClearPad(GPIOB, 16); break;
124 case 5: palClearPad(GPIOB, 17); break;
125 case 6: palClearPad(GPIOC, 4); break;
126 case 7: palClearPad(GPIOC, 5); break;
127 case 8: palClearPad(GPIOD, 0); break;
131 if (matrix_debouncing[row] != data) {
132 matrix_debouncing[row] = data;
134 debouncing_time = timer_read();
138 if (debouncing && timer_elapsed(debouncing_time) > DEBOUNCE) {
139 for (int row = 0; row < MATRIX_ROWS; row++) {
140 matrix[row] = matrix_debouncing[row];
147 bool matrix_is_on(uint8_t row, uint8_t col)
149 return (matrix[row] & (1<<col));
152 matrix_row_t matrix_get_row(uint8_t row)
157 void matrix_print(void)
159 xprintf("\nr/c 01234567\n");
160 for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
162 matrix_row_t data = matrix_get_row(row);
163 for (int col = 0; col < MATRIX_COLS; col++) {