Slight performance improvement
Prevent all oscillations around the target position/velocity