From 98f89aae9b97b604b9b2ce4bec7d302c4f6efd4d Mon Sep 17 00:00:00 2001 From: Daniel Agar Date: Wed, 24 Mar 2021 15:15:07 -0400 Subject: [PATCH] drivers/rc_input: always report new lock --- src/drivers/rc_input/RCInput.cpp | 12 +++++++----- 1 file changed, 7 insertions(+), 5 deletions(-) diff --git a/src/drivers/rc_input/RCInput.cpp b/src/drivers/rc_input/RCInput.cpp index 5ed5066cd4..106bedf461 100644 --- a/src/drivers/rc_input/RCInput.cpp +++ b/src/drivers/rc_input/RCInput.cpp @@ -246,6 +246,8 @@ void RCInput::set_rc_scan_state(RC_SCAN newState) _rc_scan_begin = 0; _rc_scan_state = newState; _rc_scan_locked = false; + + _report_lock = true; } void RCInput::rc_io_invert(bool invert) @@ -388,11 +390,6 @@ void RCInput::Run() unsigned frame_drops = 0; - if (_report_lock && _rc_scan_locked) { - _report_lock = false; - PX4_INFO("RC scan: %s RC input locked", RC_SCAN_STRING[_rc_scan_state]); - } - int newBytes = 0; // TODO: needs work (poll _rcs_fd) @@ -704,6 +701,11 @@ void RCInput::Run() } else if (!rc_updated && ((hrt_absolute_time() - _rc_in.timestamp_last_signal) > 1_s)) { _rc_scan_locked = false; } + + if (_report_lock && _rc_scan_locked) { + _report_lock = false; + PX4_INFO("RC scan: %s RC input locked", RC_SCAN_STRING[_rc_scan_state]); + } } }