Browse Source

output a message if a previously lost connection is regained

sbg
baumanta 6 years ago committed by Beat Küng
parent
commit
d8bdc1b367
  1. 10
      src/modules/commander/Commander.cpp

10
src/modules/commander/Commander.cpp

@ -3903,6 +3903,11 @@ void Commander::data_link_check(bool &status_changed) @@ -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) @@ -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;
}

Loading…
Cancel
Save