Maps any angle to the equivalent between -pi and pi
0001 %Maps any angle to the equivalent between -pi and pi 0002 function a=modAngle(a) 0003 a=mod(a+pi,2*pi)-pi;