Fixes #6745 (not pushed to the right branch!)

This commit is contained in:
Bertrand Songis
2019-09-14 11:12:31 +02:00
parent c126a082f7
commit ee2dce9725
+6 -4
View File
@@ -223,21 +223,23 @@ void telemetryInterrupt10ms()
#if !defined(SIMU) #if !defined(SIMU)
telemetryData.rssi.reset(); telemetryData.rssi.reset();
#endif #endif
for (int i=0; i<MAX_TELEMETRY_SENSORS; i++) { for (auto & telemetryItem: telemetryItems) {
telemetryItems[i].setOld(); if (telemetryItem.isAvailable()) {
telemetryItem.setOld();
}
} }
} }
} }
void telemetryReset() void telemetryReset()
{ {
memclear(&telemetryData, sizeof(telemetryData)); telemetryData.clear();
for (auto & telemetryItem : telemetryItems) { for (auto & telemetryItem : telemetryItems) {
telemetryItem.clear(); telemetryItem.clear();
} }
telemetryStreaming = 0; // reset counter only if valid frsky packets are being detected telemetryStreaming = 0; // reset counter only if valid telemetry packets are being detected
telemetryState = TELEMETRY_INIT; telemetryState = TELEMETRY_INIT;
} }