样条之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 < )
     {
         return(z);
     }
     if (n == )
     {
         z = YfGetFloatValue(valuesPtr, stride, );
         return(z);
     }

     float h = 1.0f/(n - );

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

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

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

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

     return(z);
 }

切图：

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