fork/GramFirmware

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

CarVacrebase to configurator818d962

gram
3.1 KiB115 linesraw
1#ifndef _UTIL_STATE_UTIL_HPP
2#define _UTIL_STATE_UTIL_HPP
3
4#include "stdlib.hpp"
5
6#include <config.pb.h>
7
8/* InputState utils */
9
10inline void set_button(uint64_t &buttons, Button button_index, bool pressed) {
11    if (button_index == BTN_UNSPECIFIED) {
12        return;
13    }
14    Button button_index_adjusted = (Button)(button_index - 1);
15    buttons =
16        (buttons & ~(1ULL << button_index_adjusted)) | ((uint64_t)pressed << button_index_adjusted);
17}
18
19inline bool get_button(const uint64_t &buttons, Button button_index) {
20    if (button_index == BTN_UNSPECIFIED) {
21        return false;
22    }
23    return buttons & (1ULL << (button_index - 1));
24}
25
26inline uint64_t make_button_mask(const Button *buttons, size_t buttons_count) {
27    uint64_t button_mask = 0;
28    for (size_t j = 0; j < buttons_count; j++) {
29        button_mask |= (1ULL << (buttons[j] - 1));
30    }
31    return button_mask;
32}
33
34inline bool all_buttons_held(const uint64_t &buttons, uint64_t button_mask) {
35    return button_mask != 0 && (buttons & button_mask) == button_mask;
36}
37
38inline bool any_button_held(const uint64_t &buttons, uint64_t button_mask) {
39    return button_mask != 0 && (buttons & button_mask);
40}
41
42/* OutputState utils */
43
44inline void set_output(uint32_t &buttons, DigitalOutput output_index, bool pressed) {
45    if (output_index == GP_UNSPECIFIED) {
46        return;
47    }
48    DigitalOutput output_index_adjusted = (DigitalOutput)(output_index - 1);
49    buttons =
50        (buttons & ~(1UL << output_index_adjusted)) | ((uint32_t)pressed << output_index_adjusted);
51}
52
53inline uint8_t OutputState::*axis_pointer(AnalogAxis axis) {
54    switch (axis) {
55        case AXIS_LSTICK_X:
56            return &OutputState::leftStickX;
57        case AXIS_LSTICK_Y:
58            return &OutputState::leftStickY;
59        case AXIS_RSTICK_X:
60            return &OutputState::rightStickX;
61        case AXIS_RSTICK_Y:
62            return &OutputState::rightStickY;
63        case AXIS_LTRIGGER:
64            return &OutputState::triggerLAnalog;
65        case AXIS_RTRIGGER:
66            return &OutputState::triggerRAnalog;
67        default:
68            return nullptr;
69    }
70}
71
72constexpr const char *digital_output_name(DigitalOutput output) {
73    switch (output) {
74        case GP_A:
75            return "A";
76        case GP_B:
77            return "B";
78        case GP_X:
79            return "X";
80        case GP_Y:
81            return "Y";
82        case GP_LB:
83            return "L1";
84        case GP_RB:
85            return "R1";
86        case GP_LT:
87            return "L2";
88        case GP_RT:
89            return "R2";
90        case GP_START:
91            return "Start";
92        case GP_SELECT:
93            return "Select";
94        case GP_HOME:
95            return "Home";
96        case GP_CAPTURE:
97            return "Capture";
98        case GP_DPAD_UP:
99            return "D-Pad Up";
100        case GP_DPAD_DOWN:
101            return "D-Pad Down";
102        case GP_DPAD_LEFT:
103            return "D-Pad Left";
104        case GP_DPAD_RIGHT:
105            return "D-Pad Right";
106        case GP_LSTICK_CLICK:
107            return "L3";
108        case GP_RSTICK_CLICK:
109            return "R3";
110        default:
111            return "Unknown";
112    }
113}
114
115#endif