fork/GramFirmware

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

Jonathan HaylettSOCD revamp (#57)1f92ae6

v0.1.0
2.2 KiB84 linesraw
1#include "core/socd.hpp"
2
3void socd::second_input_priority_no_reactivation(
4    bool &input_dir1,
5    bool &input_dir2,
6    SocdState &socd_state
7) {
8    bool is_dir1 = false;
9    bool is_dir2 = false;
10    if (input_dir1 && input_dir2) {
11        if (socd_state.was_dir2) {
12            is_dir1 = true;
13            is_dir2 = false;
14            socd_state.lock_dir2 = true;
15        }
16        if (socd_state.was_dir1) {
17            is_dir1 = false;
18            is_dir2 = true;
19            socd_state.lock_dir1 = true;
20        }
21    }
22    if (!input_dir1 && input_dir2 && !socd_state.lock_dir2) {
23        is_dir1 = false;
24        is_dir2 = true;
25        socd_state.was_dir2 = true;
26        socd_state.was_dir1 = false;
27        socd_state.lock_dir1 = false;
28    }
29    if (input_dir1 && !input_dir2 && !socd_state.lock_dir1) {
30        is_dir1 = true;
31        is_dir2 = false;
32        socd_state.was_dir1 = true;
33        socd_state.was_dir2 = false;
34        socd_state.lock_dir2 = false;
35    }
36    if (!input_dir1 && !input_dir2) {
37        socd_state.was_dir2 = false;
38        socd_state.was_dir1 = false;
39        socd_state.lock_dir1 = false;
40        socd_state.lock_dir2 = false;
41    }
42    input_dir1 = is_dir1;
43    input_dir2 = is_dir2;
44}
45
46void socd::second_input_priority(bool &input_dir1, bool &input_dir2, SocdState &socd_state) {
47    bool is_dir1 = false;
48    bool is_dir2 = false;
49    if (input_dir1 && socd_state.was_dir2) {
50        is_dir1 = true;
51        is_dir2 = false;
52    }
53    if (input_dir2 && socd_state.was_dir1) {
54        is_dir1 = false;
55        is_dir2 = true;
56    }
57    if (!input_dir1 && input_dir2) {
58        is_dir1 = false;
59        is_dir2 = true;
60        socd_state.was_dir2 = true;
61        socd_state.was_dir1 = false;
62    }
63    if (input_dir1 && !input_dir2) {
64        is_dir1 = true;
65        is_dir2 = false;
66        socd_state.was_dir1 = true;
67        socd_state.was_dir2 = false;
68    }
69    input_dir1 = is_dir1;
70    input_dir2 = is_dir2;
71}
72
73void socd::neutral(bool &input_dir1, bool &input_dir2) {
74    if (input_dir1 && input_dir2) {
75        input_dir1 = false;
76        input_dir2 = false;
77    }
78}
79
80void socd::dir1_priority(bool &input_dir1, bool &input_dir2) {
81    if (input_dir1 && input_dir2) {
82        input_dir2 = false;
83    }
84}