fork/GramFirmware
git clone https://git.julia.blue/fork/GramFirmware
7824f7a
v0.1.2
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_ ( 11JOYSTICK_DEFAULT_REPORT_ID , 12JOYSTICK_TYPE_GAMEPAD , 1316 ,// Button Count 141 ,// 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 (); 39delete _joystick ; 40} 41 42void DInputBackend ::SendReport () { 43// Update inputs from all sources at once. 44ScanInputs (); 45 46UpdateOutputs (); 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 ( 730 , 74GetDpadAngle (_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 ) { 81int16_t angle = -1 ; 82if (right && !left ) { 83angle = 90 ; 84if (down ) 85angle = 135 ; 86if (up ) 87angle = 45 ; 88 }else if (left && !right ) { 89angle = 270 ; 90if (down ) 91angle = 225 ; 92if (up ) 93angle = 315 ; 94 }else if (down && !up ) { 95angle = 180 ; 96 }else if (up && !down ) { 97angle = 0 ; 98 } 99return angle ; 100}