fork/GramFirmware

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

Jonathan HaylettFix Pico DInputBackend analog scaling on Linux (properly)9fb52af

gram
6.3 KiB183 linesraw
1/************************************************************************
2MIT License
3
4Copyright (c) 2021 gdsports625@gmail.com
5
6Permission is hereby granted, free of charge, to any person obtaining a copy
7of this software and associated documentation files (the "Software"), to deal
8in the Software without restriction, including without limitation the rights
9to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10copies of the Software, and to permit persons to whom the Software is
11furnished to do so, subject to the following conditions:
12
13The above copyright notice and this permission notice shall be included in all
14copies or substantial portions of the Software.
15
16THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
19AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
22SOFTWARE.
23*************************************************************************/
24#include "TUGamepad.hpp"
25
26#include <Adafruit_TinyUSB.h>
27#include <Arduino.h>
28#include <TUCompositeHID.hpp>
29
30// clang-format off
31
32#define HID_REPORT_DESC(...) \
33    HID_USAGE_PAGE ( HID_USAGE_PAGE_DESKTOP     )                 ,\
34    HID_USAGE      ( HID_USAGE_DESKTOP_GAMEPAD  )                 ,\
35    HID_COLLECTION ( HID_COLLECTION_APPLICATION )                 ,\
36        /* Report ID if any */\
37        __VA_ARGS__ \
38        /* 16 bit X, Y, Z, Rz, Rx, Ry (min -32768 max 32767 ) */ \
39        HID_USAGE_PAGE     ( HID_USAGE_PAGE_DESKTOP                 ) ,\
40        HID_USAGE          ( HID_USAGE_DESKTOP_X                    ) ,\
41        HID_USAGE          ( HID_USAGE_DESKTOP_Y                    ) ,\
42        HID_USAGE          ( HID_USAGE_DESKTOP_Z                    ) ,\
43        HID_USAGE          ( HID_USAGE_DESKTOP_RZ                   ) ,\
44        HID_USAGE          ( HID_USAGE_DESKTOP_RX                   ) ,\
45        HID_USAGE          ( HID_USAGE_DESKTOP_RY                   ) ,\
46        HID_LOGICAL_MIN    ( 0                                      ) ,\
47        HID_LOGICAL_MAX_N  ( 0xffff, 3                              ) ,\
48        HID_REPORT_COUNT   ( 6                                      ) ,\
49        HID_REPORT_SIZE    ( 16                                     ) ,\
50        HID_INPUT          ( HID_DATA | HID_VARIABLE | HID_ABSOLUTE ) ,\
51        /* 8 bit DPad/Hat Button Map  */ \
52        HID_USAGE_PAGE     ( HID_USAGE_PAGE_DESKTOP                 ) ,\
53        HID_USAGE          ( HID_USAGE_DESKTOP_HAT_SWITCH           ) ,\
54        HID_LOGICAL_MIN    ( 1                                      ) ,\
55        HID_LOGICAL_MAX    ( 8                                      ) ,\
56        HID_PHYSICAL_MIN   ( 0                                      ) ,\
57        HID_PHYSICAL_MAX_N ( 315, 2                                 ) ,\
58        HID_REPORT_COUNT   ( 1                                      ) ,\
59        HID_REPORT_SIZE    ( 8                                      ) ,\
60        HID_INPUT          ( HID_DATA | HID_VARIABLE | HID_ABSOLUTE ) ,\
61        /* 16 bit Button Map */ \
62        HID_USAGE_PAGE     ( HID_USAGE_PAGE_BUTTON                  ) ,\
63        HID_USAGE_MIN      ( 1                                      ) ,\
64        HID_USAGE_MAX      ( 16                                     ) ,\
65        HID_LOGICAL_MIN    ( 0                                      ) ,\
66        HID_LOGICAL_MAX    ( 1                                      ) ,\
67        HID_REPORT_COUNT   ( 16                                     ) ,\
68        HID_REPORT_SIZE    ( 1                                      ) ,\
69        HID_INPUT          ( HID_DATA | HID_VARIABLE | HID_ABSOLUTE ) ,\
70    HID_COLLECTION_END
71
72// clang-format on
73
74uint8_t TUGamepad::_descriptor[] = { HID_REPORT_DESC(HID_REPORT_ID(_report_id)) };
75
76TUGamepad::TUGamepad() {}
77
78void TUGamepad::registerDescriptor() {
79    TUCompositeHID::addDescriptor(_descriptor, sizeof(_descriptor));
80}
81
82void TUGamepad::begin() {
83    TUCompositeHID::_usb_hid.begin();
84
85    // Release all buttons, center all sticks, etc.
86    resetInputs();
87}
88
89bool TUGamepad::ready() {
90    return TUCompositeHID::_usb_hid.ready();
91};
92
93bool TUGamepad::sendState() {
94    return TUCompositeHID::_usb_hid.sendReport(_report_id, &_report, sizeof(gamepad_report_t));
95}
96
97void TUGamepad::resetInputs() {
98    releaseAll();
99    leftXAxis(128);
100    leftYAxis(128);
101    rightXAxis(128);
102    rightYAxis(128);
103    triggerLAnalog(0);
104    triggerRAnalog(0);
105}
106
107void TUGamepad::press(uint8_t button) {
108    _report.buttons |= TU_BIT(button);
109}
110
111void TUGamepad::release(uint8_t button) {
112    _report.buttons &= ~TU_BIT(button);
113}
114
115void TUGamepad::releaseAll() {
116    _report.buttons = 0;
117}
118
119void TUGamepad::setButton(uint8_t button, bool pressed) {
120    if (pressed) {
121        press(button);
122    } else {
123        release(button);
124    }
125}
126
127void TUGamepad::buttons(uint16_t buttons) {
128    _report.buttons = buttons;
129}
130
131void TUGamepad::leftXAxis(uint8_t value) {
132    _report.x = value * 257;
133}
134
135void TUGamepad::leftYAxis(uint8_t value) {
136    _report.y = value * 257;
137}
138
139void TUGamepad::rightXAxis(uint8_t value) {
140    _report.rx = value * 257;
141}
142
143void TUGamepad::rightYAxis(uint8_t value) {
144    _report.ry = value * 257;
145}
146
147void TUGamepad::triggerLAnalog(uint8_t value) {
148    _report.z = value * 257;
149}
150
151void TUGamepad::triggerRAnalog(uint8_t value) {
152    _report.rz = value * 257;
153}
154
155void TUGamepad::hatSwitch(hid_gamepad_hat_t direction) {
156    _report.hat = direction;
157}
158
159void TUGamepad::hatSwitch(bool left, bool right, bool down, bool up) {
160    _report.hat = getHatPosition(left, right, down, up);
161}
162
163hid_gamepad_hat_t TUGamepad::getHatPosition(bool left, bool right, bool down, bool up) {
164    hid_gamepad_hat_t angle = GAMEPAD_HAT_CENTERED;
165    if (right && !left) {
166        angle = GAMEPAD_HAT_RIGHT;
167        if (down)
168            angle = GAMEPAD_HAT_DOWN_RIGHT;
169        if (up)
170            angle = GAMEPAD_HAT_UP_RIGHT;
171    } else if (left && !right) {
172        angle = GAMEPAD_HAT_LEFT;
173        if (down)
174            angle = GAMEPAD_HAT_DOWN_LEFT;
175        if (up)
176            angle = GAMEPAD_HAT_UP_LEFT;
177    } else if (down && !up) {
178        angle = GAMEPAD_HAT_DOWN;
179    } else if (up && !down) {
180        angle = GAMEPAD_HAT_UP;
181    }
182    return angle;
183}