28 if (angle <= 2. * M_PI && angle > 0)
32 int n =
static_cast<int>(angle / (2. *
M_PI));
33 angle -= 2. *
M_PI *
n;
35 int n =
static_cast<int>(-(angle) / (2. *
M_PI));
36 angle += 2. *
M_PI * (
n + 1);
45 if (angle <= M_PI && angle > -
M_PI)
49 int n =
static_cast<int>((angle +
M_PI) / (2. *
M_PI));
50 angle -= 2 *
M_PI *
n;
52 int n =
static_cast<int>(-(angle -
M_PI) / (2. *
M_PI));
53 angle += 2 *
M_PI *
n;
double Phi_mpi_pi(double phi)
Returns phi angle in the interval (-PI,PI].
double Phi_0_2pi(double phi)
Return a phi angle in the interval (0,2*PI].