|
|
|
@ -1139,7 +1139,7 @@ void QuadPlane::control_auto(const Location &loc)
@@ -1139,7 +1139,7 @@ void QuadPlane::control_auto(const Location &loc)
|
|
|
|
|
// call attitude controller
|
|
|
|
|
attitude_control->input_euler_angle_roll_pitch_euler_rate_yaw_smooth(plane.nav_roll_cd, |
|
|
|
|
plane.nav_pitch_cd, |
|
|
|
|
desired_auto_yaw_rate_cds(), |
|
|
|
|
desired_auto_yaw_rate_cds() + get_weathervane_yaw_rate_cds(), |
|
|
|
|
smoothing_gain); |
|
|
|
|
if (plane.auto_state.wp_proportion >= 1 || |
|
|
|
|
plane.auto_state.wp_distance < 5) { |
|
|
|
|