From 29f4fca7bf5244df6751e044255e4341338f327e Mon Sep 17 00:00:00 2001 From: Daniel Agar Date: Mon, 4 May 2020 16:27:17 -0400 Subject: [PATCH] sensors: failover don't print remaining disabled sensors --- src/modules/sensors/voted_sensors_update.cpp | 7 +++---- 1 file changed, 3 insertions(+), 4 deletions(-) diff --git a/src/modules/sensors/voted_sensors_update.cpp b/src/modules/sensors/voted_sensors_update.cpp index ce67ca4006..1effcf5248 100644 --- a/src/modules/sensors/voted_sensors_update.cpp +++ b/src/modules/sensors/voted_sensors_update.cpp @@ -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) {