/* Copyright 2014 Ralf Schmitt <ralf@bunkertor.net> Modified by Ryan Skidmore <rskeys@ryanskidmore.co.uk> (@ryanskidmore) to support the rskeys100. 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 <http://www.gnu.org/licenses/>. */ #include <stdbool.h> #include "matrix.h" #include <util/delay.h> #include "quantum.h" static const uint32_t col_values[24] = SHR_COLS; static uint8_t read_rows(void); static void select_col(uint8_t col); static void shift_pulse(void); static void shift_out_single(uint8_t value); static void shift_out(uint32_t value); void matrix_init_custom(void) { setPinInput(ROW_A); setPinInput(ROW_B); setPinInput(ROW_C); setPinInput(ROW_D); setPinInput(ROW_E); setPinInput(ROW_F); setPinOutput(SHR_DATA); setPinOutput(SHR_LATCH); setPinOutput(SHR_CLOCK); } bool matrix_scan_custom(matrix_row_t current_matrix[]) { bool changed = false; for (uint8_t col = 0; col < MATRIX_COLS; col++) { select_col(col); _delay_us(1); uint8_t rows = read_rows(); for (uint8_t row = 0; row < MATRIX_ROWS; row++) { bool prev_bit = ((uint32_t)(current_matrix[row]) & (matrix_row_t)(1UL << col)) ? 1 : 0; bool curr_bit = ((uint32_t)rows & (uint32_t)(1UL << row)) ? 1 : 0; if (prev_bit != curr_bit) { current_matrix[row] = (uint32_t)(current_matrix[row]) ^ (uint32_t)(1UL << col); changed = true; } } } return changed; } static uint8_t read_rows(void) { return (readPin(ROW_F) << 5) | (readPin(ROW_E) << 4) | (readPin(ROW_D) << 3) | (readPin(ROW_C) << 2) | (readPin(ROW_B) << 1) | (readPin(ROW_A) ); } static void select_col(uint8_t col) { shift_out(col_values[col]); } static void shift_out(uint32_t value) { writePinLow(SHR_LATCH); uint8_t first_byte = (value >> 16) & 0xFF; uint8_t second_byte = (value >> 8) & 0xFF; uint8_t third_byte = (uint8_t)(value & 0xFF); shift_out_single(first_byte); shift_out_single(second_byte); shift_out_single(third_byte); writePinHigh(SHR_LATCH); /* We delay here to prevent multiple consecutive keys being triggered with a single switch press */ _delay_us(10); } static void shift_out_single(uint8_t value) { for (uint8_t i = 0; i < 8; i++) { if (value & 0b10000000) { writePinHigh(SHR_DATA); } else { writePinLow(SHR_DATA); } shift_pulse(); value = value << 1; } } static inline void shift_pulse(void) { writePinHigh(SHR_CLOCK); writePinLow(SHR_CLOCK); }