logo

qmk_firmware

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

matrix.c (6167B)

    

  1. /*
  2. Copyright 2016-2017 Ralf Schmitt <ralf@bunkertor.net> Rasmus Schults <rasmusx@gmail.com>
  3. This program is free software: you can redistribute it and/or modify
  4. it under the terms of the GNU General Public License as published by
  5. the Free Software Foundation, either version 2 of the License, or
  6. (at your option) any later version.
  8. This program is distributed in the hope that it will be useful,
  9. but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  11. GNU General Public License for more details.
  13. You should have received a copy of the GNU General Public License
  14. along with this program.  If not, see <http://www.gnu.org/licenses/>.
  15. */
  17. #include <util/delay.h>
  18. #include <avr/io.h>
  19. #include <stdio.h>
  20. #include "matrix.h"
  21. #include "util.h"
  22. #include "print.h"
  23. #include "debug.h"
  25. #ifndef DEBOUNCE
  26. #    define DEBOUNCE 5
  27. #endif
  29. static uint8_t debouncing = DEBOUNCE;
  31. /* matrix state(1:on, 0:off) */
  32. static matrix_row_t matrix[MATRIX_ROWS];
  33. static matrix_row_t matrix_debouncing[MATRIX_ROWS];
  35. static uint8_t read_rows(void);
  36. static uint8_t read_fwkey(void);
  37. static void init_rows(void);
  38. static void unselect_cols(void);
  39. static void select_col(uint8_t col);
  42. __attribute__ ((weak))
  43. void matrix_init_kb(void) {
  44.     matrix_init_user();
  45. }
  47. __attribute__ ((weak))
  48. void matrix_scan_kb(void) {
  49.     matrix_scan_user();
  50. }
  52. __attribute__ ((weak))
  53. void matrix_init_user(void) {
  54. }
  56. __attribute__ ((weak))
  57. void matrix_scan_user(void) {
  58. }
  60. void matrix_init(void) {
  61.   DDRD  |=  0b11010000;
  62.   PORTD &= ~0b01010000;
  63.   DDRB  |=  0b00011111;
  64.   PORTB &= ~0b00001110;
  65.   PORTB |=  0b00010001;
  66.   DDRE  |=  0b01000000;
  67.   PORTE &= ~0b01000000;
  69.   unselect_cols();
  70.   init_rows();
  72.   for (uint8_t i=0; i < MATRIX_ROWS; i++)  {
  73.     matrix[i] = 0;
  74.     matrix_debouncing[i] = 0;
  75.   }
  77.   matrix_init_kb();
  78. }
  80. uint8_t matrix_scan(void) {
  81.   for (uint8_t col = 0; col < MATRIX_COLS; col++) {
  82.     select_col(col);
  83.     _delay_us(3);
  85.     uint8_t rows = read_rows();
  86.     if(col == 0) {
  87.       rows |= read_fwkey();
  88.     }
  89.     for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
  90.       bool prev_bit = matrix_debouncing[row] & ((matrix_row_t)1<<col);
  91.       bool curr_bit = rows & (1<<row);
  92.       if (prev_bit != curr_bit) {
  93.         matrix_debouncing[row] ^= ((matrix_row_t)1<<col);
  94.         if (debouncing) {
  95.             dprint("bounce!: "); dprintf("%02X", debouncing); dprintln();
  96.         }        
  97.         debouncing = DEBOUNCE;
  98.       }
  99.     }
  100.     unselect_cols();
  101.   }
  103.   if (debouncing) {
  104.     if (--debouncing) {
  105.       _delay_ms(1);
  106.     } else {
  107.       for (uint8_t i = 0; i < MATRIX_ROWS; i++) {
  108.         matrix[i] = matrix_debouncing[i];
  109.       }
  110.     }
  111.   }
  113.   matrix_scan_kb();
  114.   return 1;
  115. }
  117. inline matrix_row_t matrix_get_row(uint8_t row) {
  118.   return matrix[row];
  119. }
  121. void matrix_print(void) {
  122.   print("\nr/c 0123456789ABCDEF\n");
  123.   for (uint8_t row = 0; row < MATRIX_ROWS; row++) {
  124.     xprintf("%02X: %032lb\n", row, bitrev32(matrix_get_row(row)));
  125.   }
  126. }
  128. /* Row pin configuration
  129.  * row: 0    1    2    3    4    5
  130.  * pin: PB7  PD0  PD1  PD2  PD3  PD5
  131.  *
  132.  * Esc uses its own pin PE2
  133.  */
  134. static void init_rows(void) {
  135.   DDRB  &= ~0b10000000;
  136.   PORTB &= ~0b10000000;
  138.   DDRD  &= ~0b00101111;
  139.   PORTD &= ~0b00101111;
  141.   DDRE  &= ~0b00000100;
  142.   PORTE |=  0b00000100;
  143. }
  145. static uint8_t read_rows(void) {
  146.   return (PINB&(1<<7) ? (1<<0) : 0) |
  147.     (PIND&(1<<0) ? (1<<1) : 0) |
  148.     (PIND&(1<<1) ? (1<<2) : 0) |
  149.     (PIND&(1<<2) ? (1<<3) : 0) |
  150.     (PIND&(1<<3) ? (1<<4) : 0) |
  151.     (PIND&(1<<5) ? (1<<5) : 0);
  152. }
  154. static uint8_t read_fwkey(void)
  155. {
  156.   return PINE&(1<<2) ? 0 : (1<<0);
  157. }
  159. /* Columns 0 - 15
  160.  * These columns uses two 74HC237D 3 to 8 bit demultiplexers.
  161.  * col / pin:    PC6  PB6  PF0  PF1  PC7
  162.  * 0:             1    0    0    0    0
  163.  * 1:             1    0    1    0    0
  164.  * 2:             1    0    0    1    0
  165.  * 3:             1    0    1    1    0
  166.  * 4:             1    0    0    0    1
  167.  * 5:             1    0    1    0    1
  168.  * 6:             1    0    0    1    1
  169.  * 7:             1    0    1    1    1
  170.  * 8:             0    1    0    0    0
  171.  * 9:             0    1    1    0    0
  172.  * 10:            0    1    0    1    0
  173.  * 11:            0    1    1    1    0
  174.  * 12:            0    1    0    0    1
  175.  * 13:            0    1    1    0    1
  176.  * 14:            0    1    0    1    1
  177.  * 15:            0    1    1    1    1
  178.  *
  179.  * col: 16
  180.  * pin: PB5
  181.  *
  182.  * col: 17
  183.  * pin: PB4
  184.  *
  185.  * col: 18
  186.  * pin: PD7
  187.  */
  188. static void unselect_cols(void) {
  189.   DDRB  |=  0b01110000;
  190.   PORTB &= ~0b01110000;
  192.   DDRC |= (1<<6) | (1<<7);
  193.   PORTC &= ~((1<<6) | (1<<7));
  195.   DDRF |= (1<<0) | (1<<1);
  196.   PORTF &= ~((1<<0) | (1<<1));
  198.   DDRD |= (1<<7);
  199.   PORTD &= ~(1<<7);
  200. }
  202. static void select_col(uint8_t col) {
  203.   switch (col) {
  204.     case 0:
  205.       PORTC |= (1<<6);
  206.       break;
  207.     case 1:
  208.       PORTC |= (1<<6);
  209.       PORTF |= (1<<0);
  210.       break;
  211.     case 2:
  212.       PORTC |= (1<<6);
  213.       PORTF |= (1<<1);
  214.       break;
  215.     case 3:
  216.       PORTC |= (1<<6);
  217.       PORTF |= (1<<0) | (1<<1);
  218.       break;
  219.     case 4:
  220.       PORTC |= (1<<6);
  221.       PORTC |= (1<<7);
  222.       break;
  223.     case 5:
  224.       PORTC |= (1<<6);
  225.       PORTF |= (1<<0);
  226.       PORTC |= (1<<7);
  227.       break;
  228.     case 6:
  229.       PORTC |= (1<<6);
  230.       PORTF |= (1<<1);
  231.       PORTC |= (1<<7);
  232.       break;
  233.     case 7:
  234.       PORTC |= (1<<6);
  235.       PORTF |= (1<<0) | (1<<1);
  236.       PORTC |= (1<<7);
  237.       break;
  238.     case 8:
  239.       PORTB |= (1<<6);
  240.       break;
  241.     case 9:
  242.       PORTB |= (1<<6);
  243.       PORTF |= (1<<0);
  244.       break;
  245.     case 10:
  246.       PORTB |= (1<<6);
  247.       PORTF |= (1<<1);
  248.       break;
  249.     case 11:
  250.       PORTB |= (1<<6);
  251.       PORTF |= (1<<0) | (1<<1);
  252.       break;
  253.     case 12:
  254.       PORTB |= (1<<6);
  255.       PORTC |= (1<<7);
  256.       break;
  257.     case 13:
  258.       PORTB |= (1<<6);
  259.       PORTF |= (1<<0);
  260.       PORTC |= (1<<7);
  261.       break;
  262.     case 14:
  263.       PORTB |= (1<<6);
  264.       PORTF |= (1<<1);
  265.       PORTC |= (1<<7);
  266.       break;
  267.     case 15:
  268.       PORTB |= (1<<6);
  269.       PORTF |= (1<<0) | (1<<1);
  270.       PORTC |= (1<<7);
  271.       break;
  272.     case 16:
  273.       PORTB |= (1<<5);
  274.       break;
  275.     case 17:
  276.       PORTB |= (1<<4);
  277.       break;
  278.     case 18:
  279.       PORTD |= (1<<7);
  280.       break;
  281.   }
  282. }