基于两段二阶贝塞尔曲线的自动平行泊车路径规划方法

摘要

本发明公开了一种基于两段二阶贝塞尔曲线的自动平行泊车路径规划方法，该方法通过获取目标车位信息，确定泊车目标位置并以它为原点建立全局坐标系，构建泊车轨迹分段判断模型以确定规划轨迹分段数量，规划第一段轨迹结束位置范围，确定各段规划轨迹起止点及控制点位置，用二阶贝塞尔曲线进行路径规划，每隔一段时间监测并用动态调整规划轨迹法调整规划轨迹。本发明降低了对待泊车辆起始位姿的要求，提高了路径规划方法的环境适应性；可人为通过简单调整将车辆驶入所规划区域，以降低成本，可应用于中低档车中；泊车轨迹规划的控制点易确定、轨迹生成算法简单、路径曲率连续；降低了对轨迹误差的修正难度，提高了车辆避障性及泊车效率。