fork/GramFirmware

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

CarVacrebase to configurator818d962

gram
3.3 KiB96 linesraw
1#include "comms/DInputBackend.hpp"
2
3#include "core/CommunicationBackend.hpp"
4#include "core/state.hpp"
5
6#include <TUGamepad.hpp>
7
8DInputBackend::DInputBackend(
9    InputState &inputs,
10    InputSource **input_sources,
11    size_t input_source_count
12)
13    : CommunicationBackend(inputs, input_sources, input_source_count) {
14    _gamepad.begin();
15}
16
17DInputBackend::~DInputBackend() {
18    _gamepad.resetInputs();
19}
20
21CommunicationBackendId DInputBackend::BackendId() {
22    return COMMS_BACKEND_DINPUT;
23}
24
25void DInputBackend::SendReport() {
26    if (!_gamemode->isMelee()) {
27        ScanInputs(InputScanSpeed::SLOW);
28        ScanInputs(InputScanSpeed::MEDIUM);
29    }
30
31    while (!_gamepad.ready()) {
32        tight_loop_contents();
33    }
34
35    if (!_gamemode->isMelee()) {
36        ScanInputs(InputScanSpeed::FAST);
37
38        UpdateOutputs();
39    }
40
41    if (!_gamemode->isMelee()) {
42        // Digital outputs
43        _gamepad.setButton(0, _outputs.b);
44        _gamepad.setButton(1, _outputs.a);
45        _gamepad.setButton(2, _outputs.y);
46        _gamepad.setButton(3, _outputs.x);
47        _gamepad.setButton(4, _outputs.buttonR);
48        _gamepad.setButton(5, _outputs.triggerRDigital);
49        _gamepad.setButton(6, _outputs.buttonL);
50        _gamepad.setButton(7, _outputs.triggerLDigital);
51        _gamepad.setButton(8, _outputs.select);
52        _gamepad.setButton(9, _outputs.start);
53        _gamepad.setButton(10, _outputs.rightStickClick);
54        _gamepad.setButton(11, _outputs.leftStickClick);
55        _gamepad.setButton(12, _outputs.home);
56
57        // Analog outputs
58        _gamepad.leftXAxis(_outputs.leftStickX);
59        _gamepad.leftYAxis(255 - _outputs.leftStickY);
60        _gamepad.rightXAxis(_outputs.rightStickX);
61        _gamepad.rightYAxis(255 - _outputs.rightStickY);
62        _gamepad.triggerLAnalog(_outputs.triggerLAnalog + 1);
63        _gamepad.triggerRAnalog(_outputs.triggerRAnalog + 1);
64
65        // D-pad Hat Switch
66        _gamepad.hatSwitch(_outputs.dpadLeft, _outputs.dpadRight, _outputs.dpadDown, _outputs.dpadUp);
67    } else {
68        // Digital outputs
69        _gamepad.setButton(0, _finalOutputs.b);
70        _gamepad.setButton(1, _finalOutputs.a);
71        _gamepad.setButton(2, _finalOutputs.y);
72        _gamepad.setButton(3, _finalOutputs.x);
73        _gamepad.setButton(4, _finalOutputs.buttonR);
74        _gamepad.setButton(5, _finalOutputs.triggerRDigital);
75        _gamepad.setButton(6, _finalOutputs.buttonL);
76        _gamepad.setButton(7, _finalOutputs.triggerLDigital);
77        _gamepad.setButton(8, _finalOutputs.select);
78        _gamepad.setButton(9, _finalOutputs.start);
79        _gamepad.setButton(10, _finalOutputs.rightStickClick);
80        _gamepad.setButton(11, _finalOutputs.leftStickClick);
81        _gamepad.setButton(12, _finalOutputs.home);
82
83        // Analog outputs
84        _gamepad.leftXAxis(_finalOutputs.leftStickX);
85        _gamepad.leftYAxis(255 - _finalOutputs.leftStickY);
86        _gamepad.rightXAxis(_finalOutputs.rightStickX);
87        _gamepad.rightYAxis(255 - _finalOutputs.rightStickY);
88        _gamepad.triggerLAnalog(_finalOutputs.triggerLAnalog + 1);
89        _gamepad.triggerRAnalog(_finalOutputs.triggerRAnalog + 1);
90
91        // D-pad Hat Switch
92        _gamepad.hatSwitch(_finalOutputs.dpadLeft, _finalOutputs.dpadRight, _finalOutputs.dpadDown, _finalOutputs.dpadUp);
93    }
94
95    _gamepad.sendState();
96}