Browse Source

AC_WPNav: AC_Loiter: Fix loiter level bug

master_rangefinder
Leonard Hall 2 years ago committed by Randy Mackay
parent
commit
af54acd202
  1. 4
      libraries/AC_WPNav/AC_Loiter.cpp

4
libraries/AC_WPNav/AC_Loiter.cpp

@ -118,8 +118,8 @@ void AC_Loiter::init_target() @@ -118,8 +118,8 @@ void AC_Loiter::init_target()
_pos_control.set_correction_speed_accel_xy(LOITER_VEL_CORRECTION_MAX, _accel_cmss);
_pos_control.set_pos_error_max_xy_cm(LOITER_POS_CORRECTION_MAX);
// initialise position controller
_pos_control.init_xy_controller();
// initialise position controller and move target accelerations smoothly towards zero
_pos_control.relax_velocity_controller_xy();
// initialise predicted acceleration and angles from the position controller
_predicted_accel.x = _pos_control.get_accel_target_cmss().x;

Loading…
Cancel
Save