Mavlink: allow to stop (WIP)