quantum/matrix.c

   1 /*
   2 Copyright 2012-2018 Jun Wako, Jack Humbert, Yiancar
   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 #include <stdint.h>
  18 #include <stdbool.h>
  19 #include "wait.h"
  20 #include "print.h"
  21 #include "debug.h"
  22 #include "util.h"
  23 #include "matrix.h"
  24 #include "debounce.h"
  25 #include "quantum.h"
  26
  27 #if (MATRIX_COLS <= 8)
  28 #    define print_matrix_header()  print("\nr/c 01234567\n")
  29 #    define print_matrix_row(row)  print_bin_reverse8(matrix_get_row(row))
  30 #    define matrix_bitpop(i)       bitpop(matrix[i])
  31 #    define ROW_SHIFTER ((uint8_t)1)
  32 #elif (MATRIX_COLS <= 16)
  33 #    define print_matrix_header()  print("\nr/c 0123456789ABCDEF\n")
  34 #    define print_matrix_row(row)  print_bin_reverse16(matrix_get_row(row))
  35 #    define matrix_bitpop(i)       bitpop16(matrix[i])
  36 #    define ROW_SHIFTER ((uint16_t)1)
  37 #elif (MATRIX_COLS <= 32)
  38 #    define print_matrix_header()  print("\nr/c 0123456789ABCDEF0123456789ABCDEF\n")
  39 #    define print_matrix_row(row)  print_bin_reverse32(matrix_get_row(row))
  40 #    define matrix_bitpop(i)       bitpop32(matrix[i])
  41 #    define ROW_SHIFTER  ((uint32_t)1)
  42 #endif
  43
  44 #ifdef MATRIX_MASKED
  45     extern const matrix_row_t matrix_mask[];
  46 #endif
  47
  48 #ifdef DIRECT_PINS
  49 static pin_t direct_pins[MATRIX_ROWS][MATRIX_COLS] = DIRECT_PINS;
  50 #elif (DIODE_DIRECTION == ROW2COL) || (DIODE_DIRECTION == COL2ROW)
  51 static const pin_t row_pins[MATRIX_ROWS] = MATRIX_ROW_PINS;
  52 static const pin_t col_pins[MATRIX_COLS] = MATRIX_COL_PINS;
  53 #endif
  54
  55 /* matrix state(1:on, 0:off) */
  56 static matrix_row_t raw_matrix[MATRIX_ROWS]; //raw values
  57 static matrix_row_t matrix[MATRIX_ROWS]; //debounced values
  58
  59 __attribute__ ((weak))
  60 void matrix_init_quantum(void) {
  61     matrix_init_kb();
  62 }
  63
  64 __attribute__ ((weak))
  65 void matrix_scan_quantum(void) {
  66     matrix_scan_kb();
  67 }
  68
  69 __attribute__ ((weak))
  70 void matrix_init_kb(void) {
  71     matrix_init_user();
  72 }
  73
  74 __attribute__ ((weak))
  75 void matrix_scan_kb(void) {
  76     matrix_scan_user();
  77 }
  78
  79 __attribute__ ((weak))
  80 void matrix_init_user(void) {
  81 }
  82
  83 __attribute__ ((weak))
  84 void matrix_scan_user(void) {
  85 }
  86
  87 inline
  88 uint8_t matrix_rows(void) {
  89     return MATRIX_ROWS;
  90 }
  91
  92 inline
  93 uint8_t matrix_cols(void) {
  94     return MATRIX_COLS;
  95 }
  96
  97 //Deprecated.
  98 bool matrix_is_modified(void)
  99 {
 100     if (debounce_active()) return false;
 101     return true;
 102 }
 103
 104 inline
 105 bool matrix_is_on(uint8_t row, uint8_t col)
 106 {
 107     return (matrix[row] & ((matrix_row_t)1<<col));
 108 }
 109
 110 inline
 111 matrix_row_t matrix_get_row(uint8_t row)
 112 {
 113     // Matrix mask lets you disable switches in the returned matrix data. For example, if you have a
 114     // switch blocker installed and the switch is always pressed.
 115 #ifdef MATRIX_MASKED
 116     return matrix[row] & matrix_mask[row];
 117 #else
 118     return matrix[row];
 119 #endif
 120 }
 121
 122 void matrix_print(void)
 123 {
 124     print_matrix_header();
 125
 126     for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
 127         phex(row); print(": ");
 128         print_matrix_row(row);
 129         print("\n");
 130     }
 131 }
 132
 133 uint8_t matrix_key_count(void)
 134 {
 135     uint8_t count = 0;
 136     for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
 137         count += matrix_bitpop(i);
 138     }
 139     return count;
 140 }
 141
 142
 143 #ifdef DIRECT_PINS
 144
 145 static void init_pins(void) {
 146   for (int row = 0; row < MATRIX_ROWS; row++) {
 147     for (int col = 0; col < MATRIX_COLS; col++) {
 148       pin_t pin = direct_pins[row][col];
 149       if (pin != NO_PIN) {
 150         setPinInputHigh(pin);
 151       }
 152     }
 153   }
 154 }
 155
 156 static bool read_cols_on_row(matrix_row_t current_matrix[], uint8_t current_row) {
 157   matrix_row_t last_row_value = current_matrix[current_row];
 158   current_matrix[current_row] = 0;
 159
 160   for (uint8_t col_index = 0; col_index < MATRIX_COLS; col_index++) {
 161     pin_t pin = direct_pins[current_row][col_index];
 162     if (pin != NO_PIN) {
 163       current_matrix[current_row] |= readPin(pin) ? 0 : (ROW_SHIFTER << col_index);
 164     }
 165   }
 166
 167   return (last_row_value != current_matrix[current_row]);
 168 }
 169
 170 #elif (DIODE_DIRECTION == COL2ROW)
 171
 172 static void select_row(uint8_t row)
 173 {
 174     setPinOutput(row_pins[row]);
 175     writePinLow(row_pins[row]);
 176 }
 177
 178 static void unselect_row(uint8_t row)
 179 {
 180     setPinInputHigh(row_pins[row]);
 181 }
 182
 183 static void unselect_rows(void)
 184 {
 185     for(uint8_t x = 0; x < MATRIX_ROWS; x++) {
 186         setPinInputHigh(row_pins[x]);
 187     }
 188 }
 189
 190 static void init_pins(void) {
 191   unselect_rows();
 192   for (uint8_t x = 0; x < MATRIX_COLS; x++) {
 193     setPinInputHigh(col_pins[x]);
 194   }
 195 }
 196
 197 static bool read_cols_on_row(matrix_row_t current_matrix[], uint8_t current_row)
 198 {
 199     // Store last value of row prior to reading
 200     matrix_row_t last_row_value = current_matrix[current_row];
 201
 202     // Clear data in matrix row
 203     current_matrix[current_row] = 0;
 204
 205     // Select row and wait for row selecton to stabilize
 206     select_row(current_row);
 207     wait_us(30);
 208
 209     // For each col...
 210     for(uint8_t col_index = 0; col_index < MATRIX_COLS; col_index++) {
 211
 212         // Select the col pin to read (active low)
 213         uint8_t pin_state = readPin(col_pins[col_index]);
 214
 215         // Populate the matrix row with the state of the col pin
 216         current_matrix[current_row] |=  pin_state ? 0 : (ROW_SHIFTER << col_index);
 217     }
 218
 219     // Unselect row
 220     unselect_row(current_row);
 221
 222     return (last_row_value != current_matrix[current_row]);
 223 }
 224
 225 #elif (DIODE_DIRECTION == ROW2COL)
 226
 227 static void select_col(uint8_t col)
 228 {
 229     setPinOutput(col_pins[col]);
 230     writePinLow(col_pins[col]);
 231 }
 232
 233 static void unselect_col(uint8_t col)
 234 {
 235     setPinInputHigh(col_pins[col]);
 236 }
 237
 238 static void unselect_cols(void)
 239 {
 240     for(uint8_t x = 0; x < MATRIX_COLS; x++) {
 241         setPinInputHigh(col_pins[x]);
 242     }
 243 }
 244
 245 static void init_pins(void) {
 246   unselect_cols();
 247   for (uint8_t x = 0; x < MATRIX_ROWS; x++) {
 248     setPinInputHigh(row_pins[x]);
 249   }
 250 }
 251
 252 static bool read_rows_on_col(matrix_row_t current_matrix[], uint8_t current_col)
 253 {
 254     bool matrix_changed = false;
 255
 256     // Select col and wait for col selecton to stabilize
 257     select_col(current_col);
 258     wait_us(30);
 259
 260     // For each row...
 261     for(uint8_t row_index = 0; row_index < MATRIX_ROWS; row_index++)
 262     {
 263
 264         // Store last value of row prior to reading
 265         matrix_row_t last_row_value = current_matrix[row_index];
 266
 267         // Check row pin state
 268         if (readPin(row_pins[row_index]) == 0)
 269         {
 270             // Pin LO, set col bit
 271             current_matrix[row_index] |= (ROW_SHIFTER << current_col);
 272         }
 273         else
 274         {
 275             // Pin HI, clear col bit
 276             current_matrix[row_index] &= ~(ROW_SHIFTER << current_col);
 277         }
 278
 279         // Determine if the matrix changed state
 280         if ((last_row_value != current_matrix[row_index]) && !(matrix_changed))
 281         {
 282             matrix_changed = true;
 283         }
 284     }
 285
 286     // Unselect col
 287     unselect_col(current_col);
 288
 289     return matrix_changed;
 290 }
 291
 292 #endif
 293
 294 void matrix_init(void) {
 295
 296     // initialize key pins
 297     init_pins();
 298
 299     // initialize matrix state: all keys off
 300     for (uint8_t i=0; i < MATRIX_ROWS; i++) {
 301         raw_matrix[i] = 0;
 302         matrix[i] = 0;
 303     }
 304
 305     debounce_init(MATRIX_ROWS);
 306
 307     matrix_init_quantum();
 308 }
 309
 310 uint8_t matrix_scan(void)
 311 {
 312   bool changed = false;
 313
 314 #if defined(DIRECT_PINS) || (DIODE_DIRECTION == COL2ROW)
 315   // Set row, read cols
 316   for (uint8_t current_row = 0; current_row < MATRIX_ROWS; current_row++) {
 317     changed |= read_cols_on_row(raw_matrix, current_row);
 318   }
 319 #elif (DIODE_DIRECTION == ROW2COL)
 320   // Set col, read rows
 321   for (uint8_t current_col = 0; current_col < MATRIX_COLS; current_col++) {
 322     changed |= read_rows_on_col(raw_matrix, current_col);
 323   }
 324 #endif
 325
 326   debounce(raw_matrix, matrix, MATRIX_ROWS, changed);
 327
 328   matrix_scan_quantum();
 329   return (uint8_t)changed;
 330 }