diff --git a/ArduCopterMega/ArduCopterMega.pde b/ArduCopterMega/ArduCopterMega.pde index d09513cc8c..eb047a33c4 100644 --- a/ArduCopterMega/ArduCopterMega.pde +++ b/ArduCopterMega/ArduCopterMega.pde @@ -598,11 +598,6 @@ static void fast_loop() // record throttle output // ------------------------------ throttle_integrator += g.rc_3.servo_out; - - #if HIL_PROTOCOL == HIL_PROTOCOL_MAVLINK && HIL_MODE != HIL_MODE_DISABLED - // HIL for a copter needs very fast update of the servo values - hil.send_message(MSG_RADIO_OUT); - #endif } static void medium_loop() @@ -771,6 +766,11 @@ static void medium_loop() // --------------------------- static void fifty_hz_loop() { + #if HIL_PROTOCOL == HIL_PROTOCOL_MAVLINK && HIL_MODE != HIL_MODE_DISABLED + // HIL for a copter needs very fast update of the servo values + hil.send_message(MSG_RADIO_OUT); + #endif + // use Yaw to find our bearing error calc_bearing_error();