diff --git a/Firmware/MotorControl/axis.cpp b/Firmware/MotorControl/axis.cpp index 6130f782..7775d97d 100644 --- a/Firmware/MotorControl/axis.cpp +++ b/Firmware/MotorControl/axis.cpp @@ -303,6 +303,7 @@ bool Axis::run_closed_loop_control_loop() { // To avoid any transient on startup, we intialize the setpoint to be the current position controller_.pos_setpoint_ = *controller_.pos_estimate_src_; controller_.input_pos_ = *controller_.pos_estimate_src_; + controller_.input_pos_updated(); // Avoid integrator windup issues controller_.vel_integrator_current_ = 0.0f;