|
|
|
@ -64,6 +64,7 @@ void AP_Compass_HIL::read()
@@ -64,6 +64,7 @@ void AP_Compass_HIL::read()
|
|
|
|
|
uint8_t compass_instance = _compass_instance[i]; |
|
|
|
|
Vector3f field = _compass._hil.field[compass_instance]; |
|
|
|
|
rotate_field(field, compass_instance); |
|
|
|
|
publish_raw_field(field, hal.scheduler->micros(), compass_instance); |
|
|
|
|
correct_field(field, compass_instance); |
|
|
|
|
publish_filtered_field(field, compass_instance); |
|
|
|
|
} |
|
|
|
|