三次样条插值三弯矩matlab_曲线拟合/样条插值的C++及MATLAB实现（三十四）

最新推荐文章于 2023-01-07 12:51:58 发布

邪与

最新推荐文章于 2023-01-07 12:51:58 发布

阅读量880

点赞数 1

文章标签：三次样条插值三弯矩matlab

本文链接：https://blog.csdn.net/weixin_35879114/article/details/113368538

版权

本文介绍了三次样条插值的概念和在MATLAB中的实现，包括C++源代码示例，以及与AutoCAD插值结果的比较。文中讨论了参数化方法、阶次选择、边界条件设定，特别是端点切矢量的处理，并提供了与OpenCV相关的后续内容。

摘要由CSDN通过智能技术生成

一、二维点C++实现：

SplineInterpolation.cpp

#include "SplineInterpolation.h"// find the index i where xn >= x_i[i]int FindPositionID_0(float *x_i, float xn, int InputDataLen, float InterplotGap){
    #define X0_i_FirstPixel    1.0f  int i = xn - X0_i_FirstPixel;  return i;}// find the index i where xn >= x_i[i]int FindPositionID_search(float *x_i, float xn, int InputDataLen, float UserPara){
      int i;  for (i = 0; i < InputDataLen; i++)  {
        if (xn >= x_i[i])    {
          break;    }  }  return i;}

SplineInterpolation.h

#pragma once// find the index i where xn >= x_i[i]int FindPositionID_search(float *x_i, float xn, int InputDataLen, float UserPara);int FindPositionID_0(float *x_i, float xn, int InputDataLen, float InterplotGap);template <int InputDataLen, int OutputDataLen>void InterplotData(float *x_i, float *x_o, float *y_o, float *An, float *Bn, float *Cn, float *Dn, int(*FindPositionID)(float *x_i, float xn, int InputDataLen, float UserPara), float UserPara);template <int InputDataLen>void ConstractSplineLinearEquations(float *A, float *b, float *x_i, float *y_i);template <int DataLen>void SolveSplineEquations(float *A, float *b, float *x);// the FindPositionID is the function to find the index i where xn >= x_i[i]// the UserPara the para to send to FindPositionID// the input of xi must be sortedtemplate <int InputDataLen, int OutputDataLen>void SplineInterpolation(float *x_i, float *y_i, float *x_o, float *y_o, int(*FindPositionID)(float *x_i, float xn, int InputDataLen, float UserPara), float UserPara){
      float An[InputDataLen];  float Bn[InputDataLen];  float Cn[InputDataLen];  float Dn[InputDataLen];  // initilize  for (int i = 0; i < InputDataLen; i++)  {
        An[i] = y_i[i];  }  // sove linear equations  float A[InputDataLen*InputDataLen];  float b[InputDataLen];  ConstractSplineLinearEquations(A, b, x_i, y_i);  // solve Cn  SolveSplineEquations(A, b, Cn);  // solve Bn and Dn  for (int i = 0; i1; i++)  {
        float hi = x_i[i + 1] - x_i[i];    Bn[i] = 1 / hi*(An[i + 1] - An[i]) - hi / 3 * (2 * Cn[i] + Cn[i + 1]);    Dn[i] = (Cn[i + 1] - Cn[i]) / (3 * hi);  }  // yn(i) = An(ParaSet) + Bn(ParaSet)*(curx-xi) + Cn(ParaSet)*(curx-xi)^2 + Dn(ParaSet)*(curx-xi)^3;  InterplotData (x_i, x_o, y_o, An, Bn, Cn, Dn, FindPositionID, UserPara);}template <int InputDataLen, int OutputDataLen>void InterplotData(float *x_i, float *x_o, float *y_o, float *An, float *Bn, float *Cn, float *Dn, int(*FindPositionID)(float *x_i, float xn, int InputDataLen, float UserPara), float UserPara){
      int ParaSet = 0;  for (int i = 0; i < OutputDataLen; i++)  {
        float xn = x_o[i];    ParaSet = FindPositionID(x_i, xn, InputDataLen, UserPara);    if (ParaSet < 0)ParaSet = 0;    if (ParaSet >= InputDataLen - 1)ParaSet = InputDataLen - 2;//    printf("ParaSet:%d\n", ParaSet);    float xi = x_i[ParaSet];//    printf("xn xi:%f %f\n", xn, xi);    y_o[i] = An[ParaSet] + Bn[ParaSet] * (xn - xi) + Cn[ParaSet] * (xn - xi)*(xn - xi) + Dn[ParaSet] * (xn - xi)*(xn - xi)*(xn - xi);  }}template <int InputDataLen>void ConstractSplineLinearEquations(float *A, float *b, float *x_i, float *y_i){
      float(*pA)[InputDataLen] = (float(*)[InputDataLen])A; // for parameter array                              //   for (int r = 0; r  {
        for (int c = 0; c    {
          pA[r][c] = 0;    }  }  // construct A  pA[0][0] = 1;  pA[InputDataLen - 1][InputDataLen - 1] = 1;  for (int i = 1; i < InputDataLen - 1; i++)  {
        float h0 = x_i[i] - x_i[i - 1];    float h1 = x_i[i + 1] - x_i[i];    pA[i][i - 1] = h0;    pA[i][i] = 2 * (h0 + h1);    pA[i][i + 1] = h1;  }  // construct b  b[0] = 0;  b[InputDataLen - 1] = 0;  for (int i = 1; i1; i++)  {
        float h0 = x_i[i] - x_i[i - 1];    float h1 = x_i[i + 1] - x_i[i];    float a0 = y_i[i - 1];    float a1 = y_i[i];    float a2 = y_i[i + 1];    b[i] = 3 / h1*(a2 - a1) - 3 / h0*(a1 - a0);  }}template <int DataLen>void SolveSplineEquations(float *A, float *b, float *x){