sensors: add accel/gyro current priority to sensors_status_imu

- later the sensor priorities (user configurable) can be factored into the estimator selection criteria
This commit is contained in:
Daniel Agar
2021-07-30 09:54:19 -04:00
parent b33fdf704b
commit 713a1d08a3
4 changed files with 29 additions and 1 deletions
@@ -305,3 +305,21 @@ uint32_t DataValidatorGroup::get_sensor_state(unsigned index)
// sensor index not found
return UINT32_MAX;
}
uint8_t DataValidatorGroup::get_sensor_priority(unsigned index)
{
DataValidator *next = _first;
unsigned i = 0;
while (next != nullptr) {
if (i == index) {
return next->priority();
}
next = next->sibling();
i++;
}
// sensor index not found
return 0;
}