58 lines
1.7 KiB
C
58 lines
1.7 KiB
C
#include "anim.h"
|
|
#include "log.h"
|
|
#include "stb_ds.h"
|
|
|
|
void sampler_add(sampler *s, float time, HMM_Vec4 val)
|
|
{
|
|
arrput(s->times,time);
|
|
arrput(s->data,val);
|
|
}
|
|
|
|
HMM_Vec4 sample_cubicspline(sampler *sampler, float t, int prev, int next)
|
|
{
|
|
float t2 = t*t;
|
|
float t3 = t2*t;
|
|
float td = sampler->times[next]-sampler->times[prev];
|
|
|
|
HMM_Vec4 v = HMM_MulV4F(sampler->data[prev*3+1], (2*t3-3*t2+1));
|
|
v = HMM_AddV4(v, HMM_MulV4F(sampler->data[prev*3+2], td*(t3-2*t2+t)));
|
|
v = HMM_AddV4(v, HMM_MulV4F(sampler->data[next*3+1], 3*t2-2*t3));
|
|
v = HMM_AddV4(v, HMM_MulV4F(sampler->data[next*3], td*(t3-t2)));
|
|
return v;
|
|
}
|
|
|
|
HMM_Vec4 sample_sampler(sampler *sampler, float time)
|
|
{
|
|
if (arrlen(sampler->data) == 0) return (HMM_Vec4){0,0,0,0};
|
|
if (arrlen(sampler->data) == 1) return sampler->data[0];
|
|
int previous_time=0;
|
|
int next_time=0;
|
|
|
|
for (int i = 1; i < arrlen(sampler->times); i++) {
|
|
if (time < sampler->times[i]) {
|
|
previous_time = sampler->times[i-1];
|
|
next_time = sampler->times[i];
|
|
break;
|
|
}
|
|
}
|
|
|
|
float td = sampler->times[next_time]-sampler->times[previous_time];
|
|
float t = (time - sampler->times[previous_time])/td;
|
|
|
|
switch(sampler->type) {
|
|
case LINEAR:
|
|
return HMM_LerpV4(sampler->data[previous_time],time,sampler->data[next_time]);
|
|
break;
|
|
case STEP:
|
|
return sampler->data[previous_time];
|
|
break;
|
|
case CUBICSPLINE:
|
|
return sample_cubicspline(sampler,t, previous_time, next_time);
|
|
break;
|
|
case SLERP:
|
|
return (HMM_Vec4)HMM_SLerp(sampler->data[previous_time].quat, time, sampler->data[next_time].quat);
|
|
break;
|
|
}
|
|
return sample_cubicspline(sampler,t, previous_time, next_time);
|
|
}
|