wrapToPi
Wrap angle in radians to [−pi, pi]
Description
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.
