#ifndef _INPUT_SWITCHMATRIXINPUT_HPP #define _INPUT_SWITCHMATRIXINPUT_HPP #include "core/InputSource.hpp" #include "core/state.hpp" #include "gpio.hpp" #define BTN(x) &InputState::x #define NA nullptr enum class DiodeDirection { ROW2COL, COL2ROW, }; typedef bool InputState::*SwitchMatrixElement; template class SwitchMatrixInput : public InputSource { public: SwitchMatrixInput( uint row_pins[num_rows], uint col_pins[num_cols], SwitchMatrixElement (&matrix)[num_rows][num_cols], DiodeDirection direction ) : _matrix(matrix) { _direction = direction; if (_direction == DiodeDirection::ROW2COL) { _num_outputs = num_cols; _num_inputs = num_rows; _output_pins = col_pins; _input_pins = row_pins; } else { _num_outputs = num_rows; _num_inputs = num_cols; _output_pins = row_pins; _input_pins = col_pins; } // Initialize output pins. for (size_t i = 0; i < _num_outputs; i++) { gpio::init_pin(_output_pins[i], gpio::GpioMode::GPIO_INPUT_PULLUP); } // Initialize input pins. for (size_t i = 0; i < _num_inputs; i++) { gpio::init_pin(_input_pins[i], gpio::GpioMode::GPIO_INPUT_PULLUP); } } ~SwitchMatrixInput() { // Make sure all pins are set back to inputs. for (size_t i = 0; i < _num_outputs; i++) { gpio::init_pin(_output_pins[i], gpio::GpioMode::GPIO_INPUT_PULLUP); } } InputScanSpeed ScanSpeed() { return InputScanSpeed::FAST; } void UpdateInputs(InputState &inputs) { for (size_t i = 0; i < _num_outputs; i++) { // Activate the column/row. gpio::init_pin(_output_pins[i], gpio::GpioMode::GPIO_OUTPUT); gpio::write_digital(_output_pins[i], 0); // Read each cell in the column/row. for (size_t j = 0; j < _num_inputs; j++) { SwitchMatrixElement button = _direction == DiodeDirection::ROW2COL ? _matrix[j][i] : _matrix[i][j]; if (button != nullptr) { inputs.*button = !gpio::read_digital(_input_pins[j]); } } // Deactivate the column/row. gpio::init_pin(_output_pins[i], gpio::GpioMode::GPIO_INPUT_PULLUP); } } protected: size_t _num_outputs; size_t _num_inputs; uint *_output_pins; uint *_input_pins; SwitchMatrixElement (&_matrix)[num_rows][num_cols]; DiodeDirection _direction; }; #endif