fork/GramFirmware

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

CarVacrebase to configurator818d962

gram
3.0 KiB96 linesraw
1#include "core/socd.hpp"
2
3#include "util/state_util.hpp"
4
5void socd::second_input_priority_no_reactivation(
6    InputState &inputs,
7    Button button_dir1,
8    Button button_dir2,
9    SocdState &socd_state
10) {
11    bool result_dir1 = false;
12    bool result_dir2 = false;
13    bool dir1_pressed = get_button(inputs.buttons, button_dir1);
14    bool dir2_pressed = get_button(inputs.buttons, button_dir2);
15    if (dir1_pressed && dir2_pressed) {
16        if (socd_state.was_dir2) {
17            result_dir1 = true;
18            result_dir2 = false;
19            socd_state.lock_dir2 = true;
20        }
21        if (socd_state.was_dir1) {
22            result_dir1 = false;
23            result_dir2 = true;
24            socd_state.lock_dir1 = true;
25        }
26    }
27    if (!dir1_pressed && dir2_pressed && !socd_state.lock_dir2) {
28        result_dir1 = false;
29        result_dir2 = true;
30        socd_state.was_dir2 = true;
31        socd_state.was_dir1 = false;
32        socd_state.lock_dir1 = false;
33    }
34    if (dir1_pressed && !dir2_pressed && !socd_state.lock_dir1) {
35        result_dir1 = true;
36        result_dir2 = false;
37        socd_state.was_dir1 = true;
38        socd_state.was_dir2 = false;
39        socd_state.lock_dir2 = false;
40    }
41    if (!dir1_pressed && !dir2_pressed) {
42        socd_state.was_dir2 = false;
43        socd_state.was_dir1 = false;
44        socd_state.lock_dir1 = false;
45        socd_state.lock_dir2 = false;
46    }
47    set_button(inputs.buttons, button_dir1, result_dir1);
48    set_button(inputs.buttons, button_dir2, result_dir2);
49}
50
51void socd::second_input_priority(
52    InputState &inputs,
53    Button button_dir1,
54    Button button_dir2,
55    SocdState &socd_state
56) {
57    bool result_dir1 = false;
58    bool result_dir2 = false;
59    bool dir1_pressed = get_button(inputs.buttons, button_dir1);
60    bool dir2_pressed = get_button(inputs.buttons, button_dir2);
61    if (dir1_pressed && socd_state.was_dir2) {
62        result_dir1 = true;
63        result_dir2 = false;
64    }
65    if (dir2_pressed && socd_state.was_dir1) {
66        result_dir1 = false;
67        result_dir2 = true;
68    }
69    if (!dir1_pressed && dir2_pressed) {
70        result_dir1 = false;
71        result_dir2 = true;
72        socd_state.was_dir2 = true;
73        socd_state.was_dir1 = false;
74    }
75    if (dir1_pressed && !dir2_pressed) {
76        result_dir1 = true;
77        result_dir2 = false;
78        socd_state.was_dir1 = true;
79        socd_state.was_dir2 = false;
80    }
81    set_button(inputs.buttons, button_dir1, result_dir1);
82    set_button(inputs.buttons, button_dir2, result_dir2);
83}
84
85void socd::neutral(InputState &inputs, Button button_dir1, Button button_dir2) {
86    if (get_button(inputs.buttons, button_dir1) && get_button(inputs.buttons, button_dir2)) {
87        set_button(inputs.buttons, button_dir1, false);
88        set_button(inputs.buttons, button_dir2, false);
89    }
90}
91
92void socd::dir1_priority(InputState &inputs, Button button_dir1, Button button_dir2) {
93    if (get_button(inputs.buttons, button_dir1) && get_button(inputs.buttons, button_dir2)) {
94        set_button(inputs.buttons, button_dir2, false);
95    }
96}