diff --git a/radio/src/pulses/pxx2.cpp b/radio/src/pulses/pxx2.cpp index 18727d19a..07fe6d96f 100644 --- a/radio/src/pulses/pxx2.cpp +++ b/radio/src/pulses/pxx2.cpp @@ -113,6 +113,7 @@ void Pxx2Pulses::setupTelemetryFrame(uint8_t module) for (uint8_t i = 0; i < outputTelemetryBuffer.size; i++) { Pxx2Transport::addByte(outputTelemetryBuffer.data[i]); } + outputTelemetryBuffer.reset(); } void Pxx2Pulses::setupHardwareInfoFrame(uint8_t module) diff --git a/radio/src/telemetry/telemetry.h b/radio/src/telemetry/telemetry.h index e320f303a..bdab8d178 100644 --- a/radio/src/telemetry/telemetry.h +++ b/radio/src/telemetry/telemetry.h @@ -159,6 +159,10 @@ void logTelemetryWriteByte(uint8_t data); class OutputTelemetryBuffer { public: + OutputTelemetryBuffer() { + reset(); + } + void push(uint8_t byte) { data[size++] = byte; } @@ -174,6 +178,7 @@ class OutputTelemetryBuffer { void reset() { size = 0; trigger = 0x7E; + destination = 0xFF; } public: