Lerp Angle Function Matlab