From 069a2d0e350fef4c8cb4824fa63b1952c7ebf06c Mon Sep 17 00:00:00 2001 From: Peter Barker Date: Tue, 3 Jul 2018 19:07:38 +1000 Subject: [PATCH] Sub: compass init never fails --- ArduSub/sensors.cpp | 3 ++- 1 file changed, 2 insertions(+), 1 deletion(-) diff --git a/ArduSub/sensors.cpp b/ArduSub/sensors.cpp index 4e1c481b3b..501477fa3a 100644 --- a/ArduSub/sensors.cpp +++ b/ArduSub/sensors.cpp @@ -83,7 +83,8 @@ void Sub::rpm_update(void) // initialise 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 hal.console->println("COMPASS INIT ERROR"); Log_Write_Error(ERROR_SUBSYSTEM_COMPASS,ERROR_CODE_FAILED_TO_INITIALISE);