matrix.c (5828B)
1 /** 2 * matrix.c 3 */ 4 5 #include "matrix.h" 6 #include "timer.h" 7 #include "wait.h" 8 #include "print.h" 9 10 #ifndef DEBOUNCE 11 # define DEBOUNCE 5 12 #endif 13 14 /** 15 * 16 * Row pins are input with internal pull-down. 17 * Column pins are output and strobe with high. 18 * Key is high or 1 when it turns on. 19 * 20 */ 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; 26 27 // user-defined overridable functions 28 29 __attribute__((weak)) void matrix_init_kb(void) { matrix_init_user(); } 30 31 __attribute__((weak)) void matrix_scan_kb(void) { matrix_scan_user(); } 32 33 __attribute__((weak)) void matrix_init_user(void) {} 34 35 __attribute__((weak)) void matrix_scan_user(void) {} 36 37 // helper functions 38 void matrix_init(void) 39 { 40 //debug_enable = true; 41 palSetLineMode(LINE_COL_1, PAL_MODE_OUTPUT_PUSHPULL); 42 palSetLineMode(LINE_COL_2, PAL_MODE_OUTPUT_PUSHPULL); 43 palSetLineMode(LINE_COL_3, PAL_MODE_OUTPUT_PUSHPULL); 44 palSetLineMode(LINE_COL_4, PAL_MODE_OUTPUT_PUSHPULL); 45 palSetLineMode(LINE_COL_5, PAL_MODE_OUTPUT_PUSHPULL); 46 palSetLineMode(LINE_COL_6, PAL_MODE_OUTPUT_PUSHPULL); 47 palSetLineMode(LINE_COL_7, PAL_MODE_OUTPUT_PUSHPULL); 48 palSetLineMode(LINE_COL_8, PAL_MODE_OUTPUT_PUSHPULL); 49 palSetLineMode(LINE_COL_9, PAL_MODE_OUTPUT_PUSHPULL); 50 palSetLineMode(LINE_COL_10, PAL_MODE_OUTPUT_PUSHPULL); 51 palSetLineMode(LINE_COL_11, PAL_MODE_OUTPUT_PUSHPULL); 52 palSetLineMode(LINE_COL_12, PAL_MODE_OUTPUT_PUSHPULL); 53 palSetLineMode(LINE_COL_13, PAL_MODE_OUTPUT_PUSHPULL); 54 palSetLineMode(LINE_COL_14, PAL_MODE_OUTPUT_PUSHPULL); 55 palSetLineMode(LINE_COL_15, PAL_MODE_OUTPUT_PUSHPULL); 56 57 palSetLineMode(LINE_ROW_1, PAL_MODE_INPUT_PULLDOWN); 58 palSetLineMode(LINE_ROW_2, PAL_MODE_INPUT_PULLDOWN); 59 palSetLineMode(LINE_ROW_3, PAL_MODE_INPUT_PULLDOWN); 60 palSetLineMode(LINE_ROW_4, PAL_MODE_INPUT_PULLDOWN); 61 palSetLineMode(LINE_ROW_5, PAL_MODE_INPUT_PULLDOWN); 62 63 palClearLine(LINE_COL_1); 64 palClearLine(LINE_COL_2); 65 palClearLine(LINE_COL_3); 66 palClearLine(LINE_COL_4); 67 palClearLine(LINE_COL_5); 68 palClearLine(LINE_COL_6); 69 palClearLine(LINE_COL_7); 70 palClearLine(LINE_COL_8); 71 palClearLine(LINE_COL_9); 72 palClearLine(LINE_COL_10); 73 palClearLine(LINE_COL_11); 74 palClearLine(LINE_COL_12); 75 palClearLine(LINE_COL_13); 76 palClearLine(LINE_COL_14); 77 palClearLine(LINE_COL_15); 78 79 memset(matrix, 0, MATRIX_ROWS * sizeof(matrix_row_t)); 80 memset(matrix_debouncing, 0, MATRIX_COLS * sizeof(matrix_row_t)); 81 82 matrix_init_kb(); 83 } 84 85 uint8_t matrix_scan(void) 86 { 87 for (int col = 0; col < MATRIX_COLS; col++) { 88 matrix_row_t data = 0; 89 switch (col) { 90 case 0: palSetLine(LINE_COL_1); break; 91 case 1: palSetLine(LINE_COL_2); break; 92 case 2: palSetLine(LINE_COL_3); break; 93 case 3: palSetLine(LINE_COL_4); break; 94 case 4: palSetLine(LINE_COL_5); break; 95 case 5: palSetLine(LINE_COL_6); break; 96 case 6: palSetLine(LINE_COL_7); break; 97 case 7: palSetLine(LINE_COL_8); break; 98 case 8: palSetLine(LINE_COL_9); break; 99 case 9: palSetLine(LINE_COL_10); break; 100 case 10: palSetLine(LINE_COL_11); break; 101 case 11: palSetLine(LINE_COL_12); break; 102 case 12: palSetLine(LINE_COL_13); break; 103 case 13: palSetLine(LINE_COL_14); break; 104 case 14: palSetLine(LINE_COL_15); break; 105 } 106 107 // need wait to settle pin state 108 wait_us(20); 109 110 data = ( 111 (palReadLine(LINE_ROW_1) << 0 ) | 112 (palReadLine(LINE_ROW_2) << 1 ) | 113 (palReadLine(LINE_ROW_3) << 2 ) | 114 (palReadLine(LINE_ROW_4) << 3 ) | 115 (palReadLine(LINE_ROW_5) << 4 ) 116 ); 117 118 switch (col) { 119 case 0: palClearLine(LINE_COL_1); break; 120 case 1: palClearLine(LINE_COL_2); break; 121 case 2: palClearLine(LINE_COL_3); break; 122 case 3: palClearLine(LINE_COL_4); break; 123 case 4: palClearLine(LINE_COL_5); break; 124 case 5: palClearLine(LINE_COL_6); break; 125 case 6: palClearLine(LINE_COL_7); break; 126 case 7: palClearLine(LINE_COL_8); break; 127 case 8: palClearLine(LINE_COL_9); break; 128 case 9: palClearLine(LINE_COL_10); break; 129 case 10: palClearLine(LINE_COL_11); break; 130 case 11: palClearLine(LINE_COL_12); break; 131 case 12: palClearLine(LINE_COL_13); break; 132 case 13: palClearLine(LINE_COL_14); break; 133 case 14: palClearLine(LINE_COL_15); break; 134 } 135 136 if (matrix_debouncing[col] != data) { 137 matrix_debouncing[col] = data; 138 debouncing = true; 139 debouncing_time = timer_read(); 140 } 141 } 142 143 if (debouncing && timer_elapsed(debouncing_time) > DEBOUNCE) { 144 for (int row = 0; row < MATRIX_ROWS; row++) { 145 matrix[row] = 0; 146 for (int col = 0; col < MATRIX_COLS; col++) { 147 matrix[row] |= ((matrix_debouncing[col] & (1 << row) ? 1 : 0) << col); 148 } 149 } 150 debouncing = false; 151 } 152 153 matrix_scan_kb(); 154 155 return 1; 156 } 157 158 bool matrix_is_on(uint8_t row, uint8_t col) { return (matrix[row] & (1<<col)); } 159 160 matrix_row_t matrix_get_row(uint8_t row) { return matrix[row]; } 161 162 void matrix_print(void) 163 { 164 xprintf("\nr/c 01234567\n"); 165 for (uint8_t row = 0; row < MATRIX_ROWS; row++) { 166 xprintf("%X0: ", row); 167 matrix_row_t data = matrix_get_row(row); 168 for (int col = 0; col < MATRIX_COLS; col++) { 169 if (data & (1<<col)) 170 xprintf("1"); 171 else 172 xprintf("0"); 173 } 174 xprintf("\n"); 175 } 176 }