fork/GramFirmware

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

CarVacrebase to configurator818d962

gram
1.7 KiB67 linesraw
1#include "comms/N64Backend.hpp"
2
3#include "core/InputSource.hpp"
4
5#include <N64Console.hpp>
6#include <hardware/pio.h>
7
8N64Backend::N64Backend(
9    InputState &inputs,
10    InputSource **input_sources,
11    size_t input_source_count,
12    uint data_pin,
13    PIO pio,
14    int sm,
15    int offset
16)
17    : CommunicationBackend(inputs, input_sources, input_source_count),
18      _n64(data_pin, pio, sm, offset) {
19    _report = default_n64_report;
20}
21
22CommunicationBackendId N64Backend::BackendId() {
23    return COMMS_BACKEND_N64;
24}
25
26void N64Backend::SendReport() {
27    // Update slower inputs before we start waiting for poll.
28    ScanInputs(InputScanSpeed::SLOW);
29    ScanInputs(InputScanSpeed::MEDIUM);
30
31    // Read inputs
32    _n64.WaitForPoll();
33
34    // Update fast inputs in response to poll.
35    ScanInputs(InputScanSpeed::FAST);
36
37    // Run gamemode logic.
38    UpdateOutputs();
39
40    // Digital outputs
41    _report.a = _outputs.a;
42    _report.b = _outputs.b;
43    _report.z = _outputs.buttonR;
44    _report.l = _outputs.triggerLDigital;
45    _report.r = _outputs.triggerRDigital;
46    _report.start = _outputs.start;
47    _report.dpad_left = _outputs.dpadLeft;
48    _report.dpad_right = _outputs.dpadRight;
49    _report.dpad_down = _outputs.dpadDown;
50    _report.dpad_up = _outputs.dpadUp;
51    // Somewhat ugly way of mapping right stick to C-Pad
52    _report.c_left = _outputs.rightStickX < 128;
53    _report.c_right = _outputs.rightStickX > 128;
54    _report.c_down = _outputs.rightStickY < 128;
55    _report.c_up = _outputs.rightStickY > 128;
56
57    // Analog outputs
58    _report.stick_x = _outputs.leftStickX - 128;
59    _report.stick_y = _outputs.leftStickY - 128;
60
61    // Send outputs to console.
62    _n64.SendReport(&_report);
63}
64
65int N64Backend::GetOffset() {
66    return _n64.GetOffset();
67}