AP_NavEKF3: log set source events

This commit is contained in:
Andrew Tridgell 2022-05-27 21:28:48 +10:00
parent 56c5a607e3
commit a91894ff2d
1 changed files with 3 additions and 0 deletions

View File

@ -1083,6 +1083,9 @@ void NavEKF3::resetCoreErrors(void)
// set position, velocity and yaw sources to either 0=primary, 1=secondary, 2=tertiary
void NavEKF3::setPosVelYawSourceSet(uint8_t source_set_idx)
{
if (source_set_idx < AP_NAKEKF_SOURCE_SET_MAX) {
AP::dal().log_event3(AP_DAL::Event(uint8_t(AP_DAL::Event::setSourceSet0)+source_set_idx));
}
sources.setPosVelYawSourceSet(source_set_idx);
}