keyboards/jj50/matrix.c

   1 /*
   2 Copyright 2017 Luiz Ribeiro <luizribeiro@gmail.com>
   3 Modified 2018 by Wayne K Jones <github.com/WarmCatUK>
   4
   5 This program is free software: you can redistribute it and/or modify
   6 it under the terms of the GNU General Public License as published by
   7 the Free Software Foundation, either version 2 of the License, or
   8 (at your option) any later version.
   9
  10 This program is distributed in the hope that it will be useful,
  11 but WITHOUT ANY WARRANTY; without even the implied warranty of
  12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13 GNU General Public License for more details.
  14
  15 You should have received a copy of the GNU General Public License
  16 along with this program.  If not, see <http://www.gnu.org/licenses/>.
  17 */
  18
  19 #include <avr/io.h>
  20 #include <util/delay.h>
  21
  22 #include "matrix.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 void matrix_init(void) {
  34     // all outputs for rows high
  35     DDRB = 0xFF;
  36     PORTB = 0xFF;
  37     // all inputs for columns
  38     DDRA = 0x00;
  39     DDRC &= ~(0x111111<<2);
  40     //----> DDRD &= ~(1<<PIND7);
  41     // Port D not used on this keyboard
  42     // all columns are pulled-up
  43     PORTA = 0xFF;
  44     PORTC |= (0b111111<<2);
  45     //PORTD |= (1<<PIND7);
  46     // Port D not used on this keyboard
  47
  48     // initialize matrix state: all keys off
  49     for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
  50         matrix[row] = 0x00;
  51         matrix_debouncing[row] = 0x00;
  52     }
  53     matrix_init_quantum();  // missing from original port by Luiz
  54 }
  55
  56 void matrix_set_row_status(uint8_t row) {
  57     DDRB = (1 << row);
  58     PORTB = ~(1 << row);
  59 }
  60
  61 uint8_t bit_reverse(uint8_t x) {
  62     x = ((x >> 1) & 0x55) | ((x << 1) & 0xaa);
  63     x = ((x >> 2) & 0x33) | ((x << 2) & 0xcc);
  64     x = ((x >> 4) & 0x0f) | ((x << 4) & 0xf0);
  65     return x;
  66 }
  67
  68 uint8_t matrix_scan(void) {
  69     for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
  70         matrix_set_row_status(row);
  71         _delay_us(5);
  72
  73         matrix_row_t cols = (
  74             // cols 0..7, PORTA 0 -> 7
  75             (~PINA) & 0xFF
  76         ) | (
  77             // cols 8..13, PORTC 7 -> 0
  78             bit_reverse((~PINC) & 0xFF) << 8
  79         );
  80
  81         if (matrix_debouncing[row] != cols) {
  82             matrix_debouncing[row] = cols;
  83             debouncing = DEBOUNCE;
  84         }
  85     }
  86
  87     if (debouncing) {
  88         if (--debouncing) {
  89             _delay_ms(1);
  90         } else {
  91             for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
  92                 matrix[i] = matrix_debouncing[i];
  93             }
  94         }
  95     }
  96     matrix_scan_quantum();  // also missing in original PS2AVRGB implementation
  97     //matrix_scan_user();
  98
  99     return 1;
 100 }
 101
 102 inline matrix_row_t matrix_get_row(uint8_t row) {
 103     return matrix[row];
 104 }
 105
 106 void matrix_print(void) {
 107 }