fork/GramFirmware

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

CarVacrebase to configurator818d962

gram
6.0 KiB155 linesraw
1#include "modes/CustomControllerMode.hpp"
2
3#include "util/state_util.hpp"
4
5#define SIGNUM(x) ((x > 0) - (x < 0))
6#define ANALOG_STICK_NEUTRAL 128
7
8CustomControllerMode::CustomControllerMode() : ControllerMode() {}
9
10void CustomControllerMode::SetConfig(
11    GameModeConfig &config,
12    const CustomModeConfig &custom_mode_config
13) {
14    InputMode::SetConfig(config);
15    _custom_mode_config = &custom_mode_config;
16    for (size_t i = 0; i < custom_mode_config.modifiers_count; i++) {
17        _modifier_button_masks[i] = make_button_mask(
18            custom_mode_config.modifiers[i].buttons,
19            custom_mode_config.modifiers[i].buttons_count
20        );
21    }
22    for (size_t i = 0; i < custom_mode_config.button_combo_mappings_count; i++) {
23        _button_combo_mappings_masks[i] = make_button_mask(
24            custom_mode_config.button_combo_mappings[i].buttons,
25            custom_mode_config.button_combo_mappings[i].buttons_count
26        );
27    }
28}
29
30void CustomControllerMode::UpdateDigitalOutputs(const InputState &inputs, OutputState &outputs) {
31    if (_custom_mode_config == nullptr) {
32        return;
33    }
34
35    // First check for button combo -> single output mappings, and lock out the normal function of
36    // the buttons in any buttons combos that are activated.
37    _buttons_to_ignore = 0;
38    const ButtonComboMapping *button_combo_mappings = _custom_mode_config->button_combo_mappings;
39    for (size_t i = 0; i < _custom_mode_config->button_combo_mappings_count; i++) {
40        const ButtonComboMapping &button_combo_mapping = button_combo_mappings[i];
41        if (!all_buttons_held(inputs.buttons, _button_combo_mappings_masks[i])) {
42            continue;
43        }
44
45        set_output(outputs.buttons, button_combo_mapping.digital_output, true);
46        _buttons_to_ignore |= _button_combo_mappings_masks[i];
47    }
48    _filtered_buttons = inputs.buttons & ~_buttons_to_ignore;
49
50    for (size_t output = 0; output < _custom_mode_config->digital_button_mappings_count; output++) {
51        Button input = _custom_mode_config->digital_button_mappings[output];
52        set_output(
53            outputs.buttons,
54            (DigitalOutput)(output + 1),
55            get_button(_filtered_buttons, input)
56        );
57    }
58
59    if (inputs.nunchuk_connected) {
60        outputs.triggerLDigital |= inputs.nunchuk_z;
61    }
62}
63
64void CustomControllerMode::UpdateAnalogOutputs(const InputState &inputs, OutputState &outputs) {
65    if (_custom_mode_config == nullptr) {
66        return;
67    }
68
69    const Button *direction_buttons = _custom_mode_config->stick_direction_mappings;
70    uint8_t stick_range = _custom_mode_config->stick_range;
71    UpdateDirections(
72        get_button(_filtered_buttons, GetDirectionButton(direction_buttons, SD_LSTICK_LEFT)),
73        get_button(_filtered_buttons, GetDirectionButton(direction_buttons, SD_LSTICK_RIGHT)),
74        get_button(_filtered_buttons, GetDirectionButton(direction_buttons, SD_LSTICK_DOWN)),
75        get_button(_filtered_buttons, GetDirectionButton(direction_buttons, SD_LSTICK_UP)),
76        get_button(_filtered_buttons, GetDirectionButton(direction_buttons, SD_RSTICK_LEFT)),
77        get_button(_filtered_buttons, GetDirectionButton(direction_buttons, SD_RSTICK_RIGHT)),
78        get_button(_filtered_buttons, GetDirectionButton(direction_buttons, SD_RSTICK_DOWN)),
79        get_button(_filtered_buttons, GetDirectionButton(direction_buttons, SD_RSTICK_UP)),
80        ANALOG_STICK_NEUTRAL - stick_range,
81        ANALOG_STICK_NEUTRAL,
82        ANALOG_STICK_NEUTRAL + stick_range,
83        outputs
84    );
85
86    const AnalogModifier *modifiers = _custom_mode_config->modifiers;
87    for (size_t i = 0; i < _custom_mode_config->modifiers_count; i++) {
88        const AnalogModifier &modifier = modifiers[i];
89        if (modifier.axis == AXIS_UNSPECIFIED || modifier.axis > _AnalogAxis_MAX) {
90            continue;
91        }
92        if (!all_buttons_held(_filtered_buttons, _modifier_button_masks[i])) {
93            continue;
94        }
95
96        uint8_t OutputState::*axis = axis_pointer(modifier.axis);
97        if (axis != nullptr) {
98            int8_t sign = 0;
99            switch (modifier.combination_mode) {
100                case COMBINATION_MODE_OVERRIDE:
101                    sign = SIGNUM(outputs.*axis);
102                    outputs.*axis = ANALOG_STICK_NEUTRAL +
103                                    _custom_mode_config->stick_range * modifier.multiplier * sign;
104                    break;
105                case COMBINATION_MODE_COMPOUND:
106                case COMBINATION_MODE_UNSPECIFIED:
107                default:
108                    outputs.*axis = ANALOG_STICK_NEUTRAL +
109                                    (outputs.*axis - ANALOG_STICK_NEUTRAL) * modifier.multiplier;
110                    break;
111            }
112        }
113    }
114
115    const AnalogTriggerMapping *analog_trigger_mappings =
116        _custom_mode_config->analog_trigger_mappings;
117    for (size_t i = 0; i < _custom_mode_config->analog_trigger_mappings_count; i++) {
118        const AnalogTriggerMapping &mapping = analog_trigger_mappings[i];
119        if (get_button(_filtered_buttons, mapping.button)) {
120            switch (mapping.trigger) {
121                case TRIGGER_LT:
122                    outputs.triggerLAnalog = mapping.value;
123                    break;
124                case TRIGGER_RT:
125                    outputs.triggerRAnalog = mapping.value;
126                    break;
127                default:
128                    break;
129            }
130        }
131    }
132
133    if (outputs.triggerLDigital) {
134        outputs.triggerLAnalog = 255;
135    }
136    if (outputs.triggerRDigital) {
137        outputs.triggerRAnalog = 255;
138    }
139
140    // Nunchuk overrides left stick.
141    if (inputs.nunchuk_connected) {
142        outputs.leftStickX = inputs.nunchuk_x;
143        outputs.leftStickY = inputs.nunchuk_y;
144    }
145}
146
147Button CustomControllerMode::GetDirectionButton(
148    const Button *direction_buttons,
149    StickDirectionButton direction
150) {
151    if (direction == SD_UNSPECIFIED || direction > _StickDirectionButton_MAX) {
152        return BTN_UNSPECIFIED;
153    }
154    return direction_buttons[direction - 1];
155}