diff --git a/libraries/AP_HAL_SITL/RCOutput.cpp b/libraries/AP_HAL_SITL/RCOutput.cpp index 5f6d4deb04..d0d40e782a 100644 --- a/libraries/AP_HAL_SITL/RCOutput.cpp +++ b/libraries/AP_HAL_SITL/RCOutput.cpp @@ -2,24 +2,46 @@ #if CONFIG_HAL_BOARD == HAL_BOARD_SITL #include "RCOutput.h" +#include + +#define ENABLE_DEBUG 0 + +#if ENABLE_DEBUG +# define Debug(fmt, args ...) do {::printf("%s:%d: " fmt "\n", __FUNCTION__, __LINE__, ## args); } while(0) +#else +# define Debug(fmt, args ...) +#endif using namespace HALSITL; void SITLRCOutput::init() {} -void SITLRCOutput::set_freq(uint32_t chmask, uint16_t freq_hz) { +void SITLRCOutput::set_freq(uint32_t chmask, uint16_t freq_hz) +{ + Debug("set_freq(0x%04x, %u)\n", (unsigned)chmask, (unsigned)freq_hz); _freq_hz = freq_hz; } -uint16_t SITLRCOutput::get_freq(uint8_t ch) { +uint16_t SITLRCOutput::get_freq(uint8_t ch) +{ return _freq_hz; } void SITLRCOutput::enable_ch(uint8_t ch) -{} +{ + if (!(_enable_mask & (1U<