fix debug variables on f3

This commit is contained in:
Thorsten Laux 2019-03-01 12:54:45 +01:00
parent 0bb52bd9b8
commit 4af3308edf
1 changed files with 2 additions and 0 deletions

View File

@ -72,11 +72,13 @@ FAST_CODE void pwmWriteDshotInt(uint8_t index, uint16_t value)
/*If there is a command ready to go overwrite the value and send that instead*/
if (pwmDshotCommandIsProcessing()) {
value = pwmGetDshotCommand(index);
#ifdef USE_DSHOT_TELEMETRY
// reset telemetry debug statistics every time telemetry is enabled
if (value == DSHOT_CMD_SIGNAL_LINE_CONTINUOUS_ERPM_TELEMETRY) {
dshotInvalidPacketCount = 0;
readDoneCount = 0;
}
#endif
if (value) {
motor->requestTelemetry = true;
}