Fix issue #245

https://github.com/diydrones/apm_planner/issues/245