MathToolbox.cpp

Go to the documentation of this file.

//
// MathToolbox.cpp
//
//
// Math functions.
//

#include "MathToolbox.hpp"
#include <limits>


const double NaN_double = std::numeric_limits<double>::quiet_NaN();
//const float NaN = std::numeric_limits<float>::quiet_NaN();

double hypot(double x, double y, double z)
{
        return sqrt(x*x + y*y + z*z);
}


double normalizeRadians (double radians)
{
        if (std::abs(radians) > PI)
        {
                // For numerical stability we must use this sin/cos/atan2
                // implementation even though it might consume more cycles.
                // Note that radians = -pi converts to atan2(0,-1) = +pi!
                radians = std::atan2 (std::sin(radians), std::cos(radians));
                // radians now in (-pi,+pi]
        }
        if (radians == PI)      // equality of doubles ... just for the sake of completeness
        {
                // Convert half-open interval from  (-pi,+pi]  to  [-pi,+pi)
                radians = -PI;
        }
        return radians;
}