diff --git a/libraries/AP_HAL_ChibiOS/RCInput.cpp b/libraries/AP_HAL_ChibiOS/RCInput.cpp index 9bb2b4586e..4734637002 100644 --- a/libraries/AP_HAL_ChibiOS/RCInput.cpp +++ b/libraries/AP_HAL_ChibiOS/RCInput.cpp @@ -26,6 +26,7 @@ extern AP_IOMCU iomcu; #endif #include +#include #define SIG_DETECT_TIMEOUT_US 500000 using namespace ChibiOS; @@ -132,6 +133,10 @@ void RCInput::_timer_tick(void) _rc_values[i] = rcin_prot.read(i); } rcin_mutex.give(); + if (rcin_prot.protocol_name() != last_protocol) { + last_protocol = rcin_prot.protocol_name(); + gcs().send_text(MAV_SEVERITY_DEBUG, "RCInput: decoding %s", last_protocol); + } } #endif diff --git a/libraries/AP_HAL_ChibiOS/RCInput.h b/libraries/AP_HAL_ChibiOS/RCInput.h index 1e85bd54a6..08ef54eb77 100644 --- a/libraries/AP_HAL_ChibiOS/RCInput.h +++ b/libraries/AP_HAL_ChibiOS/RCInput.h @@ -62,6 +62,8 @@ private: int16_t _rssi = -1; uint32_t _rcin_timestamp_last_signal; bool _init; + const char *last_protocol; + #if HAL_RCINPUT_WITH_AP_RADIO bool _radio_init; AP_Radio *radio;