本发明涉及路径规划领域,尤其是涉及一种基于路径平滑和双向跳点搜索的移动机器人路径规划方法。
背景技术:
1、目前自动引导车(agv)等移动机器人得到快速发展与落地,已成为设备智能化的重要组成部分,在工业、农业、服务、医疗等领域都得到了诸多应用。路径规划是机器人运动控制的主要研究内容与基础技术之一,路径规划以可达性为核心,基于路径约束(如障碍物),规划机器人首末位置间无冲突行进的最优空间路径{θ},其中θ是机器人广义坐标,{θ}是路径点序列。
2、常用的路径规划方法包括可视图法、拓扑图法、启发式算法、智能算法、局部规划算法等。在启发式算法中,a*算法是非常有效且常用的有信息路径规划算法之一,但在扩展邻域时会评估大量不必要节点。跳点搜索算法(jps)通过筛选出有价值的节点——称为跳点,而剪去探索空间中无意义的冗余节点,改善了a*算法性能。但是传统jps算法只能从出发点开始扩展探索域,无法利用终点附近有效的局部地图信息,因此在面对大规模地图,或高密度、不规则障碍时,搜索效率往往比较低下;同时规划的路径存在不平滑转角,造成应用时存在内存消耗大、运行时间长、损坏机械结构等缺陷。
3、因此,亟需设计一种可解决传统算法地图信息利用率低、路径不平滑的问题,方法可靠、易于实现,且对复杂环境的适应性较强的移动机器人路径规划方法
技术实现思路
1、本发明的目的就是为了克服上述现有技术存在的地图信息利用率低、路径不平滑的问题缺陷而提供了一种基于路径平滑和双向跳点搜索的移动机器人路径规划方法。
2、本发明的目的可以通过以下技术方案来实现:
3、根据本发明的第一方面,提供了一种基于路径平滑和双向跳点搜索的移动机器人路径规划方法,该方法包括以下步骤:
4、步骤s1、建立表征移动机器人工作空间的栅格地图,确认移动机器人初始点和目标点;
5、步骤s2、采用双向跳点搜索算法利用起始点和目标点两个方向的栅格地图信息规划出从起点到终点的较优可行路径;
6、步骤s3、采用b样条曲线对较优可行路径中跳点所在位置的不平滑拐角进行优化,得到最终的路径规划结果。
7、优选地,所述步骤s2包括以下子步骤:
8、步骤s21、初始化双向跳点搜索算法的先验信息,包括栅格代价函数和启发式函数;
9、步骤s22、初始化数据结构表,包括前、后向开节点表openf、openb,前、后向闭节点表closedf、closedb,以及前、后向当前最优跳点curf、curb;
10、步骤s23、通过选择当前从open表中评估出的最佳跳点的父节点作为另一个方向本轮迭代的目标点,以当前方向跳点出现在另一方向closed表中为循环结束标志,使两个方向的搜索产生信息交互;
11、步骤s24、按照closedf或closedb表的父子节点关系,回溯可行路径,得到跳点集合表征的较优可行路径。
12、优选地,所述栅格代价函数的数学表达式为:
13、cost=exp(-αd)×254
14、式中,α为膨胀系数,d为移动机器人的几何中心到障碍的最短距离与移动机器人内切半径之差,表征机器人受到碰撞的危险性。
15、优选地,所述启发式函数的数学表达式为:
16、f(n*)=h(n*)+g(n*)
17、式中,g(n)为路径耗散函数,表达式为n*为当前评估的节点,n为上一个评估的节点,c为代价系数;h(n)为启发函数,采用曼哈顿距离,表达式为h(n)=c·(|nx-goalx|+|ny-goaly|),c为代价系数,goal为目标点。
18、优选地,所述步骤s3包括以下子步骤:
19、步骤s31、针对步骤s24中的跳点集合中的某个特定跳点,依据周围有无障碍物,确定控制节点集;
20、步骤s32、采用cox-deboor递推定义计算控制节点集合中每个节点对应的b样条基函数ni,k(t),计算由控制节点集定义的整条b样条曲线,遍历得到的跳点集合,生成平滑路径曲线生成平滑路径曲线。
21、优选地,所述步骤s31具体为:
22、当前跳点周围无障碍物时,以当前跳点pc与上一相邻跳点的中点为起始节点ps,以当前跳点与下一相邻跳点的中点为结束节点pe,则控制节点集合组成为{ps,(ps+pc)/2,pc,(pc+pe)/2,pe};
23、当前跳点周围有障碍物时,若原始轨迹与障碍相切则以切点为起始点ps或终止点pe,否则端点选择同上,则控制节点集合为{ps,(ps+pc)/2,pc,(pc+pe)/2,pe}。
24、优选地,所述b样条基函数ni,k(t)的数学表达式为:
25、
26、式中,为,i=0,1,...,n,曲线次数k≥1且规定0/0=0,满足
27、
28、优选地,所述b样条曲线生成表达式如下:
29、
30、式中,是第l次插入重复节点产生的新控制节点,满足:
31、
32、其中,
33、根据本发明的第二方面,提供了一种电子设备,包括存储器和处理器,所述存储器上存储有计算机程序,所述处理器执行所述程序时实现任一项所述的方法。
34、根据本发明的第三方面,提供了一种计算机可读存储介质,其上存储有计算机程序,所述程序被处理器执行时实现任一项所述的方法。
35、与现有技术相比,本发明具有以下优点:
36、1)本发明有效利用了起始点和目标点两个方向的地图信息,复杂环境的适应性较强,采用结合b样条曲线路径平滑与双向跳点搜索算法进行路径规划,大幅减小了路径搜索空间,搜索效率大幅提高;
37、2)本发明通过选择当前从表open中评估出的最佳跳点的父节点作为另一个方向本轮迭代的目标点,以当前方向跳点出现在另一方向closed表中为循环结束标志,使两个方向的搜索产生信息交互且保证收敛,提高了搜索效率;
38、3)将跳点作为方向发生改变的拐角点,直接生成控制节点集,进行b样条曲线路径平滑,可靠高且易于实现;
39、4)通过均匀b样条曲线的二阶连续性改善了移动机器人运行时的速度和加速度轨迹,保护移动机器人的机械结构。
1.一种基于路径平滑和双向跳点搜索的移动机器人路径规划方法,其特征在于,该方法包括以下步骤:
2.根据权利要求1所述的一种基于路径平滑和双向跳点搜索的移动机器人路径规划方法,其特征在于,所述步骤s2包括以下子步骤:
3.根据权利要求2所述的一种基于路径平滑和双向跳点搜索的移动机器人路径规划方法,其特征在于,所述栅格代价函数的数学表达式为:
4.根据权利要求2所述的一种基于路径平滑和双向跳点搜索的移动机器人路径规划方法,其特征在于,所述启发式函数的数学表达式为:
5.根据权利要求2所述的一种基于路径平滑和双向跳点搜索的移动机器人路径规划方法,其特征在于,所述步骤s3包括以下子步骤:
6.根据权利要求5所述的一种基于路径平滑和双向跳点搜索的移动机器人路径规划方法,其特征在于,所述步骤s31具体为:
7.根据权利要求5所述的一种基于路径平滑和双向跳点搜索的移动机器人路径规划方法,其特征在于,所述b样条基函数ni,k(t)的数学表达式为:
8.根据权利要求7所述的一种基于路径平滑和双向跳点搜索的移动机器人路径规划方法,其特征在于,所述b样条曲线生成表达式如下:
9.一种电子设备,包括存储器和处理器,所述存储器上存储有计算机程序,其特征在于,所述处理器执行所述程序时实现如权利要求1~8任一项所述的方法。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述程序被处理器执行时实现如权利要求1~8中任一项所述的方法。