fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

mc_pos_control_main - Re-add updateVelocityControllerIO for glitch-free position unlock

Browse Source
This commit is contained in:
bresch 2019-02-27 10:21:22 +01:00 committed by Matthias Grob
parent 1eced05359
commit 684e2974ac
1 changed files with 4 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
src/modules/mc_pos_control/mc_pos_control_main.cpp
View File

@ -777,6 +777,10 @@ MulticopterPositionControl::run()
// vehicle intention.
publish_local_pos_sp(local_pos_sp);
// Inform FlightTask about the input and output of the velocity controller
// This is used to properly initialize the velocity setpoint when onpening the position loop (position unlock)
_flight_tasks.updateVelocityControllerIO(_control.getVelSp(), local_pos_sp.thrust);
// Part of landing logic: if ground-contact/maybe landed was detected, turn off
// controller. This message does not have to be logged as part of the vehicle_local_position_setpoint topic.
// Note: only adust thrust output if there was not thrust-setpoint demand in D-direction.