sapphire/src/common/Util/UtilMath.h

#ifndef _UTILMATH_H
#define _UTILMATH_H

#include "Common.h"

#define PI 3.14159265358979323846f

namespace Core {
namespace Math {
namespace Util {

float distanceSq( float x, float y, float z, float x1, float y1, float z1 );

float distance( float x, float y, float z, float x1, float y1, float z1 );

float distance2DSq( float x, float y, float x1, float y1 );

float distance2D( float x, float y, float x1, float y1 );

float calcAngTo( float x, float y, float x1, float y1 );

float calcAngFrom( float x, float y, float x1, float y1 );

uint16_t floatToUInt16( float val );

uint16_t floatToUInt16Rot( float val );

uint8_t floatToUInt8Rot( float val );

template
  < typename T >
T clamp( T val, T minimum, T maximum )
{
  if( val > maximum )
  {
    return maximum;
  }

  if( val < minimum )
  {
    return minimum;
  }

  return val;
}
}
}
}

#endif