mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-10 18:08:30 -04:00
AC_AttitudeControl: properly protect sqrt_controller from nonpositive acceleration limits
This commit is contained in:
parent
0fe0787265
commit
b8223771d3
@ -634,7 +634,7 @@ void AC_AttitudeControl::set_throttle_out_unstabilized(float throttle_in, bool r
|
|||||||
|
|
||||||
float AC_AttitudeControl::sqrt_controller(float error, float p, float second_ord_lim)
|
float AC_AttitudeControl::sqrt_controller(float error, float p, float second_ord_lim)
|
||||||
{
|
{
|
||||||
if (is_zero(second_ord_lim) || is_zero(p)) {
|
if (second_ord_lim < 0.0f || is_zero(second_ord_lim) || is_zero(p)) {
|
||||||
return error*p;
|
return error*p;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user