fork/GramFirmware

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

CarVacrebase to configurator818d962

gram
6.1 KiB179 linesraw
1/* Ultimate2 profile by Taker */
2#include "modes/extra/Ultimate2.hpp"
3
4#define ANALOG_STICK_MIN 28
5#define ANALOG_STICK_NEUTRAL 128
6#define ANALOG_STICK_MAX 228
7
8Ultimate2::Ultimate2() : ControllerMode() {}
9
10void Ultimate2::UpdateDigitalOutputs(const InputState &inputs, OutputState &outputs) {
11    outputs.a = inputs.rt1;
12    outputs.b = inputs.rf1;
13    outputs.x = inputs.rf2;
14    outputs.y = inputs.rf6;
15    outputs.buttonR = inputs.rf3;
16    outputs.triggerLDigital = inputs.lf4;
17    outputs.triggerRDigital = inputs.rf5;
18    outputs.start = inputs.mb1;
19
20    // Turn on D-Pad layer by holding Mod X + Mod Y, or Nunchuk C button.
21    if ((inputs.lt1 && inputs.lt2) || inputs.nunchuk_c) {
22        outputs.dpadUp = inputs.rt4;
23        outputs.dpadDown = inputs.rt2;
24        outputs.dpadLeft = inputs.rt3;
25        outputs.dpadRight = inputs.rt5;
26    }
27
28    if (inputs.mb3)
29        outputs.dpadLeft = true;
30    if (inputs.mb2)
31        outputs.dpadRight = true;
32}
33
34void Ultimate2::UpdateAnalogOutputs(const InputState &inputs, OutputState &outputs) {
35    // Coordinate calculations to make modifier handling simpler.
36    UpdateDirections(
37        inputs.lf3, // Left
38        inputs.lf1, // Right
39        inputs.lf2, // Down
40        inputs.rf4, // Up
41        inputs.rt3, // C-Left
42        inputs.rt5, // C-Right
43        inputs.rt2, // C-Down
44        inputs.rt4, // C-Up
45        ANALOG_STICK_MIN,
46        ANALOG_STICK_NEUTRAL,
47        ANALOG_STICK_MAX,
48        outputs
49    );
50
51    bool shield_button_pressed = inputs.lf4 || inputs.rf5 || inputs.rf7 || inputs.rf8;
52
53    if (inputs.lt1) {
54        // MX + Horizontal = 6625 = 53
55        if (directions.horizontal) {
56            outputs.leftStickX = 128 + (directions.x * 53);
57            // Horizontal Shield tilt = 51
58            if (shield_button_pressed) {
59                outputs.leftStickX = 128 + (directions.x * 51);
60            }
61            // Horizontal Tilts = 36
62            if (inputs.rt1) {
63                outputs.leftStickX = 128 + (directions.x * 36);
64            }
65        }
66        // MX + Vertical = 44
67        if (directions.vertical) {
68            outputs.leftStickY = 128 + (directions.y * 44);
69            // Vertical Shield Tilt = 51
70            if (shield_button_pressed) {
71                outputs.leftStickY = 128 + (directions.y * 51);
72            }
73        }
74        if (directions.diagonal) {
75            // MX + q1/2/3/4 = 53 40
76            outputs.leftStickX = 128 + (directions.x * 53);
77            outputs.leftStickY = 128 + (directions.y * 40);
78            if (shield_button_pressed) {
79                // MX + L, R, LS, and MS + q1/2/3/4 = 6375 3750 = 51 30
80                outputs.leftStickX = 128 + (directions.x * 51);
81                outputs.leftStickY = 128 + (directions.y * 30);
82            }
83        }
84
85        // Angled fsmash/ftilt with C-Stick + MX
86        if (directions.cx != 0) {
87            outputs.rightStickX = 128 + (directions.cx * 127);
88            outputs.rightStickY = 128 + (directions.y * 59);
89        }
90
91        /* Up B angles */
92        if (directions.diagonal && !shield_button_pressed) {
93            // (33.44) = 53 40
94            outputs.leftStickX = 128 + (directions.x * 53);
95            outputs.leftStickY = 128 + (directions.y * 40);
96
97            // Angled Ftilts
98            if (inputs.rt1) {
99                outputs.leftStickX = 128 + (directions.x * 36);
100                outputs.leftStickY = 128 + (directions.y * 26);
101            }
102        }
103    }
104
105    if (inputs.lt2) {
106        // MY + Horizontal (even if shield is held) = 41
107        if (directions.horizontal) {
108            outputs.leftStickX = 128 + (directions.x * 41);
109            // MY Horizontal Tilts
110            if (inputs.rt1) {
111                outputs.leftStickX = 128 + (directions.x * 36);
112            }
113        }
114        // MY + Vertical (even if shield is held) = 44
115        if (directions.vertical) {
116            outputs.leftStickY = 128 + (directions.y * 44);
117            // MY Vertical Tilts
118            if (inputs.rt1) {
119                outputs.leftStickY = 128 + (directions.y * 36);
120            }
121        }
122        if (directions.diagonal) {
123            // MY + q1/2/3/4 = 41 44
124            outputs.leftStickX = 128 + (directions.x * 41);
125            outputs.leftStickY = 128 + (directions.y * 44);
126            if (shield_button_pressed) {
127                // MY + L, R, LS, and MS + q1/2 = 38 70
128                outputs.leftStickX = 128 + (directions.x * 38);
129                outputs.leftStickY = 128 + (directions.y * 70);
130                // MY + L, R, LS, and MS + q3/4 = 40 68
131                if (directions.x == -1) {
132                    outputs.leftStickX = 128 + (directions.x * 40);
133                    outputs.leftStickY = 128 + (directions.y * 68);
134                }
135            }
136        }
137
138        /* Up B angles */
139        if (directions.diagonal && !shield_button_pressed) {
140            // (56.56) = 41 44
141            outputs.leftStickX = 128 + (directions.x * 41);
142            outputs.leftStickY = 128 + (directions.y * 44);
143
144            // MY Pivot Uptilt/Dtilt
145            if (inputs.rt1) {
146                outputs.leftStickX = 128 + (directions.x * 34);
147                outputs.leftStickY = 128 + (directions.y * 38);
148            }
149        }
150    }
151
152    // C-stick ASDI Slideoff angle overrides any other C-stick modifiers (such as
153    // angled fsmash).
154    if (directions.cx != 0 && directions.cy != 0) {
155        // 5250 8500 = 42 68
156        outputs.rightStickX = 128 + (directions.cx * 42);
157        outputs.rightStickY = 128 + (directions.cy * 68);
158    }
159
160    if (inputs.lf4) {
161        outputs.triggerLAnalog = 140;
162    }
163
164    if (inputs.rf5) {
165        outputs.triggerRAnalog = 140;
166    }
167
168    // Shut off C-stick when using D-Pad layer.
169    if ((inputs.lt1 && inputs.lt2) || inputs.nunchuk_c) {
170        outputs.rightStickX = 128;
171        outputs.rightStickY = 128;
172    }
173
174    // Nunchuk overrides left stick.
175    if (inputs.nunchuk_connected) {
176        outputs.leftStickX = inputs.nunchuk_x;
177        outputs.leftStickY = inputs.nunchuk_y;
178    }
179}