一种考虑跟踪误差累积的两段式平行泊车路径规划算法

本发明公开了一种考虑跟踪误差累积的两段式平行泊车路径规划算法，包括步骤：S1、周期性获取车辆运行数据、车位坐标信息及障碍物坐标信息；S2、通过Hybrid A*算法进行路径搜索、避障约束，实时规划车辆起点至泊车终点间最优路径；S3、在检测点，对车辆横向误差进行判断，若误差超出阈值，重新规划车库内泊车路径；S4、形成完整的自动泊车规划路径；本发明首先以混合A*算法搭配RS曲线进行路径搜索，其次在规划中点处结合车位内环境进行进一步规划，最后利用检测点检测车辆的轨迹跟踪误差，确保车辆能成功泊车。