fork/GramFirmware

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

Jonathan HaylettFix Dolphin inconsistent stick calibration bug7824f7a

master
2.8 KiB100 linesraw
1#include "comms/DInputBackend.hpp"
2
3#include "core/CommunicationBackend.hpp"
4#include "core/state.hpp"
5
6#include <Joystick.h>
7
8DInputBackend::DInputBackend(InputSource **input_sources, size_t input_source_count)
9    : CommunicationBackend(input_sources, input_source_count) {
10    _joystick = new Joystick_(
11        JOYSTICK_DEFAULT_REPORT_ID,
12        JOYSTICK_TYPE_GAMEPAD,
13        16, // Button Count
14        1, // Hat Switch Count
15        true, // X Axis
16        true, // Y Axis
17        true, // Z Axis
18        true, // Rx Axis
19        true, // Ry Axis
20        true, // Rz Axis
21        false, // No rudder
22        false, // No throttle
23        false, // No accelerator
24        false, // No brake
25        false // No steering
26    );
27
28    _joystick->begin(false);
29    _joystick->setXAxisRange(0, 255);
30    _joystick->setYAxisRange(0, 255);
31    _joystick->setRxAxisRange(0, 255);
32    _joystick->setRyAxisRange(0, 255);
33    _joystick->setZAxisRange(0, 255);
34    _joystick->setRzAxisRange(0, 255);
35}
36
37DInputBackend::~DInputBackend() {
38    _joystick->end();
39    delete _joystick;
40}
41
42void DInputBackend::SendReport() {
43    // Update inputs from all sources at once.
44    ScanInputs();
45
46    UpdateOutputs();
47
48    // Digital outputs
49    _joystick->setButton(0, _outputs.b);
50    _joystick->setButton(1, _outputs.a);
51    _joystick->setButton(2, _outputs.y);
52    _joystick->setButton(3, _outputs.x);
53    _joystick->setButton(4, _outputs.buttonR);
54    _joystick->setButton(5, _outputs.triggerRDigital);
55    _joystick->setButton(6, _outputs.buttonL);
56    _joystick->setButton(7, _outputs.triggerLDigital);
57    _joystick->setButton(8, _outputs.select);
58    _joystick->setButton(9, _outputs.start);
59    _joystick->setButton(10, _outputs.rightStickClick);
60    _joystick->setButton(11, _outputs.leftStickClick);
61    _joystick->setButton(12, _outputs.home);
62
63    // Analog outputs
64    _joystick->setXAxis(_outputs.leftStickX);
65    _joystick->setYAxis(255 - _outputs.leftStickY);
66    _joystick->setRxAxis(_outputs.rightStickX);
67    _joystick->setRyAxis(255 - _outputs.rightStickY);
68    _joystick->setZAxis(_outputs.triggerLAnalog + 1);
69    _joystick->setRzAxis(_outputs.triggerRAnalog + 1);
70
71    // D-pad Hat Switch
72    _joystick->setHatSwitch(
73        0,
74        GetDpadAngle(_outputs.dpadLeft, _outputs.dpadRight, _outputs.dpadDown, _outputs.dpadUp)
75    );
76
77    _joystick->sendState();
78}
79
80int16_t DInputBackend::GetDpadAngle(bool left, bool right, bool down, bool up) {
81    int16_t angle = -1;
82    if (right && !left) {
83        angle = 90;
84        if (down)
85            angle = 135;
86        if (up)
87            angle = 45;
88    } else if (left && !right) {
89        angle = 270;
90        if (down)
91            angle = 225;
92        if (up)
93            angle = 315;
94    } else if (down && !up) {
95        angle = 180;
96    } else if (up && !down) {
97        angle = 0;
98    }
99    return angle;
100}