Fix for https://github.com/diydrones/apm_planner/issues/291