commander: handle RC loss timeout if manual_control_setpoint stops publishing (#19680)

Co-authored-by: Matthias Grob <maetugr@gmail.com>
This commit is contained in:
Daniel Agar
2022-05-20 19:37:30 -04:00
committed by GitHub
co-authored by Matthias Grob
parent 2bdeb36ea3
commit c40631c136
3 changed files with 122 additions and 93 deletions
@@ -53,6 +53,7 @@ void ManualControlSelector::updateWithNewInputSample(uint64_t now, const manual_
if (isInputValid(input, now) && (update_existing_input || start_using_new_input)) {
_setpoint = input;
_setpoint.valid = true;
_setpoint.timestamp = now; // timestamp_sample is preserved
_instance = instance;
if (_first_valid_source == manual_control_setpoint_s::SOURCE_UNKNOWN) {