navigator: some warnings and cleanup
Merge branch 'navigator_cleanup' of github.com:PX4/Firmware into navigator_cleanup