Sub: stop position control when in velocity mode

This commit is contained in:
Willian Galvani 2022-09-13 10:36:57 -03:00
parent 61d854035c
commit 431ee46133

View File

@ -364,6 +364,7 @@ void Sub::guided_vel_control_run()
pos_control.set_vel_desired_cms(Vector3f(0,0,0));
}
pos_control.stop_pos_xy_stabilisation();
// call velocity controller which includes z axis controller
pos_control.update_xy_controller();
pos_control.update_z_controller();