AP_Compass: fixed SITL compass

This commit is contained in:
Andrew Tridgell 2015-09-09 14:24:39 +10:00
parent f1322252ae
commit 3699932417
1 changed files with 1 additions and 0 deletions

View File

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