|
|
|
@ -481,7 +481,7 @@ void Sub::guided_angle_control_run()
@@ -481,7 +481,7 @@ void Sub::guided_angle_control_run()
|
|
|
|
|
float yaw_in = wrap_180_cd(guided_angle_state.yaw_cd); |
|
|
|
|
|
|
|
|
|
// constrain climb rate
|
|
|
|
|
float climb_rate_cms = constrain_float(guided_angle_state.climb_rate_cms, -fabsf(wp_nav.get_default_speed_down()), wp_nav.get_default_speed_up()); |
|
|
|
|
float climb_rate_cms = constrain_float(guided_angle_state.climb_rate_cms, -wp_nav.get_default_speed_down(), wp_nav.get_default_speed_up()); |
|
|
|
|
|
|
|
|
|
// check for timeout - set lean angles and climb rate to zero if no updates received for 3 seconds
|
|
|
|
|
uint32_t tnow = AP_HAL::millis(); |
|
|
|
|