logo

qmk_firmware

custom branch of QMK firmware git clone https://anongit.hacktivis.me/git/qmk_firmware.git

matrix.c (1796B)

    

  1. // Copyright 2023 QMK
  2. // SPDX-License-Identifier: GPL-2.0-or-later
  4. #include "matrix.h"
  6. static matrix_row_t read_row(uint8_t row) {
  7.     matrix_io_delay();  // without this wait read unstable value.
  9.     // keypad and program buttons
  10.     if (row == 12) {
  11.         return ~(gpio_read_pin(B4) | (gpio_read_pin(B5) << 1) | 0b11111100);
  12.     }
  14.     return ~(gpio_read_pin(B6) | gpio_read_pin(B2) << 1 | gpio_read_pin(B3) << 2 | gpio_read_pin(B1) << 3 | gpio_read_pin(F7) << 4 | gpio_read_pin(F6) << 5 | gpio_read_pin(F5) << 6 | gpio_read_pin(F4) << 7);
  15. }
  17. static void unselect_rows(void) {
  18.     // set A,B,C,G to 0
  19.     PORTD &= 0xF0;
  20. }
  22. static void select_rows(uint8_t row) {
  23.     // set A,B,C,G to row value
  24.     PORTD |= (0x0F & row);
  25. }
  27. void matrix_init_custom(void) {
  28.     // output low (multiplexers)
  29.     gpio_set_pin_output(D0);
  30.     gpio_set_pin_output(D1);
  31.     gpio_set_pin_output(D2);
  32.     gpio_set_pin_output(D3);
  34.     // input with pullup (matrix)
  35.     gpio_set_pin_input_high(B6);
  36.     gpio_set_pin_input_high(B2);
  37.     gpio_set_pin_input_high(B3);
  38.     gpio_set_pin_input_high(B1);
  39.     gpio_set_pin_input_high(F7);
  40.     gpio_set_pin_input_high(F6);
  41.     gpio_set_pin_input_high(F5);
  42.     gpio_set_pin_input_high(F4);
  44.     // input with pullup (program and keypad buttons)
  45.     gpio_set_pin_input_high(B4);
  46.     gpio_set_pin_input_high(B5);
  48.     // initialize row and col
  49.     unselect_rows();
  50. }
  52. bool matrix_scan_custom(matrix_row_t current_matrix[]) {
  53.     bool matrix_has_changed = false;
  55.     for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
  56.         select_rows(i);
  57.         matrix_row_t row = read_row(i);
  58.         unselect_rows();
  59.         bool row_has_changed = current_matrix[i] != row;
  60.         matrix_has_changed |= row_has_changed;
  61.         current_matrix[i] = row;
  62.     }
  64.     return matrix_has_changed;
  65. }