ds_math.h

/* Copyright (C) 2017 - 2024, Thornwave Labs Inc - All Rights Reserved.
 * Unauthorized copying of this file, via any medium is strictly prohibited.
 * Proprietary and confidential.
 * Written by Razvan Turiac <razvan.turiac@thornwave.com>
*/
 
#ifndef _DS_MATH_H
#define _DS_MATH_H
 
 
#include <stdint.h>
#include <stdlib.h>
#include <math.h>
 
 
 
template <typename T>
static inline void swap(T &a, T &b)
{
    const T temp = a;
    a = b;
    b = temp;
}
 
 
template <typename T, typename Q>
static inline T min(T a, Q b)
{
    return (a < b) ? a : b;
}
 
 
template <typename T, typename Q>
static inline T max(T a, Q b)
{
    return (a > b) ? a : b;
}
 
 
template <typename T, typename Q, typename P>
static inline T sat(T x, Q a, P b)
{
    if (x < a)
        return a;
    else if (x > b)
        return b;
    else
        return x;
}
 
 
#ifdef DS_MATH_LIB
 
 
static inline float frac(float x)
{
    return x - (int32_t)x;
}
 
 
static inline float fsat(float x, float min, float max)
{
    return fmin(fmax(min, x), max);
}
 
 
static inline int32_t round_closest_signed(int32_t n, int32_t d)
{
    return (((n < 0) ^ (d < 0)) ? ((n - d / 2) / d) : ((n + d / 2) / d)) * d;
}
 
 
static inline uint32_t round_closest_unsigned(uint32_t n, uint32_t d)
{
    return ((n + d / 2) / d) * d;
}
 
 
#endif
 
 
#endif