fork/GramFirmware

git clone https://git.julia.blue/fork/GramFirmware

Jonathan HaylettMerge pull request #7 from JonnyHaystack/v23ab6a9b

master
2.6 KiB90 linesraw
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 {
12    ROW2COL,
13    COL2ROW,
14};
15
16typedef bool InputState::*SwitchMatrixElement;
17
18template <size_t num_rows, size_t num_cols> class SwitchMatrixInput : public InputSource {
19  public:
20    SwitchMatrixInput(
21        uint row_pins[num_rows],
22        uint col_pins[num_cols],
23        SwitchMatrixElement (&matrix)[num_rows][num_cols],
24        DiodeDirection direction
25    )
26        : _matrix(matrix) {
27        _direction = direction;
28
29        if (_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.
42        for (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.
47        for (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.
54        for (size_t i = 0; i < _num_outputs; i++) {
55            gpio::init_pin(_output_pins[i], gpio::GpioMode::GPIO_INPUT_PULLUP);
56        }
57    }
58
59    InputScanSpeed ScanSpeed() { return InputScanSpeed::FAST; }
60
61    void UpdateInputs(InputState &inputs) {
62        for (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.
68            for (size_t j = 0; j < _num_inputs; j++) {
69                SwitchMatrixElement button =
70                    _direction == DiodeDirection::ROW2COL ? _matrix[j][i] : _matrix[i][j];
71                if (button != nullptr) {
72                    inputs.*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
81  protected:
82    size_t _num_outputs;
83    size_t _num_inputs;
84    uint *_output_pins;
85    uint *_input_pins;
86    SwitchMatrixElement (&_matrix)[num_rows][num_cols];
87    DiodeDirection _direction;
88};
89
90#endif