110 lines
3.1 KiB
C
110 lines
3.1 KiB
C
|
/*
|
||
|
|
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);
|
||
|
|
}
|