1 #include "../include/animorph/MathUtil.h"
2 
3 using namespace Animorph;
4 
wrapPi(float theta)5 float Animorph::wrapPi (float theta)
6 {
7   theta += M_PI;
8   theta -= floor (theta / (2.0 * M_PI)) * 2.0 * M_PI;
9   theta -= M_PI;
10 
11   return theta;
12 }
13