PosititionControl: fix integrator windup with invalid setpoint

This commit is contained in:
Matthias Grob
2022-01-19 10:41:09 +01:00
parent 8811482f1d
commit d4e356a1ac
2 changed files with 24 additions and 15 deletions
@@ -179,7 +179,7 @@ public:
void getAttitudeSetpoint(vehicle_attitude_setpoint_s &attitude_setpoint) const;
private:
bool _updateSuccessful();
bool _inputValid();
void _positionControl(); ///< Position proportional control
void _velocityControl(const float dt); ///< Velocity PID control