diff --git a/libraries/AP_Logger/LoggerMessageWriter.cpp b/libraries/AP_Logger/LoggerMessageWriter.cpp index 0c15f73b8a..3c186eceaa 100644 --- a/libraries/AP_Logger/LoggerMessageWriter.cpp +++ b/libraries/AP_Logger/LoggerMessageWriter.cpp @@ -295,7 +295,7 @@ void LoggerMessageWriter_WriteSysInfo::process() { stage = Stage::RC_PROTOCOL; FALLTHROUGH; - case Stage::RC_PROTOCOL: + case Stage::RC_PROTOCOL: { const char *prot = hal.rcin->protocol(); if (prot == nullptr) { prot = "None"; @@ -303,6 +303,18 @@ void LoggerMessageWriter_WriteSysInfo::process() { if (! _logger_backend->Write_MessageF("RC Protocol: %s", prot)) { return; // call me again } + stage = Stage::RC_OUTPUT; + FALLTHROUGH; + } + case Stage::RC_OUTPUT: { + char banner_msg[50]; + if (hal.rcout->get_output_mode_banner(banner_msg, sizeof(banner_msg))) { + if (!_logger_backend->Write_Message(banner_msg)) { + return; // call me again + } + } + break; + } } _finished = true; // all done! diff --git a/libraries/AP_Logger/LoggerMessageWriter.h b/libraries/AP_Logger/LoggerMessageWriter.h index d89312bfcc..ddc69aa54f 100644 --- a/libraries/AP_Logger/LoggerMessageWriter.h +++ b/libraries/AP_Logger/LoggerMessageWriter.h @@ -35,7 +35,8 @@ private: VER, // i.e. the "VER" message SYSTEM_ID, PARAM_SPACE_USED, - RC_PROTOCOL + RC_PROTOCOL, + RC_OUTPUT, }; Stage stage; };