Browse Source

Plane: fixed position control in QLAND_FINAL

mission-4.1.18
Andrew Tridgell 8 years ago
parent
commit
aab20317a0
  1. 9
      ArduPlane/quadplane.cpp

9
ArduPlane/quadplane.cpp

@ -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: {

Loading…
Cancel
Save