基于路径长度的样条插补算法（自动驾驶和路径跟踪控制适用）

以前在做车辆跟踪控制的时候发现在针对有多个X和多个Y对应的路径插补时候，总是报错，因为MATLAB里面的interp1插补函数它要求x要唯一对应一个y，当路径以单独的x或者y来求插补时候的时候就报错。由于在使用Matlab的interp1函数进行插值时，采样点必须是唯一的，否则可能会出现问题。如果输入的采样点包含重复的值，interp1函数可能无法确定应该在哪个点进行插值。这会导致函数返回错误或不确定的结果。为了解决这个问题，你可以先对输入的采样点进行处理，确保它们是唯一的。你可以使用Matlab的unique函数来去除重复值，或者通过其他方法确保采样点的唯一性。

针对这个问题，我根据路径的长度来插补，而不是利用单一的x或者单一的y。在遇到类似的情况时候，也可以用范数来插补。具体代码如下

clc,clear
close all
cx = [];
cy= [];
x0 = @(t_step) 15*sin(2 * t_step + 1);
y0 = @(t_step) -20*cos(t_step + 0.5);
for theta=0.9*pi:pi/200:1.8*pi
    cx(end + 1) = x0(theta);
    cy(end + 1) = y0(theta);
end
refer_path_primary= [cx', cy'];
x = refer_path_primary(:, 1)';
y = refer_path_primary(:, 2)';
points = [x; y]';
ds = 0.01 ;%等距插值处理的间隔
distance = [0, cumsum(hypot(diff(x, 1), diff(y, 1)))]';
distance_specific &