82 lines
2 KiB
C
82 lines
2 KiB
C
|
#include <stdlib.h>
|
||
|
|
|
||
|
|
#include "shared/types.h"
|
||
|
|
#include "shared/functions.h"
|
||
|
|
|
||
|
|
double toolsRandom()
|
||
|
|
{
|
||
|
|
return (double)rand() / (double)RAND_MAX;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline double __cubicInterpolate(double p[4], double x)
|
||
|
|
{
|
||
|
|
return p[1] + 0.5 * x * (p[2] - p[0] + x * (2.0 * p[0] - 5.0 * p[1] + 4.0 * p[2] - p[3] + x * (3.0 * (p[1] - p[2]) + p[3] - p[0])));
|
||
|
|
}
|
||
|
|
|
||
|
|
double toolsBicubicInterpolate(double stencil[16], double x, double y)
|
||
|
|
{
|
||
|
|
double buf_cubic_y[4];
|
||
|
|
|
||
|
|
buf_cubic_y[0] = __cubicInterpolate(stencil, x);
|
||
|
|
buf_cubic_y[1] = __cubicInterpolate(stencil + 4, x);
|
||
|
|
buf_cubic_y[2] = __cubicInterpolate(stencil + 8, x);
|
||
|
|
buf_cubic_y[3] = __cubicInterpolate(stencil + 12, x);
|
||
|
|
|
||
|
|
return __cubicInterpolate(buf_cubic_y, y);
|
||
|
|
}
|
||
|
|
|
||
|
|
void toolsFloat2DMapCopy(double* src, double* dest, int src_xstart, int src_ystart, int dest_xstart, int dest_ystart, int xsize, int ysize, int src_xstep, int src_ystep, int dest_xstep, int dest_ystep)
|
||
|
|
{
|
||
|
|
/* TODO Optimize with memcpy if src_xstep == dest_xstep == 1 */
|
||
|
|
int x, y;
|
||
|
|
double* src_row;
|
||
|
|
double* dest_row;
|
||
|
|
src += src_ystart * src_ystep + src_xstart * src_xstep;
|
||
|
|
dest += dest_ystart * dest_ystep + dest_xstart * dest_xstep;
|
||
|
|
for (y = 0; y < ysize; y++)
|
||
|
|
{
|
||
|
|
src_row = src;
|
||
|
|
dest_row = dest;
|
||
|
|
for (x = 0; x < xsize; x++)
|
||
|
|
{
|
||
|
|
*dest = *src;
|
||
|
|
src += src_xstep;
|
||
|
|
dest += dest_xstep;
|
||
|
|
}
|
||
|
|
src = src_row + src_ystep;
|
||
|
|
dest = dest_row + dest_ystep;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
Vector3 toolsGetNormalFromTriangle(Vector3 center, Vector3 bottom, Vector3 right)
|
||
|
|
{
|
||
|
|
Vector3 dx = v3Sub(right, center);
|
||
|
|
Vector3 dz = v3Sub(bottom, center);
|
||
|
|
return v3Normalize(v3Cross(dz, dx));
|
||
|
|
}
|
||
|
|
|
||
|
|
void toolsSaveDouble(FILE* f, double value)
|
||
|
|
{
|
||
|
|
fprintf(f, "%.20le;", value);
|
||
|
|
}
|
||
|
|
|
||
|
|
double toolsLoadDouble(FILE* f)
|
||
|
|
{
|
||
|
|
double value;
|
||
|
|
fscanf(f, "%le;", &value);
|
||
|
|
return value;
|
||
|
|
}
|
||
|
|
|
||
|
|
void toolsSaveInt(FILE* f, int value)
|
||
|
|
{
|
||
|
|
fprintf(f, "%d;", value);
|
||
|
|
}
|
||
|
|
|
||
|
|
int toolsLoadInt(FILE* f)
|
||
|
|
{
|
||
|
|
int value;
|
||
|
|
fscanf(f, "%d;", &value);
|
||
|
|
return value;
|
||
|
|
}
|
||
|
|
|