There are many ways to interpolate and you always need to sample previous results, here’s one:
I do not know what method you’re using for movement. Here I needed to disable movement and account for control rotation. The settings are restored once the target position and rotation are reached.