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