fork/GramFirmware

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

CarVacrebase to configurator818d962

gram
3.8 KiB108 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(
9    InputState &inputs,
10    InputSource **input_sources,
11    size_t input_source_count
12)
13    : CommunicationBackend(inputs, input_sources, input_source_count) {
14    _joystick.begin();
15
16    //Set up hardware timer
17    TCCR1A = 0;
18    TCCR1B = (1 << CS11) | (1 << CS10);//64 clock divider -> 4 microsecond resolution
19    zeroTcnt1();
20}
21
22DInputBackend::~DInputBackend() {
23    _joystick.end();
24}
25
26CommunicationBackendId DInputBackend::BackendId() {
27    return COMMS_BACKEND_DINPUT;
28}
29
30void DInputBackend::SendReport() {
31    static uint sampleSpacing = 350;
32    //static uint16_t loopTime = 16383;
33
34    while(readTcnt1() < sampleSpacing) {
35        //spinlock to make things about 720 hz, about the fastest it'll go while running the b0xx input viewer
36    }
37
38    //read how long this loop took
39    //loopTime = readTcnt1();//each unit is 4 microseconds
40    //zero the counter so that it doesn't overflow
41    zeroTcnt1();
42    //Serial.print("Loop time: ");
43    //Serial.println(loopTime);
44
45    ScanInputs();
46
47    // Run gamemode logic.
48    UpdateOutputs();
49
50    //if(_nerfOn) {
51    if(_gamemode->isMelee()) {
52        //APPLY NERFS HERE
53        OutputState nerfedOutputs;
54        limitOutputs(sampleSpacing, _nerfOn ? AB_A : AB_B, _inputs, _outputs, nerfedOutputs);
55
56        // Digital outputs
57        _joystick->setButton(0, nerfedOutputs.b);
58        _joystick->setButton(1, nerfedOutputs.a);
59        _joystick->setButton(2, nerfedOutputs.y);
60        _joystick->setButton(3, nerfedOutputs.x);
61        _joystick->setButton(4, nerfedOutputs.buttonR);
62        _joystick->setButton(5, nerfedOutputs.triggerRDigital);
63        _joystick->setButton(6, nerfedOutputs.buttonL);
64        _joystick->setButton(7, nerfedOutputs.triggerLDigital);
65        _joystick->setButton(8, nerfedOutputs.select);
66        _joystick->setButton(9, nerfedOutputs.start);
67        _joystick->setButton(10, nerfedOutputs.rightStickClick);
68        _joystick->setButton(11, nerfedOutputs.leftStickClick);
69        _joystick->setButton(12, nerfedOutputs.home);
70
71        // Analog outputs
72        _joystick->setXAxis(nerfedOutputs.leftStickX);
73        _joystick->setYAxis(255 - nerfedOutputs.leftStickY);
74        _joystick->setRxAxis(nerfedOutputs.rightStickX);
75        _joystick->setRyAxis(255 - nerfedOutputs.rightStickY);
76        _joystick->setZAxis(nerfedOutputs.triggerLAnalog + 1);
77        _joystick->setRzAxis(nerfedOutputs.triggerRAnalog + 1);
78
79        // D-pad Hat Switch
80        _joystick->setHatSwitch(_outputs.dpadLeft, _outputs.dpadRight, _outputs.dpadDown, _outputs.dpadUp);
81    } else {
82        // Digital outputs
83        _joystick->setButton(0, _outputs.b);
84        _joystick->setButton(1, _outputs.a);
85        _joystick->setButton(2, _outputs.y);
86        _joystick->setButton(3, _outputs.x);
87        _joystick->setButton(4, _outputs.buttonR);
88        _joystick->setButton(5, _outputs.triggerRDigital);
89        _joystick->setButton(6, _outputs.buttonL);
90        _joystick->setButton(7, _outputs.triggerLDigital);
91        _joystick->setButton(8, _outputs.select);
92        _joystick->setButton(9, _outputs.start);
93        _joystick->setButton(10, _outputs.rightStickClick);
94        _joystick->setButton(11, _outputs.leftStickClick);
95        _joystick->setButton(12, _outputs.home);
96
97        // Analog outputs
98        _joystick->setXAxis(_outputs.leftStickX);
99        _joystick->setYAxis(255 - _outputs.leftStickY);
100        _joystick->setRxAxis(_outputs.rightStickX);
101        _joystick->setRyAxis(255 - _outputs.rightStickY);
102        _joystick->setZAxis(_outputs.triggerLAnalog + 1);
103        _joystick->setRzAxis(_outputs.triggerRAnalog + 1);
104
105        // D-pad Hat Switch
106        _joystick->setHatSwitch(_outputs.dpadLeft, _outputs.dpadRight, _outputs.dpadDown, _outputs.dpadUp);
107    }
108}