/* Copyright 2017 Gabriel Young This program is free software: you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation, either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program. If not, see . */ #include #include #include #include #include "print.h" #include "debug.h" #include "util.h" #include "matrix.h" #define CONFIG_LED_IO \ DDRB |= (1<<7); \ DDRC |= (1<<5) | (1<<6); #define USB_LED_CAPS_LOCK_ON PORTC &= ~(1<<5) #define USB_LED_CAPS_LOCK_OFF PORTC |= (1<<5) #define USB_LED_NUM_LOCK_ON PORTB &= ~(1<<7) #define USB_LED_NUM_LOCK_OFF PORTB |= (1<<7) #define USB_LED_SCROLL_LOCK_ON PORTC &= ~(1<<6) #define USB_LED_SCROLL_LOCK_OFF PORTC |= (1<<6) #ifndef DEBOUNCING_DELAY # define DEBOUNCING_DELAY 5 #endif static uint8_t debouncing = DEBOUNCING_DELAY; static matrix_row_t matrix[MATRIX_ROWS]; static matrix_row_t matrix_debouncing[MATRIX_ROWS]; static matrix_row_t scan_col(void); static void select_col(uint8_t row); void matrix_init(void) { /* Row output pins */ DDRD |= 0b01111011; /* Column input pins */ DDRC &= ~0b10000000; DDRB &= ~0b01111111; PORTC |= 0b10000000; PORTB |= 0b01111111; for (uint8_t i=0; i < MATRIX_ROWS; i++) matrix[i] = matrix_debouncing[i] = 0; matrix_init_quantum(); } uint8_t matrix_scan(void) { for (uint8_t col = 0; col < MATRIX_COLS; col++) { select_col(col); _delay_us(3); matrix_row_t col_scan = scan_col(); for (uint8_t row = 0; row < MATRIX_ROWS; row++) { bool prev_bit = matrix_debouncing[row] & ((matrix_row_t)1<