AP_Compass_HIL: use new compass backend interface

This commit is contained in:
Jonathan Challinger 2015-03-18 15:16:52 -07:00 committed by Andrew Tridgell
parent cd5cf45ba8
commit 8800d03fce
1 changed files with 5 additions and 1 deletions

View File

@ -61,7 +61,11 @@ void AP_Compass_HIL::read()
{
for (uint8_t i=0; i < ARRAY_SIZE(_compass_instance); i++) {
if (_compass._hil.healthy[i]) {
publish_field(_compass._hil.field[_compass_instance[i]], _compass_instance[i]);
uint8_t compass_instance = _compass_instance[i];
Vector3f field = _compass._hil.field[compass_instance];
rotate_field(field, compass_instance);
correct_field(field, compass_instance);
publish_filtered_field(field, compass_instance);
}
}
}