3dpcp/.svn/pristine/ea/ea7a68c2ea16183573f1855ab417c03d2eb679bb.svn-base

145 lines
2.6 KiB
Text
Raw Normal View History

2012-09-16 12:33:11 +00:00
#ifndef _MATHUTIL_H
#define _MATHUTIL_H
#include <math.h>
#include <stdlib.h>
#include <assert.h>
#include <float.h>
#ifndef _MSC_VER
#define _finite finite
#endif
//#define INFINITY FLT_MAX
#define M_PI 3.14159265358979323846
//#define M_PI_2 3.14159265358979323846*2
//#define NAN 0
#define to_radians(x) ( (x) * (M_PI / 180.0 ))
#define to_degrees(x) ( (x) * (180.0 / M_PI ))
void sincos(double ra, double * sinra, double* cosra);
int isless(double x, double y);
//inline int isfinite(double x) { return _finite(x); }
static inline double sq(double v)
{
return v*v;
}
static inline double sgn(double v)
{
return (v>=0) ? 1 : -1;
}
// random number between [0, 1)
static inline float randf()
{
return ((float) rand()) / (RAND_MAX + 1.0);
}
static inline float signed_randf()
{
return randf()*2 - 1;
}
#ifdef _MSC_VER
static inline double fmin(double a, double b)
{
return (a < b) ? a : b;
}
static inline double fmax(double a, double b)
{
return (a > b) ? a : b;
}
#endif
// return a random integer between [0, bound)
static inline int irand(int bound)
{
int v = (int) (randf()*bound);
assert(v >= 0);
assert(v < bound);
return v;
}
#ifndef PI
#define PI 3.14159265358979323846264338
#endif
#define TWOPI_INV (0.5/PI)
#define TWOPI (2*PI)
/** valid only for v > 0 **/
static inline double mod2pi_positive(double vin)
{
double q = vin * TWOPI_INV + 0.5;
int qi = (int) q;
return vin - qi*TWOPI;
}
/** Map v to [-PI, PI] **/
static inline double mod2pi(double vin)
{
if (vin < 0)
return -mod2pi_positive(-vin);
else
return mod2pi_positive(vin);
}
/** Return vin such that it is within PI degrees of ref **/
static inline double mod2pi_ref(double ref, double vin)
{
return ref + mod2pi(vin - ref);
}
static inline int theta_to_int(double theta, int max)
{
theta = mod2pi_ref(M_PI, theta);
int v = (int) (theta / ( 2 * M_PI ) * max);
if (v==max)
v = 0;
assert (v >= 0 && v < max);
return v;
}
static inline int imin(int a, int b)
{
return (a < b) ? a : b;
}
static inline int imax(int a, int b)
{
return (a > b) ? a : b;
}
static inline float fmin(float a, float b)
{
return (a < b) ? a : b;
}
static inline float fmax(float a, float b)
{
return (a > b) ? a : b;
}
static inline int iclamp(int v, int minv, int maxv)
{
return imax(minv, imin(v, maxv));
}
static inline double fclamp(double v, double minv, double maxv)
{
return fmax(minv, fmin(v, maxv));
}
#endif