|
|
@ -710,7 +710,7 @@ static void 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.null_offsets(); |
|
|
|
compass.learn_offsets(); |
|
|
|
if (should_log(MASK_LOG_COMPASS)) { |
|
|
|
if (should_log(MASK_LOG_COMPASS)) { |
|
|
|
Log_Write_Compass(); |
|
|
|
Log_Write_Compass(); |
|
|
|
} |
|
|
|
} |
|
|
|