Fixed functions position and velocity