|
|
@ -239,7 +239,6 @@ void Rover::update_compass(void) |
|
|
|
if (g.compass_enabled && compass.read()) { |
|
|
|
if (g.compass_enabled && compass.read()) { |
|
|
|
ahrs.set_compass(&compass); |
|
|
|
ahrs.set_compass(&compass); |
|
|
|
// update offsets
|
|
|
|
// update offsets
|
|
|
|
compass.learn_offsets(); |
|
|
|
|
|
|
|
if (should_log(MASK_LOG_COMPASS)) { |
|
|
|
if (should_log(MASK_LOG_COMPASS)) { |
|
|
|
DataFlash.Log_Write_Compass(compass); |
|
|
|
DataFlash.Log_Write_Compass(compass); |
|
|
|
} |
|
|
|
} |
|
|
|