fork/GramFirmware

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

Jonathan HaylettSOCD revamp (#57)1f92ae6

v0.1.2
2.1 KiB70 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(socd::SocdType socd_type) {
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::mod_x,   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
17void DarkSouls::UpdateDigitalOutputs(InputState &inputs, OutputState &outputs) {
18    outputs.y = inputs.y;
19    outputs.x = inputs.r;
20
21    // Base layer.
22    bool layer0 = !inputs.x && !inputs.nunchuk_c;
23    // Secondary layer when X is held.
24    bool layerX = inputs.x && !inputs.nunchuk_c;
25    // DPad layer when Nunchuk C is held.
26    bool layerC = inputs.nunchuk_c;
27
28    if (layer0) {
29        outputs.a = inputs.a;
30        outputs.b = inputs.b;
31        outputs.buttonR = inputs.z;
32        outputs.buttonL = inputs.up;
33        outputs.start = inputs.start | inputs.nunchuk_z;
34    } else if (layerX) {
35        outputs.rightStickClick = inputs.a;
36        outputs.triggerRDigital = inputs.z;
37        outputs.triggerLDigital = inputs.up;
38        outputs.select = inputs.start;
39    } else if (layerC) {
40        outputs.a = inputs.a;
41        outputs.dpadLeft = inputs.b;
42        outputs.dpadDown = inputs.x;
43        outputs.dpadUp = inputs.z;
44        outputs.dpadRight = inputs.up;
45        outputs.select = inputs.nunchuk_z;
46    }
47}
48
49void DarkSouls::UpdateAnalogOutputs(InputState &inputs, OutputState &outputs) {
50    UpdateDirections(
51        inputs.left,
52        inputs.right,
53        inputs.down,
54        inputs.mod_x,
55        inputs.c_left,
56        inputs.c_right,
57        inputs.c_down,
58        inputs.c_up,
59        ANALOG_STICK_MIN,
60        ANALOG_STICK_NEUTRAL,
61        ANALOG_STICK_MAX,
62        outputs
63    );
64
65    // Nunchuk overrides left stick.
66    if (inputs.nunchuk_connected) {
67        outputs.leftStickX = inputs.nunchuk_x;
68        outputs.leftStickY = inputs.nunchuk_y;
69    }
70}