From 19190fb1347cd586922e4de9d8e41566ebd622d2 Mon Sep 17 00:00:00 2001 From: Peter Barker Date: Fri, 13 May 2022 14:02:24 +1000 Subject: [PATCH] AP_Airspeed: log airspeed primary changes --- libraries/AP_Airspeed/AP_Airspeed.cpp | 7 +++++++ 1 file changed, 7 insertions(+) diff --git a/libraries/AP_Airspeed/AP_Airspeed.cpp b/libraries/AP_Airspeed/AP_Airspeed.cpp index a0d6d31e79..edff9dc0a2 100644 --- a/libraries/AP_Airspeed/AP_Airspeed.cpp +++ b/libraries/AP_Airspeed/AP_Airspeed.cpp @@ -637,6 +637,10 @@ void AP_Airspeed::update() } #endif +#if HAL_LOGGING_ENABLED + const uint8_t old_primary = primary; +#endif + // setup primary if (healthy(primary_sensor.get())) { primary = primary_sensor.get(); @@ -652,6 +656,9 @@ void AP_Airspeed::update() check_sensor_failures(); #if HAL_LOGGING_ENABLED + if (primary != old_primary) { + AP::logger().Write_Event(LogEvent::AIRSPEED_PRIMARY_CHANGED); + } if (_log_bit != (uint32_t)-1 && AP::logger().should_log(_log_bit)) { Log_Airspeed(); }