fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-01 12:41:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

sensors reduce priority of a failed sensor

Browse Source
This commit is contained in:
Daniel Agar
2017-10-29 16:24:31 +01:00
committed by Lorenz Meier
parent e5ead354f0
commit 2a1ecaa13e
1 changed files with 7 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/sensors/voted_sensors_update.cpp
+7 -2
View File
@@ -920,14 +920,19 @@ bool VotedSensorsUpdate::check_failover(SensorData &sensor, const char *sensor_n
} }
} else { } else {
int failover_index = sensor.voter.failover_index();
mavlink_log_emergency(&_mavlink_log_pub, "%s #%i fail: %s%s%s%s%s!", mavlink_log_emergency(&_mavlink_log_pub, "%s #%i fail: %s%s%s%s%s!",
sensor_name, sensor_name,
sensor.voter.failover_index(), failover_index,
((flags & DataValidator::ERROR_FLAG_NO_DATA) ? " OFF" : ""), ((flags & DataValidator::ERROR_FLAG_NO_DATA) ? " OFF" : ""),
((flags & DataValidator::ERROR_FLAG_STALE_DATA) ? " STALE" : ""), ((flags & DataValidator::ERROR_FLAG_STALE_DATA) ? " STALE" : ""),
((flags & DataValidator::ERROR_FLAG_TIMEOUT) ? " TOUT" : ""), ((flags & DataValidator::ERROR_FLAG_TIMEOUT) ? " TOUT" : ""),
((flags & DataValidator::ERROR_FLAG_HIGH_ERRCOUNT) ? " ECNT" : ""), ((flags & DataValidator::ERROR_FLAG_HIGH_ERRCOUNT) ? " ECNT" : ""),
((flags & DataValidator::ERROR_FLAG_HIGH_ERRDENSITY) ? " EDNST" : "")); ((flags & DataValidator::ERROR_FLAG_HIGH_ERRDENSITY) ? " EDNST" : ""));
// reduce priority of failed sensor to the minimum
sensor.priority[failover_index] = 1;
} }
sensor.last_failover_count = sensor.voter.failover_count(); sensor.last_failover_count = sensor.voter.failover_count();
@@ -1258,4 +1263,4 @@ void VotedSensorsUpdate::calc_mag_inconsistency(sensor_preflight_s &preflt)
// get the vector length of the largest difference and write to the combined sensor struct // get the vector length of the largest difference and write to the combined sensor struct
preflt.mag_inconsistency_ga = sqrtf(mag_diff_sum_max_sq); preflt.mag_inconsistency_ga = sqrtf(mag_diff_sum_max_sq);
} }
} }