diff --git a/libraries/GCS_MAVLink/GCS_Dummy.cpp b/libraries/GCS_MAVLink/GCS_Dummy.cpp new file mode 100644 index 0000000000..09360e538c --- /dev/null +++ b/libraries/GCS_MAVLink/GCS_Dummy.cpp @@ -0,0 +1,24 @@ +#include "GCS_Dummy.h" +#include + +#define FORCE_VERSION_H_INCLUDE +#include +#undef FORCE_VERSION_H_INCLUDE + +const struct GCS_MAVLINK::stream_entries GCS_MAVLINK::all_stream_entries[] {}; + +/* + send_text implementation for dummy GCS + */ +void GCS_Dummy::send_textv(MAV_SEVERITY severity, const char *fmt, va_list arg_list, uint8_t dest_bitmask) +{ +#if !APM_BUILD_TYPE(APM_BUILD_Replay) + hal.console->printf("TOGCS: "); + hal.console->vprintf(fmt, arg_list); + hal.console->printf("\n"); +#else + ::printf("TOGCS: "); + ::vprintf(fmt, arg_list); + ::printf("\n"); +#endif +} diff --git a/libraries/GCS_MAVLink/GCS_Dummy.h b/libraries/GCS_MAVLink/GCS_Dummy.h index f490017c11..eb956b7d85 100644 --- a/libraries/GCS_MAVLink/GCS_Dummy.h +++ b/libraries/GCS_MAVLink/GCS_Dummy.h @@ -8,12 +8,6 @@ #define FW_PATCH 4 #define FW_TYPE FIRMWARE_VERSION_TYPE_DEV -#define FORCE_VERSION_H_INCLUDE -#include -#undef FORCE_VERSION_H_INCLUDE - -const struct GCS_MAVLINK::stream_entries GCS_MAVLINK::all_stream_entries[] {}; - /* * GCS backend used for many examples and tools */ @@ -83,11 +77,7 @@ private: return (GCS_MAVLINK_Dummy *)_chan[ofs]; }; - void send_textv(MAV_SEVERITY severity, const char *fmt, va_list arg_list, uint8_t dest_bitmask) override { - hal.console->printf("TOGCS: "); - hal.console->vprintf(fmt, arg_list); - hal.console->printf("\n"); - } + void send_textv(MAV_SEVERITY severity, const char *fmt, va_list arg_list, uint8_t dest_bitmask) override; MAV_TYPE frame_type() const override { return MAV_TYPE_FIXED_WING; } uint32_t custom_mode() const override { return 3; } // magic number