MathToolbox.hpp

Go to the documentation of this file.

//
// MathToolbox.hpp
//
//
// Math functions and definitions.
//

#if !defined(MATHTOOLBOX_HPP)
#define MATHTOOLBOX_HPP

#include <math.h>
#include <cmath>        // for abs()
#include "../BasicDatatypes.hpp"


extern double hypot(double x, double y, double z);

extern const double NaN_double;


inline bool fuzzyCompare (double a, double b)
{
        return std::abs(a - b) < 1E-11;
}

//
// Square
//
inline double sqr(double val)
{
        return val * val;
}


inline bool fuzzyCompare(float a, float b)
{
        return std::abs(a - b) < 1E-6f;
}


// Normalizes an angle in radians to the interval [-pi,+pi)
double normalizeRadians (double radians);


template<typename floatT>
inline bool isNaN (floatT x)
{
        return (x != x);
}


template<typename IntT>
inline IntT round_to_int (float floatValue)
{

        //      assert (std::numeric_limits<float>::round_style == std::round_toward_zero);
        //      static_cast<IntT>() rounds toward zero
        return IntT (floatValue + (floatValue >= 0.0f ? + 0.5f : -0.5f));
}


template<typename IntT>
inline IntT round_to_int (double floatValue)
{

        //      assert (std::numeric_limits<double>::round_style == std::round_toward_zero);
        //      static_cast<IntT>() rounds toward zero
        return IntT (floatValue + (floatValue >= 0.0 ? + 0.5 : -0.5));
}


#endif // MATHTOOLBOX