fork/GramFirmware

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

Jonathan HaylettSOCD revamp (#57)1f92ae6

codespace-scaling-space-guide-56rpxqvxpg2v57v
10.9 KiB305 linesraw
1#include "modes/Melee18Button.hpp"
2
3#define ANALOG_STICK_MIN 48
4#define ANALOG_STICK_NEUTRAL 128
5#define ANALOG_STICK_MAX 208
6
7Melee18Button::Melee18Button(socd::SocdType socd_type, Melee18ButtonOptions options) {
8    _socd_pair_count = 4;
9    _socd_pairs = new socd::SocdPair[_socd_pair_count]{
10        socd::SocdPair{&InputState::left,    &InputState::right,   socd_type},
11        socd::SocdPair{ &InputState::down,   &InputState::up,      socd_type},
12        socd::SocdPair{ &InputState::c_left, &InputState::c_right, socd_type},
13        socd::SocdPair{ &InputState::c_down, &InputState::c_up,    socd_type},
14    };
15
16    _options = options;
17    horizontal_socd = false;
18}
19
20void Melee18Button::HandleSocd(InputState &inputs) {
21    horizontal_socd = inputs.left && inputs.right;
22    InputMode::HandleSocd(inputs);
23}
24
25void Melee18Button::UpdateDigitalOutputs(InputState &inputs, OutputState &outputs) {
26    outputs.a = inputs.a;
27    outputs.b = inputs.b;
28    outputs.x = inputs.x;
29    outputs.y = inputs.y;
30    outputs.buttonR = inputs.z;
31    if (inputs.nunchuk_connected) {
32        // Lightshield with C button.
33        if (inputs.nunchuk_c) {
34            outputs.triggerLAnalog = 49;
35        }
36        outputs.triggerLDigital = inputs.nunchuk_z;
37    } else {
38        outputs.triggerLDigital = inputs.l;
39    }
40    outputs.triggerRDigital = inputs.r;
41    outputs.start = inputs.start;
42
43    // Activate D-Pad layer by holding Mod X + Mod Y.
44    if (inputs.mod_x && inputs.mod_y) {
45        outputs.dpadUp = inputs.c_up;
46        outputs.dpadDown = inputs.c_down;
47        outputs.dpadLeft = inputs.c_left;
48        outputs.dpadRight = inputs.c_right;
49    }
50
51    if (inputs.select)
52        outputs.dpadLeft = true;
53    if (inputs.home)
54        outputs.dpadRight = true;
55}
56
57void Melee18Button::UpdateAnalogOutputs(InputState &inputs, OutputState &outputs) {
58    // Coordinate calculations to make modifier handling simpler.
59    UpdateDirections(
60        inputs.left,
61        inputs.right,
62        inputs.down,
63        inputs.up,
64        inputs.c_left,
65        inputs.c_right,
66        inputs.c_down,
67        inputs.c_up,
68        ANALOG_STICK_MIN,
69        ANALOG_STICK_NEUTRAL,
70        ANALOG_STICK_MAX,
71        outputs
72    );
73
74    bool shield_button_pressed = inputs.l || inputs.r;
75
76    if (directions.diagonal && directions.y == -1 && _options.crouch_walk_os) {
77        outputs.leftStickX = 128 + (directions.x * 56);
78        outputs.leftStickY = 128 + (directions.y * 55);
79    }
80
81    if (inputs.mod_x) {
82        if (directions.horizontal) {
83            outputs.leftStickX = 128 + (directions.x * 53);
84        }
85        if (directions.vertical) {
86            outputs.leftStickY = 128 + (directions.y * 43);
87        }
88
89        // Angled fsmash
90        if (directions.cx != 0) {
91            // 8500 5250 = 68 42
92            outputs.rightStickX = 128 + (directions.cx * 68);
93            outputs.rightStickY = 128 + (directions.y * 42);
94        }
95
96        /* Up B angles */
97        if (directions.diagonal && !shield_button_pressed) {
98            // 22.9638 - 7375 3125 = 59 25
99            outputs.leftStickX = 128 + (directions.x * 59);
100            outputs.leftStickY = 128 + (directions.y * 25);
101            // 27.37104 - 7000 3625 (27.38) = 56 29
102            if (inputs.c_down) {
103                outputs.leftStickX = 128 + (directions.x * 56);
104                outputs.leftStickY = 128 + (directions.y * 29);
105            }
106            // 31.77828 - 7875 4875 (31.76) = 63 39
107            if (inputs.c_left) {
108                outputs.leftStickX = 128 + (directions.x * 63);
109                outputs.leftStickY = 128 + (directions.y * 39);
110            }
111            // 36.18552 - 7000 5125 (36.21) = 56 41
112            if (inputs.c_up) {
113                outputs.leftStickX = 128 + (directions.x * 56);
114                outputs.leftStickY = 128 + (directions.y * 41);
115            }
116            // 40.59276 - 6125 5250 (40.6) = 49 42
117            if (inputs.c_right) {
118                outputs.leftStickX = 128 + (directions.x * 49);
119                outputs.leftStickY = 128 + (directions.y * 42);
120            }
121
122            /* Extended Up B Angles */
123            if (inputs.b) {
124                // 22.9638 - 9125 3875 (23.0) = 73 31
125                outputs.leftStickX = 128 + (directions.x * 73);
126                outputs.leftStickY = 128 + (directions.y * 31);
127                // 27.37104 - 8750 4500 (27.2) = 70 36
128                if (inputs.c_down) {
129                    outputs.leftStickX = 128 + (directions.x * 70);
130                    outputs.leftStickY = 128 + (directions.y * 36);
131                }
132                // 31.77828 - 8500 5250 (31.7) = 68 42
133                if (inputs.c_left) {
134                    outputs.leftStickX = 128 + (directions.x * 68);
135                    outputs.leftStickY = 128 + (directions.y * 42);
136                }
137                // 36.18552 - 7375 5375 (36.1) = 59 43
138                if (inputs.c_up) {
139                    outputs.leftStickX = 128 + (directions.x * 59);
140                    outputs.leftStickY = 128 + (directions.y * 43);
141                }
142                // 40.59276 - 6375 5375 (40.1) = 51 43
143                if (inputs.c_right) {
144                    outputs.leftStickX = 128 + (directions.x * 51);
145                    outputs.leftStickY = 128 + (directions.y * 43);
146                }
147            }
148        }
149    }
150
151    if (inputs.mod_y) {
152        if (directions.horizontal) {
153            outputs.leftStickX = 128 + (directions.x * 27);
154        }
155        if (directions.vertical) {
156            outputs.leftStickY = 128 + (directions.y * 59);
157        }
158
159        // Turnaround neutral B nerf
160        if (inputs.b) {
161            outputs.leftStickX = 128 + (directions.x * 80);
162        }
163
164        /* Up B angles */
165        if (directions.diagonal && !shield_button_pressed) {
166            // 67.0362 - 3125 7375 = 25 59
167            outputs.leftStickX = 128 + (directions.x * 25);
168            outputs.leftStickY = 128 + (directions.y * 59);
169            // 62.62896 - 3625 7000 (62.62) = 29 56
170            if (inputs.c_down) {
171                outputs.leftStickX = 128 + (directions.x * 29);
172                outputs.leftStickY = 128 + (directions.y * 56);
173            }
174            // 58.22172 - 4875 7875 (58.24) = 39 63
175            if (inputs.c_left) {
176                outputs.leftStickX = 128 + (directions.x * 39);
177                outputs.leftStickY = 128 + (directions.y * 63);
178            }
179            // 53.81448 - 5125 7000 (53.79) = 41 56
180            if (inputs.c_up) {
181                outputs.leftStickX = 128 + (directions.x * 41);
182                outputs.leftStickY = 128 + (directions.y * 56);
183            }
184            // 49.40724 - 6375 7625 (50.10) = 51 61
185            if (inputs.c_right) {
186                outputs.leftStickX = 128 + (directions.x * 51);
187                outputs.leftStickY = 128 + (directions.y * 61);
188            }
189
190            /* Extended Up B Angles */
191            if (inputs.b) {
192                // 67.0362 - 3875 9125 = 31 73
193                outputs.leftStickX = 128 + (directions.x * 31);
194                outputs.leftStickY = 128 + (directions.y * 73);
195                // 62.62896 - 4500 8750 (62.8) = 36 70
196                if (inputs.c_down) {
197                    outputs.leftStickX = 128 + (directions.x * 36);
198                    outputs.leftStickY = 128 + (directions.y * 70);
199                }
200                // 58.22172 - 5250 8500 (58.3) = 42 68
201                if (inputs.c_left) {
202                    outputs.leftStickX = 128 + (directions.x * 42);
203                    outputs.leftStickY = 128 + (directions.y * 68);
204                }
205                // 53.81448 - 5875 8000 (53.7) = 47 64
206                if (inputs.c_up) {
207                    outputs.leftStickX = 128 + (directions.x * 47);
208                    outputs.leftStickY = 128 + (directions.y * 64);
209                }
210                // 49.40724 - 5875 7125 (50.49) = 47 57
211                if (inputs.c_right) {
212                    outputs.leftStickX = 128 + (directions.x * 47);
213                    outputs.leftStickY = 128 + (directions.y * 57);
214                }
215            }
216        }
217    }
218
219    if (inputs.l) {
220        // L overrides modifiers, both for wavedash nerf and so MX/MY can give midshield/lightshield
221        // without forcing shield tilt.
222        if (directions.horizontal) {
223            outputs.leftStickX = 128 + (directions.x * 80);
224            if (directions.y == 1) {
225                outputs.leftStickX = 128 + (directions.x * 43);
226                outputs.leftStickY = 128 + 43;
227            }
228            if (directions.y == -1) {
229                outputs.leftStickX = 128 + (directions.x * 57);
230                outputs.leftStickY = 128 - 55;
231            }
232        }
233        if (directions.vertical) {
234            outputs.leftStickY = 128 + (directions.y * 80);
235        }
236
237        // L + Mod X = midshield
238        if (inputs.mod_x) {
239            outputs.triggerLDigital = false;
240            outputs.triggerRAnalog = 94;
241
242            if (directions.diagonal) {
243                outputs.leftStickX = 128 + (directions.x * 51);
244                outputs.leftStickY = 128 + (directions.y * 30);
245            }
246        }
247        // L + Mod Y = lightshield
248        if (inputs.mod_y) {
249            outputs.triggerLDigital = false;
250            outputs.triggerRAnalog = 49;
251
252            if (directions.diagonal) {
253                outputs.leftStickX = 128 + (directions.x * 40);
254                outputs.leftStickY = 128 + (directions.y * 68);
255            }
256        }
257    }
258
259    // Holding R gives special shield tilt and wavedash coordinates.
260    if (inputs.r) {
261        if (directions.horizontal) {
262            outputs.leftStickX = 128 + (directions.x * 51);
263        }
264        if (directions.vertical) {
265            outputs.leftStickY = 128 + (directions.y * 43);
266        }
267        if (directions.diagonal) {
268            outputs.leftStickX = 128 + (directions.x * 43);
269            if (inputs.mod_x) {
270                outputs.leftStickX = 128 + (directions.x * 51);
271                outputs.leftStickY = 128 + (directions.y * 30);
272            }
273            if (inputs.mod_y) {
274                outputs.leftStickX = 128 + (directions.x * 40);
275                outputs.leftStickY = 128 + (directions.y * 68);
276            }
277        }
278    }
279
280    // C-stick ASDI Slideoff angle overrides any other C-stick modifiers (such as
281    // angled fsmash).
282    if (directions.cx != 0 && directions.cy != 0) {
283        // 5250 8500 = 42 68
284        outputs.rightStickX = 128 + (directions.cx * 42);
285        outputs.rightStickY = 128 + (directions.cy * 68);
286    }
287
288    // Horizontal SOCD overrides X-axis modifiers (for ledgedash maximum jump
289    // trajectory).
290    if (!inputs.r && horizontal_socd && !directions.vertical) {
291        outputs.leftStickX = 128 + (directions.x * 80);
292    }
293
294    // Shut off C-stick when using D-Pad layer.
295    if ((inputs.mod_x && inputs.mod_y) || inputs.nunchuk_c) {
296        outputs.rightStickX = 128;
297        outputs.rightStickY = 128;
298    }
299
300    // Nunchuk overrides left stick.
301    if (inputs.nunchuk_connected) {
302        outputs.leftStickX = inputs.nunchuk_x;
303        outputs.leftStickY = inputs.nunchuk_y;
304    }
305}