fork/GramFirmware

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

CarVacrebase to configurator818d962

gram
1.1 KiB47 linesraw
1#include "input/Pca9671Input.hpp"
2
3#include "util/state_util.hpp"
4
5Pca9671Input::Pca9671Input(
6    const Pca9671ButtonMapping *button_mappings,
7    size_t button_count,
8    TwoWire &wire,
9    int sda_pin,
10    int scl_pin,
11    uint8_t i2c_addr
12)
13    : _pcf(i2c_addr, &wire) {
14    _button_mappings = button_mappings;
15    _button_count = button_count;
16
17#ifdef ARDUINO_PICO_REVISION
18    wire.setClock(3'000'000);
19    if (sda_pin > 0 && scl_pin > 0) {
20        wire.setSDA(sda_pin);
21        wire.setSCL(scl_pin);
22    }
23#endif
24
25    wire.begin();
26    _pcf.begin();
27}
28
29InputScanSpeed Pca9671Input::ScanSpeed() {
30    return InputScanSpeed::FAST;
31}
32
33void Pca9671Input::UpdateInputs(InputState &inputs) {
34    uint16_t pin_values = _pcf.read16();
35
36    for (size_t i = 0; i < _button_count; i++) {
37        UpdateButtonState(inputs, i, !(pin_values & (1 << _button_mappings[i].bit)));
38    }
39}
40
41void Pca9671Input::UpdateButtonState(
42    InputState &inputs,
43    size_t button_mapping_index,
44    bool pressed
45) {
46    set_button(inputs.buttons, _button_mappings[button_mapping_index].button, pressed);
47}