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"
 
#if __cplusplus < 201703L
extern double hypot(double x, double y, double z);
#endif  // C++17
 
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