fork/GramFirmware

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

CarVacrebase to configurator818d962

gram
1.7 KiB62 linesraw
1#include "modes/extra/DarkSouls.hpp"
2
3#define ANALOG_STICK_MIN 0
4#define ANALOG_STICK_NEUTRAL 128
5#define ANALOG_STICK_MAX 255
6
7DarkSouls::DarkSouls() : ControllerMode() {}
8
9void DarkSouls::UpdateDigitalOutputs(const InputState &inputs, OutputState &outputs) {
10    outputs.y = inputs.rf6;
11    outputs.x = inputs.rf5;
12
13    // Base layer.
14    bool layer0 = !inputs.rf2 && !inputs.nunchuk_c;
15    // Secondary layer when X is held.
16    bool layerX = inputs.rf2 && !inputs.nunchuk_c;
17    // DPad layer when Nunchuk C is held.
18    bool layerC = inputs.nunchuk_c;
19
20    if (layer0) {
21        outputs.a = inputs.rt1;
22        outputs.b = inputs.rf1;
23        outputs.buttonR = inputs.rf3;
24        outputs.buttonL = inputs.rf4;
25        outputs.start = inputs.mb1 | inputs.nunchuk_z;
26    } else if (layerX) {
27        outputs.rightStickClick = inputs.rt1;
28        outputs.triggerRDigital = inputs.rf3;
29        outputs.triggerLDigital = inputs.rf4;
30        outputs.select = inputs.mb1;
31    } else if (layerC) {
32        outputs.a = inputs.rt1;
33        outputs.dpadLeft = inputs.rf1;
34        outputs.dpadDown = inputs.rf2;
35        outputs.dpadUp = inputs.rf3;
36        outputs.dpadRight = inputs.rf4;
37        outputs.select = inputs.nunchuk_z;
38    }
39}
40
41void DarkSouls::UpdateAnalogOutputs(const InputState &inputs, OutputState &outputs) {
42    UpdateDirections(
43        inputs.lf3,
44        inputs.lf1,
45        inputs.lf2,
46        inputs.lt1,
47        inputs.rt3,
48        inputs.rt5,
49        inputs.rt2,
50        inputs.rt4,
51        ANALOG_STICK_MIN,
52        ANALOG_STICK_NEUTRAL,
53        ANALOG_STICK_MAX,
54        outputs
55    );
56
57    // Nunchuk overrides left stick.
58    if (inputs.nunchuk_connected) {
59        outputs.leftStickX = inputs.nunchuk_x;
60        outputs.leftStickY = inputs.nunchuk_y;
61    }
62}