Displacement and Velocity Calculation