mirror of https://github.com/ArduPilot/ardupilot
APM_Control: fixed test condition in AR_AttutudeControl.cpp
This commit is contained in:
parent
cc0b3705e9
commit
ce182fd307
|
@ -503,7 +503,7 @@ float AR_AttitudeControl::get_throttle_out_from_pitch(float desired_pitch, bool
|
||||||
const uint32_t now = AP_HAL::millis();
|
const uint32_t now = AP_HAL::millis();
|
||||||
|
|
||||||
// if not called recently, reset input filter
|
// if not called recently, reset input filter
|
||||||
if ((_balance_last_ms == 0) || ((now - _balance_last_ms) > (AR_ATTCONTROL_TIMEOUT_MS / 1000.0f))) {
|
if ((_balance_last_ms == 0) || ((now - _balance_last_ms) > (AR_ATTCONTROL_TIMEOUT_MS))) {
|
||||||
_pitch_to_throttle_pid.reset_filter();
|
_pitch_to_throttle_pid.reset_filter();
|
||||||
} else {
|
} else {
|
||||||
_pitch_to_throttle_pid.set_dt(dt);
|
_pitch_to_throttle_pid.set_dt(dt);
|
||||||
|
|
Loading…
Reference in New Issue