Telemetry push fix

This commit is contained in:
Bertrand Songis
2019-03-22 12:05:19 +01:00
parent ed1d312f20
commit 92e3b75e2c
2 changed files with 6 additions and 0 deletions
+1
View File
@@ -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)
+5
View File
@@ -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: