Open3D (C++) 三维轨迹点的等间距三次样条平滑与插值(间距可控)

Open3D (C++) 三维轨迹点的等间距三次样条平滑与插值(间距可控)

系数计算的数学原理

三次样条曲线的参数方程可以表示为:
S(t)=a+b(t−ti)+c(t−ti)2+d(t−ti)3S(t) = a + b(t-t_i) + c(t-t_i)^2 + d(t-t_i)^3S(t)=