fork/GramFirmware
git clone https://git.julia.blue/fork/GramFirmware
3ab6a9b
v0.1.0
1#ifndef _INPUT_SWITCHMATRIXINPUT_HPP 2#define _INPUT_SWITCHMATRIXINPUT_HPP 3 4#include "core/InputSource.hpp" 5#include "core/state.hpp" 6#include "gpio.hpp" 7 8#define BTN (x ) &InputState::x 9#define NA nullptr 10 11enum class DiodeDirection { 12ROW2COL , 13COL2ROW , 14}; 15 16typedef bool InputState ::* SwitchMatrixElement ; 17 18template < size_t num_rows ,size_t num_cols > class SwitchMatrixInput :public InputSource { 19public : 20SwitchMatrixInput ( 21uint row_pins [num_rows ], 22uint col_pins [num_cols ], 23SwitchMatrixElement (& matrix )[num_rows ][num_cols ], 24DiodeDirection direction 25 ) 26 :_matrix (matrix ) { 27_direction = direction ; 28 29if (_direction == DiodeDirection ::ROW2COL ) { 30_num_outputs = num_cols ; 31_num_inputs = num_rows ; 32_output_pins = col_pins ; 33_input_pins = row_pins ; 34 }else { 35_num_outputs = num_rows ; 36_num_inputs = num_cols ; 37_output_pins = row_pins ; 38_input_pins = col_pins ; 39 } 40 41// Initialize output pins. 42for (size_t i = 0 ;i < _num_outputs ;i ++ ) { 43 gpio::init_pin (_output_pins [i ], gpio::GpioMode ::GPIO_INPUT_PULLUP ); 44 } 45 46// Initialize input pins. 47for (size_t i = 0 ;i < _num_inputs ;i ++ ) { 48 gpio::init_pin (_input_pins [i ], gpio::GpioMode ::GPIO_INPUT_PULLUP ); 49 } 50 } 51 52 ~SwitchMatrixInput () { 53// Make sure all pins are set back to inputs. 54for (size_t i = 0 ;i < _num_outputs ;i ++ ) { 55 gpio::init_pin (_output_pins [i ], gpio::GpioMode ::GPIO_INPUT_PULLUP ); 56 } 57 } 58 59InputScanSpeed ScanSpeed () {return InputScanSpeed ::FAST ; } 60 61void UpdateInputs (InputState & inputs ) { 62for (size_t i = 0 ;i < _num_outputs ;i ++ ) { 63// Activate the column/row. 64 gpio::init_pin (_output_pins [i ], gpio::GpioMode ::GPIO_OUTPUT ); 65 gpio::write_digital (_output_pins [i ],0 ); 66 67// Read each cell in the column/row. 68for (size_t j = 0 ;j < _num_inputs ;j ++ ) { 69SwitchMatrixElement button = 70_direction == DiodeDirection ::ROW2COL ?_matrix [j ][i ] :_matrix [i ][j ]; 71if (button != nullptr ) { 72inputs .*button = !gpio::read_digital (_input_pins [j ]); 73 } 74 } 75 76// Deactivate the column/row. 77 gpio::init_pin (_output_pins [i ], gpio::GpioMode ::GPIO_INPUT_PULLUP ); 78 } 79 } 80 81protected : 82size_t _num_outputs ; 83size_t _num_inputs ; 84uint * _output_pins ; 85uint * _input_pins ; 86SwitchMatrixElement (& _matrix )[num_rows ][num_cols ]; 87DiodeDirection _direction ; 88}; 89 90#endif