helpers.hpp

Go to the documentation of this file.

#ifndef HELPERS_HPP
#define HELPERS_HPP
#include <cmath>
template <typename T> int sgn(T val) {
    return (T(0) < val) - (val < T(0));
}


template <typename T> T length3d(T const a[3])
{
  T ret = 0.0;
  for(int i = 0; i < 3; i++)
  {
    ret += a[i]*a[i];
  }
  return sqrt(ret);
}

template <typename T> void normalize3d(T normalized[3], T const toNormalize[3] )
{
  T normalization = length3d(toNormalize);
   for(int i = 0; i < 3; i++)
  {
    normalized[i] = toNormalize[i]/normalization;
  }
}
template <typename T> T innerProduct(T const one[3], T const two[3])
{
  T sum = 0;
  for(int i = 0; i < 3; i++)
  {
    sum += one[i]*two[i];
  }
  return sum;
}

#define radToDeg(x) (180.0*x/M_PI)
#define degToRad(x) (M_PI*x/180.0)

#endif