Math.hh

Go to the documentation of this file.

#ifndef COSA_MATH_HH
#define COSA_MATH_HH

#include <math.h>
#include "Cosa/Types.h"

inline uint16_t
rand(uint16_t range)
{
  return (rand() % (range + 1));
}

inline int16_t
rand(int16_t low, int16_t high)
{
  return (rand() % (high - low + 1) + low);
}

inline uint32_t
random(uint32_t range)
{
  return (random() % (range + 1));
}

inline int32_t
random(int32_t low, int32_t high)
{
  return (random(high - low + 1) + low);
}

template<class T>
inline uint8_t log2(T value)
{
  uint8_t res = 0;
  while (value != 0) {
    res += 1;
    value >>= 1;
  }
  return (res);
}

template<class T, T in_min, T in_max, T out_min, T out_max>
T map(T x)
{
  static_assert(in_min < in_max, "bad range for map function");
  static_assert(out_min < out_max, "bad domain for map function");
  if (UNLIKELY(x < in_min)) return (out_min);
  if (UNLIKELY(x > in_max)) return (out_max);
  T range = in_max - in_min;
  T domain = out_max - out_min;
  return ((((x - in_min) * domain) / range) + out_min);
}

template<class T, T low, T high>
T constrain(T x)
{
  static_assert(low < high, "bad range for contrain function");
  return (x < low ? low : (x > high ? high : x));
}

template<class T, T low, T high>
bool is_within(T x)
{
  return (!(x < low || x > high));
}

#endif