fork/GramFirmware

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

Skywalker1127Swaps A/B & X/Y51472f7

v0.1.1
6.1 KiB167 linesraw
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 */ \
18        HID_LOGICAL_MIN    ( 0                                      ) ,\
19        HID_LOGICAL_MAX    ( 1                                      ) ,\
20        HID_PHYSICAL_MIN   ( 0                                      ) ,\
21        HID_PHYSICAL_MAX   ( 1                                      ) ,\
22        HID_REPORT_SIZE    ( 1                                      ) ,\
23        HID_REPORT_COUNT   ( 16                                     ) ,\
24        HID_USAGE_PAGE     ( HID_USAGE_PAGE_BUTTON                  ) ,\
25        HID_USAGE_MIN      ( 1                                      ) ,\
26        HID_USAGE_MAX      ( 16                                     ) ,\
27        HID_INPUT          ( HID_DATA | HID_VARIABLE | HID_ABSOLUTE ) ,\
28        /* 8 bit DPad/Hat */ \
29        HID_USAGE_PAGE     ( HID_USAGE_PAGE_DESKTOP                 ) ,\
30        HID_LOGICAL_MAX    ( 7                                      ) ,\
31        HID_PHYSICAL_MAX_N ( 315, 2                                 ) ,\
32        HID_REPORT_SIZE    ( 4                                      ) ,\
33        HID_REPORT_COUNT   ( 1                                      ) ,\
34        HID_UNIT           ( 0x14                                   ) ,\
35        HID_USAGE          ( HID_USAGE_DESKTOP_HAT_SWITCH           ) ,\
36        HID_INPUT          ( HID_DATA | HID_VARIABLE | HID_ABSOLUTE | HID_NULL_STATE ) ,\
37        /* Useless padding after hat switch */ \
38        HID_UNIT           ( 0x00                                   ) ,\
39        HID_REPORT_COUNT   ( 1                                      ) ,\
40        HID_INPUT          ( HID_CONSTANT | HID_ARRAY | HID_ABSOLUTE ) ,\
41        /* 8 bit analog stick axes, range 0-255 */ \
42        HID_LOGICAL_MAX_N  ( 255, 2                                 ) ,\
43        HID_PHYSICAL_MAX_N ( 255, 2                                 ) ,\
44        HID_USAGE          ( HID_USAGE_DESKTOP_X                    ) ,\
45        HID_USAGE          ( HID_USAGE_DESKTOP_Y                    ) ,\
46        HID_USAGE          ( HID_USAGE_DESKTOP_Z                    ) ,\
47        HID_USAGE          ( HID_USAGE_DESKTOP_RZ                   ) ,\
48        HID_REPORT_SIZE    ( 8                                      ) ,\
49        HID_REPORT_COUNT   ( 4                                      ) ,\
50        HID_INPUT          ( HID_DATA | HID_VARIABLE | HID_ABSOLUTE ) ,\
51        /* Some output from the host idk */ \
52        HID_USAGE_PAGE_N   ( HID_USAGE_PAGE_VENDOR, 2               ) ,\
53        HID_USAGE          ( 0x20                                   ) ,\
54        HID_REPORT_COUNT   ( 8                                      ) ,\
55        HID_OUTPUT         ( HID_DATA | HID_VARIABLE | HID_ABSOLUTE ) ,\
56    HID_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) {
64    USBDevice.setManufacturerDescriptor("HORI CO.,LTD.");
65    USBDevice.setProductDescriptor("POKKEN CONTROLLER");
66    USBDevice.setSerialDescriptor("1.0");
67    USBDevice.setID(0x0F0D, 0x0092);
68
69    TUCompositeHID::_usb_hid.begin();
70
71    _report = {
72        y: false,
73        b: false,
74        a: false,
75        x: false,
76        l: false,
77        r: false,
78        zl: false,
79        zr: false,
80        minus: false,
81        plus: false,
82        l3: false,
83        r3: false,
84        home: false,
85        capture: false,
86        reserved0: 0,
87        hat: SWITCH_HAT_CENTERED,
88        lx: 128,
89        ly: 128,
90        rx: 128,
91        ry: 128,
92        reserved1: 0,
93    };
94}
95
96NintendoSwitchBackend::~NintendoSwitchBackend() {}
97
98void NintendoSwitchBackend::RegisterDescriptor() {
99    TUCompositeHID::addDescriptor(_descriptor, sizeof(_descriptor));
100}
101
102void NintendoSwitchBackend::SendReport() {
103    ScanInputs(InputScanSpeed::SLOW);
104    ScanInputs(InputScanSpeed::MEDIUM);
105
106    while (!TUCompositeHID::_usb_hid.ready()) {
107        tight_loop_contents();
108    }
109
110    ScanInputs(InputScanSpeed::FAST);
111
112    UpdateOutputs();
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 =
137        GetHatPosition(_outputs.dpadLeft, _outputs.dpadRight, _outputs.dpadDown, _outputs.dpadUp);
138
139    TUCompositeHID::_usb_hid.sendReport(_report_id, &_report, sizeof(switch_gamepad_report_t));
140}
141
142switch_gamepad_hat_t NintendoSwitchBackend::GetHatPosition(
143    bool left,
144    bool right,
145    bool down,
146    bool up
147) {
148    switch_gamepad_hat_t angle = SWITCH_HAT_CENTERED;
149    if (right && !left) {
150        angle = SWITCH_HAT_RIGHT;
151        if (down)
152            angle = SWITCH_HAT_DOWN_RIGHT;
153        if (up)
154            angle = SWITCH_HAT_UP_RIGHT;
155    } else if (left && !right) {
156        angle = SWITCH_HAT_LEFT;
157        if (down)
158            angle = SWITCH_HAT_DOWN_LEFT;
159        if (up)
160            angle = SWITCH_HAT_UP_LEFT;
161    } else if (down && !up) {
162        angle = SWITCH_HAT_DOWN;
163    } else if (up && !down) {
164        angle = SWITCH_HAT_UP;
165    }
166    return angle;
167}