|
|
|
@ -1639,13 +1639,14 @@ void QuadPlane::vtol_position_controller(void)
@@ -1639,13 +1639,14 @@ void QuadPlane::vtol_position_controller(void)
|
|
|
|
|
// run loiter controller
|
|
|
|
|
wp_nav->update_loiter(ekfGndSpdLimit, ekfNavVelGainScaler); |
|
|
|
|
|
|
|
|
|
attitude_control->input_euler_angle_roll_pitch_euler_rate_yaw(plane.nav_roll_cd, |
|
|
|
|
plane.nav_pitch_cd, |
|
|
|
|
get_pilot_input_yaw_rate_cds() + get_weathervane_yaw_rate_cds(), |
|
|
|
|
smoothing_gain); |
|
|
|
|
// nav roll and pitch are controller by position controller
|
|
|
|
|
plane.nav_roll_cd = pos_control->get_roll(); |
|
|
|
|
plane.nav_pitch_cd = pos_control->get_pitch(); |
|
|
|
|
|
|
|
|
|
attitude_control->input_euler_angle_roll_pitch_euler_rate_yaw(plane.nav_roll_cd, |
|
|
|
|
plane.nav_pitch_cd, |
|
|
|
|
get_pilot_input_yaw_rate_cds() + get_weathervane_yaw_rate_cds(), |
|
|
|
|
smoothing_gain); |
|
|
|
|
break; |
|
|
|
|
|
|
|
|
|
case QPOS_POSITION1: { |
|
|
|
|