fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-28 08:43:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

ECL: Factor in error counts from sensor

Browse Source
This commit is contained in:
Lorenz Meier
2015-08-19 10:23:50 +02:00
parent c9d0b54a6f
commit 1148ba4a77
2 changed files with 12 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/ecl/validation/data_validator_group.h
+4 -1
View File
@@ -118,15 +118,18 @@ DataValidatorGroup::get_best(uint64_t timestamp, int *index)
// XXX This should eventually also include voting
float max_confidence = 0.0f;
int max_index = -1;
uint64_t min_error_count = 30000;
DataValidator *best = nullptr;
unsigned i = 0;
while (next != nullptr) {
float confidence = next->confidence(timestamp);
if (confidence > max_confidence) {
if (confidence > max_confidence &&
next->error_count() < min_error_count) {
max_index = i;
max_confidence = confidence;
min_error_count = next->error_count();
best = next;
}
next = next->sibling();