fork/GramFirmware
git clone https://git.julia.blue/fork/GramFirmware
cbd8ff3
v0.1.0
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 output from the host idk */ \ 52HID_USAGE_PAGE_N (HID_USAGE_PAGE_VENDOR ,2 ) ,\ 53HID_USAGE (0x20 ) ,\ 54HID_REPORT_COUNT (8 ) ,\ 55HID_OUTPUT (HID_DATA |HID_VARIABLE |HID_ABSOLUTE ) ,\ 56HID_COLLECTION_END 57 58// clang-format on 59 60uint8_t NintendoSwitchBackend ::_descriptor []= {HID_REPORT_DESC () }; 61 62NintendoSwitchBackend ::NintendoSwitchBackend (InputSource ** input_sources ,size_t input_source_count ) 63 :CommunicationBackend (input_sources ,input_source_count ) { 64USBDevice .setManufacturerDescriptor ("HORI CO.,LTD." ); 65USBDevice .setProductDescriptor ("POKKEN CONTROLLER" ); 66USBDevice .setSerialDescriptor ("1.0" ); 67USBDevice .setID (0x0F0D ,0x0092 ); 68 69TUCompositeHID ::_usb_hid .begin (); 70 71_report = { 72y : false, 73b : false, 74a : false, 75x : false, 76l : false, 77r : false, 78zl : false, 79zr : false, 80minus : false, 81plus : false, 82l3 : false, 83r3 : false, 84home : false, 85capture : false, 86reserved0 :0 , 87hat :SWITCH_HAT_CENTERED , 88lx :128 , 89ly :128 , 90rx :128 , 91ry :128 , 92reserved1 :0 , 93 }; 94} 95 96NintendoSwitchBackend ::~NintendoSwitchBackend () {} 97 98void NintendoSwitchBackend ::RegisterDescriptor () { 99TUCompositeHID ::addDescriptor (_descriptor ,sizeof (_descriptor )); 100} 101 102void NintendoSwitchBackend ::SendReport () { 103ScanInputs (InputScanSpeed ::SLOW ); 104ScanInputs (InputScanSpeed ::MEDIUM ); 105 106while (!TUCompositeHID ::_usb_hid .ready ()) { 107tight_loop_contents (); 108 } 109 110ScanInputs (InputScanSpeed ::FAST ); 111 112UpdateOutputs (); 113 114// Digital outputs 115_report .y = _outputs .x ; 116_report .b = _outputs .a ; 117_report .a = _outputs .b ; 118_report .x = _outputs .y ; 119_report .l = _outputs .buttonL ; 120_report .r = _outputs .buttonR ; 121_report .zl = _outputs .triggerLDigital ; 122_report .zr = _outputs .triggerRDigital ; 123_report .minus = _outputs .select ; 124_report .plus = _outputs .start ; 125_report .l3 = _outputs .leftStickClick ; 126_report .r3 = _outputs .rightStickClick ; 127_report .home = _outputs .home ; 128 129// Analog outputs 130_report .lx = (_outputs .leftStickX - 128 )* 1.25 + 128 ; 131_report .ly = 255 - ((_outputs .leftStickY - 128 )* 1.25 + 128 ); 132_report .rx = (_outputs .rightStickX - 128 )* 1.25 + 128 ; 133_report .ry = 255 - ((_outputs .rightStickY - 128 )* 1.25 + 128 ); 134 135// D-pad Hat Switch 136_report .hat = 137GetHatPosition (_outputs .dpadLeft ,_outputs .dpadRight ,_outputs .dpadDown ,_outputs .dpadUp ); 138 139TUCompositeHID ::_usb_hid .sendReport (_report_id ,& _report ,sizeof (switch_gamepad_report_t )); 140} 141 142switch_gamepad_hat_t NintendoSwitchBackend ::GetHatPosition ( 143bool left , 144bool right , 145bool down , 146bool up 147) { 148switch_gamepad_hat_t angle = SWITCH_HAT_CENTERED ; 149if (right && !left ) { 150angle = SWITCH_HAT_RIGHT ; 151if (down ) 152angle = SWITCH_HAT_DOWN_RIGHT ; 153if (up ) 154angle = SWITCH_HAT_UP_RIGHT ; 155 }else if (left && !right ) { 156angle = SWITCH_HAT_LEFT ; 157if (down ) 158angle = SWITCH_HAT_DOWN_LEFT ; 159if (up ) 160angle = SWITCH_HAT_UP_LEFT ; 161 }else if (down && !up ) { 162angle = SWITCH_HAT_DOWN ; 163 }else if (up && !down ) { 164angle = SWITCH_HAT_UP ; 165 } 166return angle ; 167}