keyboards/mt40/matrix.c

   1 /*
   2 Copyright 2017 Luiz Ribeiro <luizribeiro@gmail.com>
   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
  18 #include <avr/io.h>
  19 #include <util/delay.h>
  20
  21 #include "matrix.h"
  22 #include "config.h"
  23
  24 #ifndef DEBOUNCE
  25 #   define DEBOUNCE     5
  26 #endif
  27
  28 static uint8_t debouncing = DEBOUNCE;
  29
  30 static matrix_row_t matrix[MATRIX_ROWS];
  31 static matrix_row_t matrix_debouncing[MATRIX_ROWS];
  32
  33 __attribute__ ((weak))
  34 void matrix_init_kb(void) {
  35     matrix_init_user();
  36 }
  37
  38 __attribute__ ((weak))
  39 void matrix_scan_kb(void) {
  40     matrix_scan_user();
  41 }
  42
  43 __attribute__ ((weak))
  44 void matrix_init_user(void) {
  45 }
  46
  47 __attribute__ ((weak))
  48 void matrix_scan_user(void) {
  49 }
  50
  51
  52
  53 void matrix_init(void) {
  54     // all outputs for rows high
  55     DDRB = 0xFF;
  56     PORTB = 0xFF;
  57     // all inputs for columns
  58     DDRA = 0x00;
  59     DDRC &= ~(0x111111<<2);
  60     DDRD &= ~(1<<PIND7);
  61     // all columns are pulled-up
  62     PORTA = 0xFF;
  63     PORTC |= (0b111111<<2);
  64     PORTD |= (1<<PIND7);
  65
  66     // initialize matrix state: all keys off
  67     for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
  68         matrix[row] = 0x00;
  69         matrix_debouncing[row] = 0x00;
  70     }
  71     matrix_init_kb();
  72 }
  73
  74 void matrix_set_row_status(uint8_t row) {
  75     DDRB = (1 << row);
  76     PORTB = ~(1 << row);
  77 }
  78
  79 uint8_t bit_reverse(uint8_t x) {
  80     x = ((x >> 1) & 0x55) | ((x << 1) & 0xaa);
  81     x = ((x >> 2) & 0x33) | ((x << 2) & 0xcc);
  82     x = ((x >> 4) & 0x0f) | ((x << 4) & 0xf0);
  83     return x;
  84 }
  85
  86 uint8_t matrix_scan(void) {
  87     for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
  88         matrix_set_row_status(row);
  89         _delay_us(5);
  90
  91         matrix_row_t cols = (
  92             // cols 0..7, PORTA 0 -> 7
  93             (~PINA) & 0xFF
  94         ) | (
  95             // cols 8..13, PORTC 7 -> 0
  96             bit_reverse((~PINC) & 0xFF) << 8
  97         ) | (
  98             // col 14, PORTD 7
  99             ((~PIND) & (1 << PIND7)) << 7
 100         );
 101
 102         if (matrix_debouncing[row] != cols) {
 103             matrix_debouncing[row] = cols;
 104             debouncing = DEBOUNCE;
 105         }
 106     }
 107
 108     if (debouncing) {
 109         if (--debouncing) {
 110             _delay_ms(1);
 111         } else {
 112             for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
 113                 matrix[i] = matrix_debouncing[i];
 114             }
 115         }
 116     }
 117
 118     matrix_scan_kb();
 119
 120     return 1;
 121 }
 122
 123 inline matrix_row_t matrix_get_row(uint8_t row) {
 124     return matrix[row];
 125 }
 126
 127 void matrix_print(void) {
 128 }