wrapToPi
Wrap angle in radians to [−pi, pi]
Description
wraps angles in lambdaWrapped = wrapToPi(lambda)lambda, in radians, to the interval
[−pi, pi] such that pi maps to
pi and −pi maps to −pi.
In general, odd, positive multiples of pi map to
pi and odd, negative multiples of pi map
to −pi.
