基于改进快速行进树的自主代客泊车路径规划

为了加速自主代客泊车系统落地,基于改进快速行进树算法提出了一种自主代客泊车路径规划方法.首先,采用类广度优先搜索策略建立环境地图的“路径场”,并提出一种高计算效率的避障检测策略,基于环境地图“路径场”提出一种符合汽车非完整约束的远端参考点和近端参考点选取原则与路径节点更新原则,通过使路径节点逐渐靠近目标节点来完成自主代客泊车引导路径规划任务.其次,基于Dubins曲线规划满足初始泊车方位角任意性要求和泊车位方位角的非唯一性要求的泊车路径,引导汽车安全驶入泊车位.最后,仿真验证所提方法的可行性.结果表明:相对于传统的快速行进算法,所提方法规划的自主代客泊车路径满足汽车非完整约束要求,可以安全引导汽车完成自主代客泊车任务.