The delay problem is similar to the phenomenon in the post below. It may be caused by the shaping when calling AC_PosControl::input_pos_xyz. Modifying the radical jerk and acceleration parameters will improve it, but the delay will always exist. There is something inside the function call shape_pos_vel_accel. Time constraints, not sure if this is the cause