fork/GramFirmware
git clone https://git.julia.blue/fork/GramFirmware
818d962
gram
1#include "comms/NintendoSwitchBackend.hpp" 2 3#include "core/CommunicationBackend.hpp" 4#include "core/state.hpp" 5 6#include <Adafruit_TinyUSB.h> 7#include <TUCompositeHID.hpp> 8 9// clang-format off 10 11#define HID_REPORT_DESC (...) \ 12 HID_USAGE_PAGE ( HID_USAGE_PAGE_DESKTOP ) ,\ 13 HID_USAGE ( HID_USAGE_DESKTOP_GAMEPAD ) ,\ 14 HID_COLLECTION ( HID_COLLECTION_APPLICATION ) ,\ 15/* Report ID if any */ \ 16__VA_ARGS__ \ 17/* 16 bit Button Map */ \ 18HID_LOGICAL_MIN (0 ) ,\ 19HID_LOGICAL_MAX (1 ) ,\ 20HID_PHYSICAL_MIN (0 ) ,\ 21HID_PHYSICAL_MAX (1 ) ,\ 22HID_REPORT_SIZE (1 ) ,\ 23HID_REPORT_COUNT (16 ) ,\ 24HID_USAGE_PAGE (HID_USAGE_PAGE_BUTTON ) ,\ 25HID_USAGE_MIN (1 ) ,\ 26HID_USAGE_MAX (16 ) ,\ 27HID_INPUT (HID_DATA |HID_VARIABLE |HID_ABSOLUTE ) ,\ 28/* 8 bit DPad/Hat */ \ 29HID_USAGE_PAGE (HID_USAGE_PAGE_DESKTOP ) ,\ 30HID_LOGICAL_MAX (7 ) ,\ 31HID_PHYSICAL_MAX_N (315 ,2 ) ,\ 32HID_REPORT_SIZE (4 ) ,\ 33HID_REPORT_COUNT (1 ) ,\ 34HID_UNIT (0x14 ) ,\ 35HID_USAGE (HID_USAGE_DESKTOP_HAT_SWITCH ) ,\ 36HID_INPUT (HID_DATA |HID_VARIABLE |HID_ABSOLUTE |HID_NULL_STATE ) ,\ 37/* Useless padding after hat switch */ \ 38HID_UNIT (0x00 ) ,\ 39HID_REPORT_COUNT (1 ) ,\ 40HID_INPUT (HID_CONSTANT |HID_ARRAY |HID_ABSOLUTE ) ,\ 41/* 8 bit analog stick axes, range 0-255 */ \ 42HID_LOGICAL_MAX_N (255 ,2 ) ,\ 43HID_PHYSICAL_MAX_N (255 ,2 ) ,\ 44HID_USAGE (HID_USAGE_DESKTOP_X ) ,\ 45HID_USAGE (HID_USAGE_DESKTOP_Y ) ,\ 46HID_USAGE (HID_USAGE_DESKTOP_Z ) ,\ 47HID_USAGE (HID_USAGE_DESKTOP_RZ ) ,\ 48HID_REPORT_SIZE (8 ) ,\ 49HID_REPORT_COUNT (4 ) ,\ 50HID_INPUT (HID_DATA |HID_VARIABLE |HID_ABSOLUTE ) ,\ 51/* Some random vendor input idk */ \ 52HID_USAGE_PAGE_N (HID_USAGE_PAGE_VENDOR ,2 ) ,\ 53HID_USAGE (0x20 ) ,\ 54HID_REPORT_COUNT (1 ) ,\ 55HID_INPUT (HID_DATA |HID_VARIABLE |HID_ABSOLUTE ) ,\ 56/* Some output from the host idk */ \ 570x0A ,0x21 ,0x26 , \ 58HID_REPORT_COUNT (8 ) ,\ 59HID_OUTPUT (HID_DATA |HID_VARIABLE |HID_ABSOLUTE ) ,\ 60HID_COLLECTION_END 61 62// clang-format on 63 64uint8_t NintendoSwitchBackend ::_descriptor []= {HID_REPORT_DESC () }; 65 66NintendoSwitchBackend ::NintendoSwitchBackend ( 67InputState & inputs , 68InputSource ** input_sources , 69size_t input_source_count 70) 71 :CommunicationBackend (inputs ,input_sources ,input_source_count ) { 72USBDevice .setManufacturerDescriptor ("HORI CO.,LTD." ); 73USBDevice .setProductDescriptor ("POKKEN CONTROLLER" ); 74USBDevice .setSerialDescriptor ("1.0" ); 75USBDevice .setID (0x0F0D ,0x0092 ); 76 77TUCompositeHID ::_usb_hid .begin (); 78 79_report = { 80y : false, 81b : false, 82a : false, 83x : false, 84l : false, 85r : false, 86zl : false, 87zr : false, 88minus : false, 89plus : false, 90l3 : false, 91r3 : false, 92home : false, 93capture : false, 94reserved0 :0 , 95hat :SWITCH_HAT_CENTERED , 96lx :128 , 97ly :128 , 98rx :128 , 99ry :128 , 100reserved1 :0 , 101 }; 102} 103 104NintendoSwitchBackend ::~NintendoSwitchBackend () {} 105 106void NintendoSwitchBackend ::RegisterDescriptor () { 107TUCompositeHID ::addDescriptor (_descriptor ,sizeof (_descriptor )); 108} 109 110CommunicationBackendId NintendoSwitchBackend ::BackendId () { 111return COMMS_BACKEND_NINTENDO_SWITCH ; 112} 113 114void NintendoSwitchBackend ::SendReport () { 115ScanInputs (InputScanSpeed ::SLOW ); 116ScanInputs (InputScanSpeed ::MEDIUM ); 117 118while (!TUCompositeHID ::_usb_hid .ready ()) { 119tight_loop_contents (); 120 } 121 122ScanInputs (InputScanSpeed ::FAST ); 123 124UpdateOutputs (); 125 126// Digital outputs 127_report .y = _outputs .y ; 128_report .b = _outputs .b ; 129_report .a = _outputs .a ; 130_report .x = _outputs .x ; 131_report .l = _outputs .buttonL ; 132_report .r = _outputs .buttonR ; 133_report .zl = _outputs .triggerLDigital ; 134_report .zr = _outputs .triggerRDigital ; 135_report .minus = _outputs .select ; 136_report .plus = _outputs .start ; 137_report .l3 = _outputs .leftStickClick ; 138_report .r3 = _outputs .rightStickClick ; 139_report .home = _outputs .home ; 140 141// Analog outputs 142_report .lx = (_outputs .leftStickX - 128 )* 1.25 + 128 ; 143_report .ly = 255 - ((_outputs .leftStickY - 128 )* 1.25 + 128 ); 144_report .rx = (_outputs .rightStickX - 128 )* 1.25 + 128 ; 145_report .ry = 255 - ((_outputs .rightStickY - 128 )* 1.25 + 128 ); 146 147// D-pad Hat Switch 148_report .hat = 149GetHatPosition (_outputs .dpadLeft ,_outputs .dpadRight ,_outputs .dpadDown ,_outputs .dpadUp ); 150 151TUCompositeHID ::_usb_hid .sendReport (_report_id ,& _report ,sizeof (switch_gamepad_report_t )); 152} 153 154switch_gamepad_hat_t NintendoSwitchBackend ::GetHatPosition ( 155bool left , 156bool right , 157bool down , 158bool up 159) { 160switch_gamepad_hat_t angle = SWITCH_HAT_CENTERED ; 161if (right && !left ) { 162angle = SWITCH_HAT_RIGHT ; 163if (down ) 164angle = SWITCH_HAT_DOWN_RIGHT ; 165if (up ) 166angle = SWITCH_HAT_UP_RIGHT ; 167 }else if (left && !right ) { 168angle = SWITCH_HAT_LEFT ; 169if (down ) 170angle = SWITCH_HAT_DOWN_LEFT ; 171if (up ) 172angle = SWITCH_HAT_UP_LEFT ; 173 }else if (down && !up ) { 174angle = SWITCH_HAT_DOWN ; 175 }else if (up && !down ) { 176angle = SWITCH_HAT_UP ; 177 } 178return angle ; 179}