Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Sub: compass init never fails

This commit is contained in:
Peter Barker 2018-07-03 19:07:38 +10:00 committed by Peter Barker
parent b933f050b8
commit 069a2d0e35
1 changed files with 2 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
ArduSub/sensors.cpp
View File

@ -83,7 +83,8 @@ void Sub::rpm_update(void)
// initialise compass // initialise compass
void Sub::init_compass() void Sub::init_compass()
{ {
if (!compass.init() || !compass.read()) { compass.init();
if (!compass.read()) {
// make sure we don't pass a broken compass to DCM // make sure we don't pass a broken compass to DCM
hal.console->println("COMPASS INIT ERROR"); hal.console->println("COMPASS INIT ERROR");
Log_Write_Error(ERROR_SUBSYSTEM_COMPASS,ERROR_CODE_FAILED_TO_INITIALISE); Log_Write_Error(ERROR_SUBSYSTEM_COMPASS,ERROR_CODE_FAILED_TO_INITIALISE);