平滑的车辆路径使用三次样条插值
自动驾驶的工具箱
的路径平滑样条块通过将输入的参考路径位姿拟合到三次样条曲线上,生成光滑的车辆路径,该路径由一系列离散的位姿组成。给定输入参考路径方向,块也返回对应于每个姿态的方向。
使用此块转换C1连续路径到C2连续的路径。C1-连续路径包括路径规划者返回的Dubins或reed - shepp路径。有关这些路径类型的详细信息,请参见c1 -连续路径和c2 -连续路径.
您可以使用一个飞行器控制器来使用返回的姿态和方向,例如横向控制器斯坦利块。
路径平滑算法插值通过所有输入参考位姿点的参数三次样条。样条的参数是这些点的累积弦长。[1]
平滑输出路径的切线方向近似匹配车辆在起始姿态和目标姿态时的姿态角。
[1]浮子,Michael S。参数三次样条插值与数据多边形的偏差。计算机辅助几何设计.第25卷第3期,2008年,148-156页。
Lepetic, Marko, Gregor Klancar, Igor Skrjanc, Drago Matko, Bostjan Potocnik。“考虑加速度限制的时间最优路径规划”。机器人技术与自主系统.第45卷,编号3-4,2003年,199-210页。