|
|
|
@ -564,7 +564,7 @@ void Copter::guided_angle_control_run()
@@ -564,7 +564,7 @@ void Copter::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, -fabs(wp_nav.get_speed_down()), wp_nav.get_speed_up()); |
|
|
|
|
float climb_rate_cms = constrain_float(guided_angle_state.climb_rate_cms, -fabsf(wp_nav.get_speed_down()), wp_nav.get_speed_up()); |
|
|
|
|
|
|
|
|
|
// check for timeout - set lean angles and climb rate to zero if no updates received for 3 seconds
|
|
|
|
|
uint32_t tnow = millis(); |
|
|
|
|