fork/GramFirmware

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

Jonathan HaylettMerge pull request #7 from JonnyHaystack/v23ab6a9b

v0.1.0
1.2 KiB46 linesraw
1#include "input/NunchukInput.hpp"
2
3#include "gpio.hpp"
4
5#include <ArduinoNunchuk.hpp>
6#include <Wire.h>
7
8NunchukInput::NunchukInput(int detect_pin) {
9    delay(50);
10
11    if (detect_pin > -1) {
12        gpio::init_pin(detect_pin, gpio::GpioMode::GPIO_INPUT_PULLUP);
13        if (gpio::read_digital(detect_pin)) {
14            _nunchuk = nullptr;
15            return;
16        }
17    }
18
19    _nunchuk = new ArduinoNunchuk(Wire);
20
21    if (!_nunchuk->init() || !_nunchuk->update()) {
22        // If a Nunchuk isn't connected we don't want i2c to stay enabled because it might interfere
23        // with inputs if i2c pins are also used for buttons. The destructor of ArduinoNunchuk
24        // ends the i2c communication.
25        delete _nunchuk;
26        _nunchuk = nullptr;
27    }
28}
29
30NunchukInput::~NunchukInput() {
31    delete _nunchuk;
32}
33
34InputScanSpeed NunchukInput::ScanSpeed() {
35    return InputScanSpeed::SLOW;
36}
37
38void NunchukInput::UpdateInputs(InputState &inputs) {
39    if (_nunchuk != nullptr && _nunchuk->update()) {
40        inputs.nunchuk_connected = true;
41        inputs.nunchuk_x = _nunchuk->stickX();
42        inputs.nunchuk_y = _nunchuk->stickY();
43        inputs.nunchuk_c = _nunchuk->buttonC();
44        inputs.nunchuk_z = _nunchuk->buttonZ();
45    }
46}