fork/GramFirmware

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

Jonathan HaylettMerge pull request #7 from JonnyHaystack/v23ab6a9b

v0.1.0
1.8 KiB61 linesraw
1#include "comms/N64Backend.hpp"
2
3#include <Nintendo.h>
4
5N64Backend::N64Backend(
6    InputSource **input_sources,
7    size_t input_source_count,
8    int polling_rate,
9    int data_pin
10)
11    : CommunicationBackend(input_sources, input_source_count) {
12    _n64 = new CN64Console(data_pin);
13    _data = defaultN64Data;
14
15    if (polling_rate > 0) {
16        // Delay used between input updates to postpone them until right before the
17        // next poll, while also leaving time (850us) for processing to finish.
18        _delay = (1000000 / polling_rate) - 850;
19    } else {
20        // If polling rate is set to 0, disable the delay.
21        _delay = 0;
22    }
23}
24
25N64Backend::~N64Backend() {
26    delete _n64;
27}
28
29void N64Backend::SendReport() {
30    // Update inputs from all sources at once.
31    ScanInputs();
32
33    // Run gamemode logic.
34    UpdateOutputs();
35
36    // Digital outputs
37    _data.report.a = _outputs.a;
38    _data.report.b = _outputs.b;
39    _data.report.z = _outputs.buttonR;
40    _data.report.l = _outputs.triggerLDigital;
41    _data.report.r = _outputs.triggerRDigital;
42    _data.report.start = _outputs.start;
43    _data.report.dleft = _outputs.dpadLeft;
44    _data.report.dright = _outputs.dpadRight;
45    _data.report.ddown = _outputs.dpadDown;
46    _data.report.dup = _outputs.dpadUp;
47    // Somewhat ugly way of mapping right stick to C-Pad
48    _data.report.cleft = _outputs.rightStickX < 128;
49    _data.report.cright = _outputs.rightStickX > 128;
50    _data.report.cdown = _outputs.rightStickY < 128;
51    _data.report.cup = _outputs.rightStickY > 128;
52
53    // Analog outputs - converted from unsigned to signed 8-bit integers
54    _data.report.xAxis = _outputs.leftStickX - 128;
55    _data.report.yAxis = _outputs.leftStickY - 128;
56
57    // Send outputs to console.
58    _n64->write(_data);
59
60    delayMicroseconds(_delay);
61}