一种非完整约束条件下的连续曲率路径优化方法
摘要:
本发明提供一种非完整约束条件下的连续曲率路径优化方法,该方法构造出来的平滑曲线满足非完整约束条件、曲率连续、存在解析解便于实时计算,有助于提高路径跟踪控制的精度。具体步骤包括:依据车辆转向能力约束确定可行驶的最大曲率;从原始路径上起始点开始按序选取三个路径点;构造两段参数化的三阶Bezier曲线,确定参数值以满足曲率连续和最大值受限双重约束条件;依据参数化方程计算平滑曲线上各点的曲率;对平滑曲线进行非均匀离散化,获取平滑后的目标路径点;重复上述步骤完成对全局路径点的平滑处理;检查平滑曲线与原路径点的拟合匹配情况,并与障碍地图进行碰撞检测。由此,最终得到的优化路径兼顾了无人车辆行驶控制的可通过性和平顺性。
0/0