something wrong with controller module

[saumonk]

Thanks very much for your contribution. When I run your package, a problem often appears as show below. Detailly, the drone often instantaneous drifts. Looking forward to hearing from you.

[tyuezhan]

Hi,

From our experience, this is an issue created by an aggressive stopping policy in simulation. One way to completely get rid of this is to switch to a stopping policy which is less aggressive. This will have no guarantee on where the quadrotor would fully stop but instead we could use "const jerk" or "const acceleration" as the control input to stop as soon as possible. For example, the one used in our kr_autonomous_flight. Please see: tyuezhan/kr_mav_control@708d0ea#diff-2cfc2f56716c5413b276bb59b718f66dd207f4ef95d185bb6da5afcfe34ee8ed
https://github.com/KumarRobotics/kr_autonomous_flight/blob/master/autonomy_core/state_machine/action_trackers/src/stopping_policy.cpp
for more details.