CN109211242B - 一种融合rrt与蚁群算法的三维空间多目标路径规划方法 - Google Patents
一种融合rrt与蚁群算法的三维空间多目标路径规划方法 Download PDFInfo
- Publication number
- CN109211242B CN109211242B CN201811063167.7A CN201811063167A CN109211242B CN 109211242 B CN109211242 B CN 109211242B CN 201811063167 A CN201811063167 A CN 201811063167A CN 109211242 B CN109211242 B CN 109211242B
- Authority
- CN
- China
- Prior art keywords
- path
- iteration
- cost
- rrt
- target
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Abstract
本发明公开了一种融合RRT与蚁群算法的三维空间多目标路径规划方法,该方法将各目标点之间的直线距离作为初始路径代价,将三维空间中多目标路径规划问题转变为已知路径代价的旅行商问题,然后用蚁群算法对该旅行商问题进行优化求解,在优化过程中,记录各目标点之间的路径上蚂蚁经过的次数以及每一次迭代中的最优解,如果两个目标点之间的路径被蚂蚁经过的次数超过一个阈值,或者该路径包含在某一次迭代的最优解中,则用RRT算法对这两个目标点之间的三维空间路径进行规划,用规划出的路径距离替代这两个目标点之间的初始路径代价,经过一定迭代次数后,可以找到一条经过所有目标点一次后返回起始点且路径总代价趋于最小的三维空间路径。
Description
技术领域
本发明涉及一种融合RRT与蚁群算法的三维空间多目标路径规划方法,属于机器人路径规划领域。
背景技术
机器人路径规划一直是机器人智能控制领域的研究热点,而随着无人机在民用和军事上越来越广泛的应用,无人机所在的三维空间中的路径规划问题也变得愈发重要。在无人机民用方向中的电力巡检和光伏发电设备巡检,以及军事方向中的无人机多任务点巡航,都涉及到了三维空间中的多目标路径规划问题,即在三维空间中规划一条无障碍经过所有目标点且要求总路径距离趋于最小的回路。
三维空间中的多目标路径规划主要涉及到两个问题,第一是任意两个目标点之间的三维路径,即以两个目标点为起止点,规划一条避开所有障碍且路径距离趋于最小的路径;第二是各个目标点的经过顺序,即以一个确定的顺序依次经过各个目标点构成一个闭合回路,类似于旅行商问题,区别在于旅行商问题中任意两点间的路径代价是已知的,而三维空间中的多目标路径规划问题中任意两点间的路径代价一开始是未知的,需要规划两点间的路径后才能已知其路径代价。对于三维空间中的多目标路径规划问题,已有的研究是将其拆分成两个独立的问题,三维路径规划和旅行商问题,先用三维空间中的路径规划方法如A*算法、RRT算法和遗传算法等对各个目标点之间的路径进行规划,求出任意两个目标点之间的路径及路径距离,这样就把问题转换成了已知各目标点间路径代价的普通旅行商问题,然后再用动态规划、模拟退火算法和蚁群算法等对该旅行商问题进行求解,这样的方法需要将大量的时间用于各个目标点之间的路径规划,随着目标点数量的增多,各个目标点间的路径规划成了该问题的主要时间消耗,成为庞大的计算负担。如果能找到一种新的方法,既能显著降低计算量和计算时间,又不降低解的优良性的话,将会是对该问题的一大帮助。
发明内容
本发明的目的在于针对现有技术的不足,提供一种融合RRT与蚁群算法的三维空间多目标路径规划方法。
本发明解决上述技术问题的技术方案如下:一种融合RRT与蚁群算法的三维空间多目标路径规划方法,该方法包括以下步骤:
步骤A:计算各目标点之间的初始路径代价;
步骤B:将三维空间中多目标路径规划问题等效于已知路径代价的普通旅行商问题,进行一次蚁群算法迭代,得到该次迭代中遍历所有目标点的最优回路,并在迭代过程中记录各段路径上的蚂蚁经过次数;
步骤C:将各段路径上的蚂蚁经过次数与阈值N比较,如果超过阈值,则调用RRT更新该段路径代价;
步骤D:该次迭代结束时,调用RRT更新最优解所包含的各段路径的路径代价;
步骤E:判断已进行的迭代次数,如果没有达到预设迭代总次数,则重复步骤BCDE,否则执行步骤F;
步骤F:将各次迭代的最优解中路径总代价最小的解作为最终解。
进一步地,所述步骤A中,将各目标点之间的欧氏距离即直线距离选取为各目标点之间的初始路径代价,将该路径代价用于蚁群优化的初始迭代。
进一步地,所述步骤C中,将各段路径上的蚂蚁经过次数与阈值N比较,如果该段路径的蚂蚁经过次数超过阈值,且其路径代价未被修正过,则调用RRT计算该段路径代价,并将计算所得路径代价作为该段路径修正后的路径代价。
进一步地,所述步骤C中,阈值N的设定规则:N=m*iter*2/n,其中m为蚂蚁个数,iter为总迭代次数,n为目标点个数。
进一步地,所述步骤D中,在该次迭代结束时,如果该次迭代的最优解路径总代价低于以往迭代中的最优解,则对于该次迭代的最优解所包含的每一段路径,如果其路径代价未被修正过,则调用RRT计算该段路径,并将计算所得路径的路径代价作为该段路径修正后的路径代价。
本发明的有益效果是:通过对RRT和蚁群算法的融合,以欧氏距离作为初始路径代价,在蚁群优化迭代过程中修正路径代价,避免了用于各目标点间路径规划的大量冗余计算量,显著节省了计算时间,同时保留了最终解的优良性。
附图说明
图1是蚁群算法应用于旅行商问题的流程图;
图2是RRT算法流程图;
图3是确定新节点示意图;
图4是碰撞检测方法示意图;
图5是融合RRT与蚁群算法的三维空间多目标路径规划方法的流程图。
具体实施方式
以下结合附图对本发明的原理和具体实现方法进行描述。
本发明提供的一种融合RRT与蚁群算法的三维空间多目标路径规划方法,该方法可应用于无人机光伏设备巡检或军事目标巡航等无人机多目标路径规划场景中,其具体流程包括:
步骤A:计算各目标点之间的初始路径代价;
步骤B:将三维空间中多目标路径规划问题等效于已知路径代价的普通旅行商问题,进行一次蚁群算法迭代,得到该次迭代中遍历所有目标点的最优回路,并在迭代过程中记录各段路径上的蚂蚁经过次数;
步骤C:将各段路径上的蚂蚁经过次数与阈值N比较,如果超过阈值,则调用RRT更新该段路径代价,执行步骤D,否则直接执行步骤D;
步骤D:该次迭代结束时,调用RRT更新最优解所包含的各段路径的路径代价;
步骤E:判断已进行的迭代次数,如果没有达到预设迭代总次数,则重复步骤BCDE,否则执行步骤F;
步骤F:将各次迭代的最优解中路径总代价最小的解作为最终解。
进一步,所述步骤A包括:
计算各目标点之间的欧式距离即直线距离,将其作为各目标点之间的初始路径代价,以此初始路径代价参与蚁群优化的迭代过程。计算公式如下:
其中d为路径代价,x1、y1、z1分别为其中一个目标点的三维空间坐标值,x2、y2、z2为另一个目标点的三维空间坐标值。
进一步,所述步骤B包括:
进行一次蚁群算法迭代,此时三维空间中多目标路径规划问题等效于已知路径代价的普通旅行商问题,蚁群算法用于旅行商问题时,其计算流程如图1所示,一次迭代的计算步骤如下:
1)初次迭代前,初始化算法运行参数,本实施例中,设置蚂蚁数量m=40,最大迭代次数itermax=100,信息素重要程度因子α=1,启发式函数重要程度因子β=5,信息素挥发因子ρ=0.1,信息素更新系数Q=1。每一次迭代开始时,对于各个蚂蚁,分别随机选取一个目标点作为其起始点。
2)各个蚂蚁根据路径信息素浓度τij和启发式函数依次选取一个目标点作为下一目标点,记录所选路径上的蚂蚁经过次数,直到每个蚂蚁都选择完所有目标点构成闭合回路。其中,两个目标点之间的启发式函数为该两点间的路径代价dij的倒数,对某一个蚂蚁来说从当前目标点选取下一可选目标点的概率pij计算式如下:
其中求和公式是对该蚂蚁的剩余可选目标点进行计算求和。
3)每个蚂蚁都选择完所有目标点构成闭合回路后,对所有路径上的信息素浓度进行更新,信息素浓度更新包括信息素的挥发和增加,信息素挥发是针对所有路径,其公式如下:
τij=(1-ρ)τij
信息素增加只针对被蚂蚁选择的路径,其公式如下:
τij=τij+Q/li
其中li为各个蚂蚁所选择回路的路径总代价。
4)比较各个蚂蚁所选择回路的路径总代价li,将路径总代价最小的回路作为该次迭代的最优解,即该次迭代中遍历所有目标点的最优回路。
进一步,所述步骤C包括:
将各段路径上的蚂蚁经过次数与阈值N比较,如果该段路径的蚂蚁经过次数超过阈值,且其路径代价未被修正过,则调用RRT计算该段路径代价,并将计算所得路径代价作为该段路径修正后的路径代价。阈值N的设定规则为N=m*iter*2/n,其中m为蚂蚁个数,iter为总迭代次数,n为目标点个数。
RRT(快速随机搜索树)算法采用随机采样的规划方法,不需要预处理,搜索速度快,在高维空间中速度优势尤为明显,其算法流程图如图2所示,基本思想就是通过不断生成采样点,根据采样点位置生成新树枝,从而产生一个从起点开始不断生长的搜索树,当该搜索树能连到终点时,即找到了一条从起点到终点的连通路径。RRT算法基本步骤如下:
1)生成采样点。这里生成采样点采用目标偏移型策略,在采样空间即路径规划空间中生成采样点时,除了在采样空间中随机生成一个点作为采样点外,还有一定几率将终点作为采样点,这样可以使树偏向终点生长,加快算法收敛速度。在此实例中选用终点作为采样点的几率为0.6。
2)确定新节点。如图3所示,生成采样点qrand后,在已有的树节点中找到距离采样点最近的树节点qnear,最近的树节点qnear和采样点qrand的连线上距离最近的树节点qnear一定距离Lseg的点即作为新节点qnew。在此实例中Lseg选为路径规划空间长度最小的维上,规划空间长度的十分之一。
3)碰撞检测。如果qnear和qnew中间有障碍,则放弃该新节点,从生成采样点的步骤重新开始。检测两点q′和q″是否无障碍连通时,如图4所示,在两点间均匀生成一系列中间点,如果每一个中间点都不在障碍范围内,则认为该两点无障碍连通。在此实例中,中间点数目n的设置规则如下:
n=120dq/D
其中dq为两点间距离,D为路径规划空间距离最远的两点间距离,中间点数目n的下限为7,当n小于7时则设置n为7。
4)添加新树枝。这里采用RRT算法的变种RRT*中的策略,即生成新节点后,对新节点一定半径圆内的已有树节点进行路径代价比较,选择路径代价最低的树节点作为新节点的父节点来生成新树枝,另外,若该新节点一定半径圆内的已有树节点将新节点作为父节点能降低其路径代价的话,则将其父节点改为新节点,这样能够找到趋近于最优解的较优解。在此实例中,圆的半径选取规则为:
其中Ntree为已有的树节点数目。
5)判断树是否能够连接到终点,如果不能则重复上述步骤,如果已经连接到终点,则从连接终点的树节点开始不断找出其父节点,直到找到起点,这样就找到一条从起点开始连接终点的路径,最后用贪心算法原则去除该路径上多余的中间点后得到最终路径。
进一步,所述步骤D包括:
在该次迭代结束时,如果该次迭代的最优解路径总代价低于以往迭代中的最优解,则对于该次迭代的最优解所包含的每一段路径,如果其路径代价未被修正过,则调用RRT计算该段路径,RRT计算过程同步骤C中所述,并将计算所得路径的路径代价作为该段路径修正后的路径代价。
进一步,所述步骤E包括:
每一次迭代结束后,将已迭代次数与预设迭代总次数比较,如果没有达到总次数,则继续迭代,重复步骤BCDE。
进一步,所述步骤F包括:
迭代次数达到预设迭代总次数后,在各次迭代的最优解中找出路径总代价最小的解,并将其作为最终解,最终解包括各个目标点的经过顺序以及在此经过顺序中任意两个相邻目标点间的三维路径。
由以上说明,可总结出融合RRT与蚁群算法的三维空间多目标路径规划方法的流程图,如图5所示,本发明通过对RRT和蚁群算法的融合,以欧氏距离作为初始路径代价,在蚁群优化迭代过程中修正路径代价,避免了用于各目标点间路径规划的大量冗余计算量,显著节省了计算时间(以40个目标为例可节省约80%用于各目标点间路径规划的时间),同时保留了最终解的优良性。
上述实施例用来解释说明本发明,而不是对本发明进行限制,在本发明的精神和权利要求的保护范围内,对本发明作出的任何修改和改变,都落入本发明的保护范围。
Claims (5)
1.一种融合RRT与蚁群算法的三维空间多目标路径规划方法,其特征在于,该方法包括以下步骤:
步骤A:计算各目标点之间的初始路径代价;
步骤B:将三维空间中多目标路径规划问题等效于已知路径代价的普通旅行商问题,进行一次蚁群算法迭代,得到该次迭代中遍历所有目标点的最优回路,并在迭代过程中记录各段路径上的蚂蚁经过次数;
步骤C:将各段路径上的蚂蚁经过次数与阈值N比较,如果超过阈值,且该段路径的代价未修正过,则调用RRT更新该段路径代价;
步骤D:该次迭代结束时,若该次迭代中的最优解的路径总代价低于以往迭代中的最优解,则调用RRT去更新该次迭代最优解所包含的各段路径的路径代价;
步骤E:判断已进行的迭代次数,如果没有达到预设迭代总次数,则重复步骤BCDE,否则执行步骤F;
步骤F:将各次迭代的最优解中路径总代价最小的解作为最终解。
2.根据权利要求1所述的一种融合RRT与蚁群算法的三维空间多目标路径规划方法,其特征在于,所述步骤A中,将各目标点之间的欧氏距离即直线距离选取为各目标点之间的初始路径代价,将该路径代价用于蚁群优化的初始迭代。
3.根据权利要求1所述的一种融合RRT与蚁群算法的三维空间多目标路径规划方法,其特征在于,所述步骤C中,将各段路径上的蚂蚁经过次数与阈值N比较,如果该段路径的蚂蚁经过次数超过阈值,且其路径代价未被修正过,则调用RRT计算该段路径代价,并将计算所得路径代价作为该段路径修正后的路径代价。
4.根据权利要求1所述的一种融合RRT与蚁群算法的三维空间多目标路径规划方法,其特征在于,所述步骤C中,阈值N的设定规则:N=m*iter*2/n,其中m为蚂蚁个数,iter为总迭代次数,n为目标点个数。
5.根据权利要求1所述的一种融合RRT与蚁群算法的三维空间多目标路径规划方法,其特征在于,所述步骤D中,在该次迭代结束时,如果该次迭代的最优解路径总代价低于以往迭代中的最优解,则对于该次迭代的最优解所包含的每一段路径,如果其路径代价未被修正过,则调用RRT计算该段路径,并将计算所得路径的路径代价作为该段路径修正后的路径代价。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811063167.7A CN109211242B (zh) | 2018-09-12 | 2018-09-12 | 一种融合rrt与蚁群算法的三维空间多目标路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811063167.7A CN109211242B (zh) | 2018-09-12 | 2018-09-12 | 一种融合rrt与蚁群算法的三维空间多目标路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109211242A CN109211242A (zh) | 2019-01-15 |
CN109211242B true CN109211242B (zh) | 2020-10-23 |
Family
ID=64983725
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811063167.7A Active CN109211242B (zh) | 2018-09-12 | 2018-09-12 | 一种融合rrt与蚁群算法的三维空间多目标路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109211242B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110135644B (zh) * | 2019-05-17 | 2020-04-17 | 北京洛必德科技有限公司 | 一种用于目标搜索的机器人路径规划方法 |
CN110986942A (zh) * | 2019-10-17 | 2020-04-10 | 浙江科技学院 | 基于蚁群算法的立体仓库三维空间路径优化方法 |
CN112269382B (zh) * | 2020-10-21 | 2021-06-29 | 桂林电子科技大学 | 一种机器人多目标路径规划方法 |
CN116128177B (zh) * | 2023-04-18 | 2023-06-27 | 福建恒而达新材料股份有限公司 | 一种平面切割路径规划的方法、系统及计算机存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104359473A (zh) * | 2014-10-24 | 2015-02-18 | 南京航空航天大学 | 一种动态环境下无人机编队飞行的协同航迹智能规划方法 |
CN104516356A (zh) * | 2015-01-08 | 2015-04-15 | 西北工业大学 | 基于rrt的动态障碍规避算法 |
CN106295791A (zh) * | 2016-07-29 | 2017-01-04 | 西安电子科技大学 | 用于寻找旅行商最优路径的方法 |
CN107883962A (zh) * | 2017-11-08 | 2018-04-06 | 南京航空航天大学 | 一种多旋翼无人机在三维环境下的动态航路规划方法 |
CN108460485A (zh) * | 2018-03-05 | 2018-08-28 | 重庆邮电大学 | 一种基于改进蚁群算法的旅行商问题求解方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101554515B1 (ko) * | 2009-01-07 | 2015-09-21 | 삼성전자 주식회사 | 로봇의 경로계획장치 및 그 방법 |
KR101667031B1 (ko) * | 2009-11-02 | 2016-10-17 | 삼성전자 주식회사 | 로봇의 경로 계획 장치 및 그 방법 |
-
2018
- 2018-09-12 CN CN201811063167.7A patent/CN109211242B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104359473A (zh) * | 2014-10-24 | 2015-02-18 | 南京航空航天大学 | 一种动态环境下无人机编队飞行的协同航迹智能规划方法 |
CN104516356A (zh) * | 2015-01-08 | 2015-04-15 | 西北工业大学 | 基于rrt的动态障碍规避算法 |
CN106295791A (zh) * | 2016-07-29 | 2017-01-04 | 西安电子科技大学 | 用于寻找旅行商最优路径的方法 |
CN107883962A (zh) * | 2017-11-08 | 2018-04-06 | 南京航空航天大学 | 一种多旋翼无人机在三维环境下的动态航路规划方法 |
CN108460485A (zh) * | 2018-03-05 | 2018-08-28 | 重庆邮电大学 | 一种基于改进蚁群算法的旅行商问题求解方法 |
Non-Patent Citations (1)
Title |
---|
Planning with ants: Efficient path planning with rapidly exploring random trees and ant colony optimization;Alberto Viseras 等;《International Journal of Advanced Robotic systems》;20161025;第1-16页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109211242A (zh) | 2019-01-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109211242B (zh) | 一种融合rrt与蚁群算法的三维空间多目标路径规划方法 | |
CN109945881B (zh) | 一种蚁群算法的移动机器人路径规划方法 | |
CN107272679B (zh) | 基于改进的蚁群算法的路径规划方法 | |
CN111024092B (zh) | 一种多约束条件下智能飞行器航迹快速规划方法 | |
CN108681787B (zh) | 基于改进双向快速扩展随机树算法的无人机路径优化方法 | |
CN108458717A (zh) | 一种迭代的快速扩展随机树irrt的无人机路径规划方法 | |
CN112987799B (zh) | 一种基于改进rrt算法的无人机路径规划方法 | |
CN108829140B (zh) | 一种基于多群体蚁群算法的多无人机协同目标搜索方法 | |
CN106525047A (zh) | 一种基于floyd算法的无人机路径规划方法 | |
CN112327876B (zh) | 一种基于终距指数的机器人路径规划方法 | |
CN114115362B (zh) | 一种基于双向apf-rrt*算法的无人机航迹规划方法 | |
CN113985888B (zh) | 一种基于改进蚁群算法的叉车路径规划方法及系统 | |
CN114167865B (zh) | 一种基于对抗生成网络与蚁群算法的机器人路径规划方法 | |
CN112985408A (zh) | 一种路径规划优化方法及系统 | |
CN111207767A (zh) | 一种基于rrt算法改进的车辆规划算法 | |
Li et al. | Mobile robot path planning based on improved genetic algorithm with A-star heuristic method | |
CN114237302B (zh) | 一种基于滚动时域的三维实时rrt*航路规划方法 | |
CN114115271B (zh) | 一种改进rrt的机器人路径规划方法和系统 | |
CN113063419B (zh) | 一种无人机路径规划方法及系统 | |
CN116817947B (zh) | 一种基于变步长机制的任意时路径规划方法 | |
Xue et al. | Hybrid bidirectional rapidly-exploring random trees algorithm with heuristic target graviton | |
CN115994891B (zh) | 基于狼群算法的无人载具混凝土坝表面缺陷动态检测方法 | |
Wang et al. | UAV online path planning based on improved genetic algorithm with optimized search region | |
CN115560772A (zh) | 一种基于改进蚁群算法的全局规划路径方法 | |
Cheng et al. | Route planning of mixed ant colony algorithm based on Dubins path |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |