Telemetry push fix
This commit is contained in:
@@ -113,6 +113,7 @@ void Pxx2Pulses::setupTelemetryFrame(uint8_t module)
|
|||||||
for (uint8_t i = 0; i < outputTelemetryBuffer.size; i++) {
|
for (uint8_t i = 0; i < outputTelemetryBuffer.size; i++) {
|
||||||
Pxx2Transport::addByte(outputTelemetryBuffer.data[i]);
|
Pxx2Transport::addByte(outputTelemetryBuffer.data[i]);
|
||||||
}
|
}
|
||||||
|
outputTelemetryBuffer.reset();
|
||||||
}
|
}
|
||||||
|
|
||||||
void Pxx2Pulses::setupHardwareInfoFrame(uint8_t module)
|
void Pxx2Pulses::setupHardwareInfoFrame(uint8_t module)
|
||||||
|
|||||||
@@ -159,6 +159,10 @@ void logTelemetryWriteByte(uint8_t data);
|
|||||||
|
|
||||||
class OutputTelemetryBuffer {
|
class OutputTelemetryBuffer {
|
||||||
public:
|
public:
|
||||||
|
OutputTelemetryBuffer() {
|
||||||
|
reset();
|
||||||
|
}
|
||||||
|
|
||||||
void push(uint8_t byte) {
|
void push(uint8_t byte) {
|
||||||
data[size++] = byte;
|
data[size++] = byte;
|
||||||
}
|
}
|
||||||
@@ -174,6 +178,7 @@ class OutputTelemetryBuffer {
|
|||||||
void reset() {
|
void reset() {
|
||||||
size = 0;
|
size = 0;
|
||||||
trigger = 0x7E;
|
trigger = 0x7E;
|
||||||
|
destination = 0xFF;
|
||||||
}
|
}
|
||||||
|
|
||||||
public:
|
public:
|
||||||
|
|||||||
Reference in New Issue
Block a user