diff --git a/src/modules/simulation/gz_bridge/GZMixingInterfaceServo.cpp b/src/modules/simulation/gz_bridge/GZMixingInterfaceServo.cpp index 19b5625120f6..6131b5ab94d9 100644 --- a/src/modules/simulation/gz_bridge/GZMixingInterfaceServo.cpp +++ b/src/modules/simulation/gz_bridge/GZMixingInterfaceServo.cpp @@ -64,6 +64,8 @@ bool GZMixingInterfaceServo::updateOutputs(bool stop_motors, uint16_t outputs[MA for (auto &servo_pub : _servos_pub) { if (_mixing_output.isFunctionSet(i)) { gz::msgs::Double servo_output; + // Servo output represents values in the range [0, 3600] + // with an offset of 180 deg, and a scaling of 10. double output = math::radians((double)outputs[i] / 10. - 180.); // std::cout << "outputs[" << i << "]: " << outputs[i] << std::endl;