diff --git a/src/main/mw.c b/src/main/mw.c index 37b3031427..db9eb66cde 100644 --- a/src/main/mw.c +++ b/src/main/mw.c @@ -647,7 +647,7 @@ static bool haveProcessedAnnexCodeOnce = false; void taskMainPidLoop(void) { cycleTime = getTaskDeltaTime(TASK_SELF); - dT = (float)cycleTime * 0.000001f; + dT = (float)targetLooptime * 0.000001f; // Calculate average cycle time and average jitter filteredCycleTime = filterApplyPt1(cycleTime, &filteredCycleTimeState, 1, dT);