Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-19 22:35:19 +03:00
Code Issues Wiki Activity

Correctly reset Dterm filter

Browse source
This commit is contained in:
Pawel Spychalski (DzikuVx) 2019-02-23 20:23:57 +01:00
parent 4ca21cd2b3
commit e01d16a81d
2 changed files with 1 additions and 6 deletions
Download patch file Download diff file Expand all files Collapse all files

4
src/main/navigation/navigation.c
View file

@ -1703,7 +1703,6 @@ float navPidApply2(pidController_t *pid, const float setpoint, const float measu
return navPidApply3(pid, setpoint, measurement, dt, outMin, outMax, pidFlags, 1.0f);
}
void navPidReset(pidController_t *pid)
{
pid->reset = true;
@ -1713,8 +1712,7 @@ void navPidReset(pidController_t *pid)
pid->integrator = 0.0f;
pid->last_input = 0.0f;
pid->feedForward = 0.0f;
pid->dterm_filter_state.state = 0.0f;
pid->dterm_filter_state.RC = 0.0f;
pt1FilterReset(&pid->dterm_filter_state, 0.0f);
pid->output_constrained = 0.0f;
}