misc.h

Go to the documentation of this file.

#pragma once
#include "Base/Headers/Angle.h"
#include "macros.h"
#include <cmath>
 
/* utility helpers */

 
namespace NDEVR
{

    template <typename T>
    inline T square(T x)
    {
        return x * x;
    }

    template <typename T>
    inline T hypot(T x, T y)
    {
        return (T)(sqrt(x * x + y * y));
    }

    template <typename T>
    inline T hypot_sqr(T x, T y)
    {
        return x * x + y * y;
    }

    inline g_type deg2rad(g_type degree)
    {
        return degree * g_type(0.01745329251994329576);
    }

    inline g_type rad2deg(g_type rad)
    {
        return rad * g_type(57.29577951308232087721);
    }

    inline g_type average_angle(g_type theta1, g_type theta2)
    {
        g_type x, y;
 
        x = cos(theta1) + cos(theta2);
        y = sin(theta1) + sin(theta2);
        if (x == 0 && y == 0)
            return 0;
        else
            return std::atan2(y, x);
    }

    template <typename T>
    inline int sign(T x)
    {
        if (x > 0)
            return 1;
        else if (x < 0)
            return -1;
        else
            return 0;
    }

    template <typename T>
    inline T clamp(T l, T x, T u)
    {
        if (x < l)
            return l;
        if (x > u)
            return u;
        return x;
    }

    template <typename T>
    inline T wrap(T l, T x, T u)
    {
        T intervalWidth = u - l;
        while (x < l)
            x += intervalWidth;
        while (x > u)
            x -= intervalWidth;
        return x;
    }

    inline bool arrayHasInvalid(const g_type* array, int size, int* nanIndex = 0)
    {
        for (int i = 0; i < size; ++i)
            if (IsInvalid(array[i])) {
                if (nanIndex)
                    *nanIndex = i;
                return true;
            }
        return false;
    }

    extern "C"
    {
        typedef void (*ForceLinkFunction) (void);
    }

    struct ForceLinker
    {
        ForceLinker(ForceLinkFunction function) { (function)(); }
    };
 
 
}