AP_Compass: initialise compass IDs saved in SITL

this ensures we don't get uncalibrates compasses in SITL
This commit is contained in:
Andrew Tridgell
2018-07-13 10:19:01 +10:00
parent 087aa1a199
commit 2fe2c8fbda
3 changed files with 14 additions and 0 deletions
+3
View File
@@ -15,6 +15,9 @@ AP_Compass_SITL::AP_Compass_SITL(Compass &compass):
for (uint8_t i=0; i<SITL_NUM_COMPASSES; i++) {
_compass_instance[i] = register_compass();
set_dev_id(_compass_instance[i], AP_HAL::Device::make_bus_id(AP_HAL::Device::BUS_TYPE_SITL, i, 0, DEVTYPE_SITL));
// save so the compass always comes up configured in SITL
save_dev_id(_compass_instance[i]);
}
hal.scheduler->register_timer_process(FUNCTOR_BIND(this, &AP_Compass_SITL::_timer, void));
}