fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-30 05:54:06 +08:00
Code Issues Packages Projects Releases Wiki Activity

sensors: failover don't print remaining disabled sensors

Browse Source
This commit is contained in:
Daniel Agar 2020-05-04 16:27:17 -04:00
parent 692aaada31
commit 29f4fca7bf
1 changed files with 3 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
src/modules/sensors/voted_sensors_update.cpp
View File

@ -698,12 +698,11 @@ bool VotedSensorsUpdate::checkFailover(SensorData &sensor, const char *sensor_na
int ctr_valid = 0;
for (uint8_t i = 0; i < sensor.subscription_count; i++) {
if (sensor.priority[i] > ORB_PRIO_MIN) {
if (sensor.enabled[i] && (sensor.priority[i] > ORB_PRIO_MIN)) {
ctr_valid++;
PX4_INFO("Remaining sensors after failover %u: %s #%u priority: %u", failover_index, sensor_name, i,
sensor.priority[i]);
}
PX4_WARN("Remaining sensors after failover event %u: %s #%u priority: %u", failover_index, sensor_name, i,
sensor.priority[i]);
}
if (ctr_valid < 2) {