Change position feed-forward and Tn_v resulting in smoother motion