fork/GramFirmware

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

CarVacrebase to configurator818d962

gram
6.5 KiB179 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 random vendor input idk */ \
52        HID_USAGE_PAGE_N   ( HID_USAGE_PAGE_VENDOR, 2               ) ,\
53        HID_USAGE          ( 0x20                                   ) ,\
54        HID_REPORT_COUNT   ( 1                                      ) ,\
55        HID_INPUT          ( HID_DATA | HID_VARIABLE | HID_ABSOLUTE ) ,\
56        /* Some output from the host idk */ \
57        0x0A, 0x21, 0x26, \
58        HID_REPORT_COUNT   ( 8                                      ) ,\
59        HID_OUTPUT         ( HID_DATA | HID_VARIABLE | HID_ABSOLUTE ) ,\
60    HID_COLLECTION_END
61
62// clang-format on
63
64uint8_t NintendoSwitchBackend::_descriptor[] = { HID_REPORT_DESC() };
65
66NintendoSwitchBackend::NintendoSwitchBackend(
67    InputState &inputs,
68    InputSource **input_sources,
69    size_t input_source_count
70)
71    : CommunicationBackend(inputs, input_sources, input_source_count) {
72    USBDevice.setManufacturerDescriptor("HORI CO.,LTD.");
73    USBDevice.setProductDescriptor("POKKEN CONTROLLER");
74    USBDevice.setSerialDescriptor("1.0");
75    USBDevice.setID(0x0F0D, 0x0092);
76
77    TUCompositeHID::_usb_hid.begin();
78
79    _report = {
80        y: false,
81        b: false,
82        a: false,
83        x: false,
84        l: false,
85        r: false,
86        zl: false,
87        zr: false,
88        minus: false,
89        plus: false,
90        l3: false,
91        r3: false,
92        home: false,
93        capture: false,
94        reserved0: 0,
95        hat: SWITCH_HAT_CENTERED,
96        lx: 128,
97        ly: 128,
98        rx: 128,
99        ry: 128,
100        reserved1: 0,
101    };
102}
103
104NintendoSwitchBackend::~NintendoSwitchBackend() {}
105
106void NintendoSwitchBackend::RegisterDescriptor() {
107    TUCompositeHID::addDescriptor(_descriptor, sizeof(_descriptor));
108}
109
110CommunicationBackendId NintendoSwitchBackend::BackendId() {
111    return COMMS_BACKEND_NINTENDO_SWITCH;
112}
113
114void NintendoSwitchBackend::SendReport() {
115    ScanInputs(InputScanSpeed::SLOW);
116    ScanInputs(InputScanSpeed::MEDIUM);
117
118    while (!TUCompositeHID::_usb_hid.ready()) {
119        tight_loop_contents();
120    }
121
122    ScanInputs(InputScanSpeed::FAST);
123
124    UpdateOutputs();
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 =
149        GetHatPosition(_outputs.dpadLeft, _outputs.dpadRight, _outputs.dpadDown, _outputs.dpadUp);
150
151    TUCompositeHID::_usb_hid.sendReport(_report_id, &_report, sizeof(switch_gamepad_report_t));
152}
153
154switch_gamepad_hat_t NintendoSwitchBackend::GetHatPosition(
155    bool left,
156    bool right,
157    bool down,
158    bool up
159) {
160    switch_gamepad_hat_t angle = SWITCH_HAT_CENTERED;
161    if (right && !left) {
162        angle = SWITCH_HAT_RIGHT;
163        if (down)
164            angle = SWITCH_HAT_DOWN_RIGHT;
165        if (up)
166            angle = SWITCH_HAT_UP_RIGHT;
167    } else if (left && !right) {
168        angle = SWITCH_HAT_LEFT;
169        if (down)
170            angle = SWITCH_HAT_DOWN_LEFT;
171        if (up)
172            angle = SWITCH_HAT_UP_LEFT;
173    } else if (down && !up) {
174        angle = SWITCH_HAT_DOWN;
175    } else if (up && !down) {
176        angle = SWITCH_HAT_UP;
177    }
178    return angle;
179}