样条之EHMT插值函数

 核心代码：

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

    // 初值
    z = 0.0f;

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

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

    for (i = 1; i <= n; i++)
    { 
        s = 1.0; 
        q = (i-1)*h;
        for (j = 1; j <= n; j++)
        { 
            p = (j-1)*h;
            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)*h);
            }
        }

        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);
}

切图：

 

相关软件的下载地址为：http://files.cnblogs.com/WhyEngine/TestSpline.zip