摘要
本申请提供了一种泊车路径规划方法及系统;所述泊车路径规划方法包括:获取目标车辆的车辆参数信息,并确定泊车终点位置;基于所述车辆参数信息建立车辆运动学方程组,以采用四阶龙格‑库塔方法基于所述车辆运动学方程组根据所述泊车终点位置获得第一泊车路径;以及,采用A*算法基于目标车辆的当前位置和车位泊入起始点获得第二泊车路径,以合并所述第一泊车路径和第二泊车路径,获得最终泊车路径。本申请避免了混合A*算法在非凸环境下耗时长的路径搜索过程,同时充分考虑了车辆的运动学特征,实现了针对平行车位的快速路径规划。
技术关键词
泊车路径规划方法
车辆参数信息
车辆运动学
四阶龙格
栅格地图
终点
轨迹
运动学特征
车辆航向角
算法
模块
节点
后轴
前轮
坐标