Calculating Angular Displacement Equation