基于批处理先验知识树的自主代客泊车路径规划

针对室内结构化场景的自主代客泊车路径规划问题,基于批处理先验知识树(BIT*)算法和滚动优化思想提出一种自主代客泊车路径规划方法.首先,基于BIT*算法规划全局自主代客泊车路径,并采用数组实现影响BIT*算法搜索效率的树节点优先队列和树边优先队列,提高全局自主代客泊车路径规划效率.然后,基于滚动优化思想和圆弧-直线组合方法规划满足汽车运动学约束和避障约束的局部自主代客泊车路径,基于滚动优化思想规划的局部自主代客泊车路径可以将汽车引导到泊车位附近,而基于圆弧-直线组合方法规划的局部自主代客泊车路径可以使汽车安全驶入泊车位.最后,仿真验证所提出的自主代客泊车路径规划方法的可行性和有效性,结果表明:相对于基于传统快速扩展随机数(RRT)算法的自主代客泊车路径规划方法,提出的方法搜索效率更高,并且规划的自主代客泊车路径满足汽车运动学约束和避障约束.