fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-07-12 17:00:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

Removed hardcoded onboard controller timeouts thresholds.

Browse Source 
Added COM_ONB_LOSS_T and COM_ONB_REG_T parameters to specify thresholds that triggers "onboard link lost" and "onboard link regained".


Signed-off-by: Claudio Micheli <claudio@auterion.com>
This commit is contained in:
Claudio Micheli
2019-02-26 14:29:09 +01:00
committed by Beat Küng
parent 156317e546
commit 14415b29c1
3 changed files with 33 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/commander/Commander.cpp
+3 -2
View File
@@ -3907,7 +3907,7 @@ void Commander::data_link_check(bool &status_changed)
_datalink_last_heartbeat_onboard_controller = telemetry.heartbeat_time;
if (_onboard_controller_lost) {
if (hrt_elapsed_time(&_datalink_last_heartbeat_onboard_controller) < (5_s)) {
if (hrt_elapsed_time(&_datalink_last_heartbeat_onboard_controller) < _onboard_regain_threshold.get() * 1_s) {
mavlink_log_info(&mavlink_log_pub, "ONBOARD CONTROLLER REGAINED");
_onboard_controller_lost = false;
}
@@ -3951,7 +3951,8 @@ void Commander::data_link_check(bool &status_changed)
// ONBOARD CONTROLLER data link loss failsafe (hard coded 5 seconds)
if ((_datalink_last_heartbeat_onboard_controller > 0)
&& (hrt_elapsed_time(&_datalink_last_heartbeat_onboard_controller) > 5_s) && !_onboard_controller_lost) {
&& (hrt_elapsed_time(&_datalink_last_heartbeat_onboard_controller) > _onboard_loss_timeout.get() * 1_s)
&& !_onboard_controller_lost) {
mavlink_log_critical(&mavlink_log_pub, "ONBOARD CONTROLLER LOST");
_onboard_controller_lost = true;