diff --git a/libraries/SITL/SIM_FlightAxis.cpp b/libraries/SITL/SIM_FlightAxis.cpp index d232fdbb21e..94385017805 100644 --- a/libraries/SITL/SIM_FlightAxis.cpp +++ b/libraries/SITL/SIM_FlightAxis.cpp @@ -296,12 +296,13 @@ void FlightAxis::exchange_data(const struct sitl_input &input) scaled_servos[1] = constrain_float(pitch_rate + 0.5, 0, 1); } + const uint16_t channels = hal.scheduler->is_system_initialized()?4095:0; if (!sock) { soap_request_start("ExchangeData", R"( -4095 +%u %.4f %.4f @@ -320,18 +321,19 @@ void FlightAxis::exchange_data(const struct sitl_input &input) )", - scaled_servos[0], - scaled_servos[1], - scaled_servos[2], - scaled_servos[3], - scaled_servos[4], - scaled_servos[5], - scaled_servos[6], - scaled_servos[7], - scaled_servos[8], - scaled_servos[9], - scaled_servos[10], - scaled_servos[11]); + channels, + scaled_servos[0], + scaled_servos[1], + scaled_servos[2], + scaled_servos[3], + scaled_servos[4], + scaled_servos[5], + scaled_servos[6], + scaled_servos[7], + scaled_servos[8], + scaled_servos[9], + scaled_servos[10], + scaled_servos[11]); } char *reply = nullptr;