Calculating Angular Velocity and Displacement