Function rad_norm

utils/algorithms.cpp:144–148

}

float rad_norm(float radian)
{
    radian = std::fmod(radian, 2 * PI);
    return (radian <= -PI) ? radian + 2 * PI : (radian > PI) ? radian - 2 * PI : radian;
}