样条之埃尔米特(Hermite)插值函数

//////////////////////////////////////////////////////////////////////
// 埃尔米特等距插值
//////////////////////////////////////////////////////////////////////
static float GetValueHermite(const void* valuesPtr, int stride, int n, float t, float dc)
{
int i,j;
float z,s,p,q, v, d;

// 初值
z = 0.0;

// 特例处理
if (n < 1)
{
return(z);
}
if (n == 1)
{
z = YfGetFloatValue(valuesPtr, stride, 0);
return(z);
}

float xStep = 1.0f/(n - 1);

// 循环插值
for (i = 1; i <= n; i++)
{
s = 1.0f;
q = (i-1)*xStep;

for (j = 1; j <= n; j++)
{
p = (j-1)*xStep;
if (j != i)
{
s = s*(t-p)/(q-p);
}
}

s = s*s;
p = 0.0f;

for (j = 1; j <= n; j++)
{
if (j != i)
{
p = p+1.0f/(q-((j-1)*xStep));
}
}

v = YfGetFloatValue(valuesPtr, stride, i - 1);
if (i < n)
{
d = YfGetFloatValue(valuesPtr, stride, i) - v;
}
else
{
d = v - YfGetFloatValue(valuesPtr, stride, i - 2);
}

q = v + (t-q)*(d*dc-2.0f*v*p);
z = z + q*s;
}

return(z);
}