mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-06-27 14:40:34 +08:00
data_validator_group: add a method to get the state of the sensor with the provided index
This commit is contained in:
committed by
Daniel Agar
parent
0f4439d281
commit
011b4c2e4e
@@ -338,3 +338,22 @@ DataValidatorGroup::failover_state()
|
||||
|
||||
return DataValidator::ERROR_FLAG_NO_ERROR;
|
||||
}
|
||||
|
||||
uint32_t
|
||||
DataValidatorGroup::get_sensor_state(unsigned index)
|
||||
{
|
||||
DataValidator *next = _first;
|
||||
unsigned i = 0;
|
||||
|
||||
while (next != nullptr) {
|
||||
if (i == index) {
|
||||
return next->state();
|
||||
}
|
||||
|
||||
next = next->sibling();
|
||||
i++;
|
||||
}
|
||||
|
||||
// sensor index not found
|
||||
return UINT32_MAX;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user