From d8bdc1b36775f105293fab73c6c64d7f1234fc46 Mon Sep 17 00:00:00 2001 From: baumanta Date: Thu, 10 Jan 2019 14:53:10 +0100 Subject: [PATCH] output a message if a previously lost connection is regained --- src/modules/commander/Commander.cpp | 10 ++++++++++ 1 file changed, 10 insertions(+) diff --git a/src/modules/commander/Commander.cpp b/src/modules/commander/Commander.cpp index 544815c665..eb02ff6cb2 100644 --- a/src/modules/commander/Commander.cpp +++ b/src/modules/commander/Commander.cpp @@ -3903,6 +3903,11 @@ void Commander::data_link_check(bool &status_changed) case (telemetry_status_s::MAV_TYPE_ONBOARD_CONTROLLER): _datalink_last_heartbeat_onboard_controller = telemetry.heartbeat_time; + + if (_onboard_controller_lost != false) { + mavlink_log_info(&mavlink_log_pub, "ONBOARD CONTROLLER REGAINED"); + } + _onboard_controller_lost = false; if (telemetry.remote_component_id == telemetry_status_s::COMPONENT_ID_OBSTACLE_AVOIDANCE) { @@ -3912,6 +3917,11 @@ void Commander::data_link_check(bool &status_changed) _datalink_last_heartbeat_avoidance_system = telemetry.heartbeat_time; _datalink_last_status_avoidance_system = telemetry.remote_system_status; + + if (_avoidance_system_lost != false) { + mavlink_log_info(&mavlink_log_pub, "AVOIDANCE SYSTEM REGAINED"); + } + _avoidance_system_lost = false; }