CN107229998A - 一种无人机自主寻路策略方法 - Google Patents
一种无人机自主寻路策略方法 Download PDFInfo
- Publication number
- CN107229998A CN107229998A CN201710397912.0A CN201710397912A CN107229998A CN 107229998 A CN107229998 A CN 107229998A CN 201710397912 A CN201710397912 A CN 201710397912A CN 107229998 A CN107229998 A CN 107229998A
- Authority
- CN
- China
- Prior art keywords
- mrow
- unmanned plane
- algorithms
- mmas
- ega
- 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.)
- Withdrawn
Links
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/004—Artificial life, i.e. computing arrangements simulating life
- G06N3/006—Artificial life, i.e. computing arrangements simulating life based on simulated virtual individual or collective life forms, e.g. social simulations or particle swarm optimisation [PSO]
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/12—Computing arrangements based on biological models using genetic models
- G06N3/126—Evolutionary algorithms, e.g. genetic algorithms or genetic programming
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
- G06Q10/00—Administration; Management
- G06Q10/04—Forecasting or optimisation specially adapted for administrative or management purposes, e.g. linear programming or "cutting stock problem"
- G06Q10/047—Optimisation of routes or paths, e.g. travelling salesman problem
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Business, Economics & Management (AREA)
- Biophysics (AREA)
- Human Resources & Organizations (AREA)
- General Physics & Mathematics (AREA)
- Evolutionary Computation (AREA)
- Software Systems (AREA)
- Molecular Biology (AREA)
- Computing Systems (AREA)
- General Engineering & Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Mathematical Physics (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Computational Linguistics (AREA)
- Biomedical Technology (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Biology (AREA)
- Economics (AREA)
- General Health & Medical Sciences (AREA)
- Strategic Management (AREA)
- Bioinformatics & Computational Biology (AREA)
- Game Theory and Decision Science (AREA)
- Operations Research (AREA)
- Quality & Reliability (AREA)
- Tourism & Hospitality (AREA)
- General Business, Economics & Management (AREA)
- Marketing (AREA)
- Entrepreneurship & Innovation (AREA)
- Development Economics (AREA)
- Physiology (AREA)
- Genetics & Genomics (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
本发明公开一种无人机自主寻路策略方法,通过改进的极坐标系栅格法对环境进行建模;将MMAS算法得到的一部分优化解转化为EGA算法的初始解;利用MMAS和EGA算法同时进行路径寻优;利用改进的变异算子和MMAS算法继续寻优,最终找到最优路径。本发明通过极坐标系进行环境建模大大减少了计算量,同时通过MMAS和EGA算法进行快速收敛算法,提高了最优解的搜索效率。
Description
技术领域
本发明主要涉及基于遗传蚂蚁算法的无人机自主寻路策略。
背景技术
无人机今年来得到大力的发展,主要应用于地质探测、影视摄影、环境监控、物体跟踪等方面。无人机除了人工控制,还具有自主智能搜索功能,能根据环境障碍物进行智能躲避和最优路径选择。
目前较常使用的,通过对障碍物分类进行全局路径规划,主要步骤包括环境建模和寻路策略算法。近来环境建模较多使用时通过栅格法建模,即通过对整体空间划分成不同栅格,没有障碍物的栅格为自由栅格,存在障碍物的非自由栅格。寻路策略算法即是在起点和目标终点之间只能选择最短路径的自由栅格组合。目前通常使用的是将x-y-z三维坐标系空间按一定距离平面进行划分成多个栅格空间,这种方法简单易行,但随着栅格数的增加,搜索组合数存在指数增加极大的耗费了计算资源造成响应慢;而基于遗传蚂蚁算法的寻路策略是借鉴自然选择和自然遗传机制的随机搜索算法,包括选择保留精英算法(elitist genetic algorithm,EGA)和最大最小蚁群系统(max-min ant system),其基本思想在每次迭代中保留适应值最优的个体,该算法一定程度上提高了搜索效率,但仍存在着在算法后期搜索效率降低的问题;最大最小蚁群系统(max-min ant system)是由德国学者Thomas stutzle提出改进的蚁群算法,主要改进如下:并不是对所有的蚂蚁都进行信息要素更新,,只对一只蚂蚁的信息素进行更新,这只蚂蚁只能是当前循环下找到的最优解蚂蚁或可能发现已知最优路径的蚂蚁;同时为了防止某条路径上的信息素出现过大或过小,设定了信息素浓度区间,同时为了开始吸引更多蚂蚁进行搜素,信息素浓度初始化的值设定为区间值,而非常数。但单纯的MMAS算法仍然存在搜素效率不高,最优解求解时间过长的问题。
发明内容
发明目的:为了克服现有技术中存在的不足,本发明提供了一种无人机自主寻路策略方法,通过极坐标系进行环境建模大大减少了计算量,同时通过MMAS和EGA算法进行快速收敛算法,提高了最优解的搜索效率。
技术方案:为实现上述目的,本发明采用以下技术:一种无人机自主寻路策略方法,其特征在于包括以下步骤:
(1)基于极坐标系对环境进行建模,首先将无人机等效为质点,将障碍物的体积等效为自身体积与无人机体积之和,在水平面上采用极坐标方式建立扇形栅格划分单元,无人机所在坐标s(t)为t+1时刻的极点;然后在三维环境中,在无人机的运动方向上按照极径距离对各障碍物进行聚类划分,将极径ρ方向上间距小于无人机机长1.2倍的障碍物聚为一类,并记为聚类结果n,n=1,2,3…N,同时在聚类结果n离无人机质点极径最小和最大处作虚拟环形柱面,从而得到2n+1个子区间;
(2)然后通过最大最小蚁群算法MMAS得到部分优化解,并作为EGA算法的初始值;
(3)利用MMAS和EGA算法进行同步运算,实现路径寻优;最后利用改进的变异算子和MMAS继续寻优,最终得到最优路径。
进一步改进,步骤(2)中,先进行参数初始化,参数包括蚂蚁数量m1,挥发系数ρ,种群数量m2,交叉概率pc,变异概率pm,最大迭代次数iter_max,信息素重要程度因子α,启发函数重要程度因子β,初始化时迭代次数iter设置为1;然后通过迭代最优解定义算法的转换时刻,并将转换时刻MMAS的路径求解值和全局最优求解值作为EGA算法的初始解。
进一步的,步骤3中MMAS和EGA算法路径寻优方法包括以下步骤:
首先,通过MMAS算法继续最优解的计算,并以上次迭代得到的最优解对路径信息素浓度进行更新,计算公式入使(1)
式中,τij(t)为t时刻ij两栅格间的信息素浓度,ρ为挥发系数,为迭代最优解的信息素浓度增量;
同时,将EGA算法每次迭代得到的最优解更新至信息素浓度,加快收敛速度和扩大收敛范围。
进一步的,所述障碍物的体积在极径上的长度等效为自身长度和无人机长度之和。
进一步的,无人机经过障碍物的最短安全距离为路径与障碍物边缘的最小距离为无人机长度的0.2~0.5倍。
有益效果:与现有技术相比,本发明采用全新的极坐标系进行区域环境划分和建模,在确保计算精度的同时简化了计算量,从而提高了寻优效率;同时采用MMAS算法与EGA算法的收敛速度的特点,采取了在每次中将迭代最优解和EGA优化得到的最优解共同更新信息素的方法,提高了搜索最优解的效率
附图说明
图1为本发明所述无人机自主寻路策略方法的流程示意图。
具体实施方式
下面结合附图对本发明作更进一步的说明。应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
如图1所示,本发明中无人机自主寻路策略方法的路径规范步骤如下:通过极坐标法改进栅格对环境进行建模,将MMAS算法得到的部分优化解作为EGA算法的初始解,利用MMAS和EGA算法的同步运算,并结合变异算子继续寻优,最终得到最优路径。
具体过程如下:首先,基于极坐标系对环境进行建模,首先将无人机等效为质点,将障碍物的体积等效为自身体积与无人机体积之和,在水平面上采用极坐标方式建立扇形栅格划分单元,无人机所在坐标s(t)为t+1时刻的极点;然后在三维环境中,在无人机的运动方向上按照极径距离对各障碍物进行聚类划分,将极径ρ方向上间距小于无人机机长1.2倍的障碍物聚为一类,并记为聚类结果n,n=1,2,3…N,同时在聚类结果n离无人机质点极径最小和最大处作虚拟环形柱面,从而得到2n+1个子区间。相对于x-y坐标系下的栅格建模,本发明中的极坐标环境建模越靠近无人机质点,划分区域越小,也就是越精细提高了数据计算精度,随着原理无人机质点,单个划分区域逐渐增大,从而能减少栅格数量和计算量,提高了计算和寻优的计算效率。因此本发明采用近程有限精度计算,远程有限效率计算,从而在保证计算精度的同时,大大减少了计算量,从而提高了计算效率。
然后,对MMAS和EGA算法的参数初始化,包括蚂蚁数量m1,挥发系数ρ,种群数量m2,交叉概率pc,变异概率pm,最大迭代次数iter_max,信息素重要程度因子α,启发函数重要程度因子β,初始化时迭代次数iter设置为1。本发明中在水平面上的路径选择,主要考虑无人机的路径的偏转角和行进长度仅为二维环境下的运动,相对于x-y栅格,路径转变过程时采用的对角线路径,因此相对直接路径更短,同时只需再考虑在高度方向上避开与障碍物的碰撞。
然后通过迭代最优解定义算法的转换时刻,并将转换时刻MMAS的路径求解值和全局最优求解值作为EGA算法的初始解。具体而言:每次迭代中利用MMAS算法得到路径解,蚂蚁k在栅格i选择下一个栅格j的转移公式如下:
式中,allowedk为蚂蚁k待访问的栅格的集合,对迭代最优解对应的路径进行信息素更新,计算每次迭代的解的平均值、全局最优解和迭代最优解。
在i3-3220和4G内存的硬件条件下,利用Matlab进行模拟仿真,设定仿真迭代次数为50,按照极角*极长*高度模式建立360*500*500的栅格环境明显,通过本发明算法和传统GAAA算法进行路径规划。仿真结果比较如下
性能指标 | 本发明 | GAAA |
出现全局最优解仿真次数 | 30 | 12 |
第一次出现最优解时间,s | 6.8 | 10.2 |
平均运行时间 | 20.8 | 23.5 |
通过结果比较,可知本发明的寻优能力明显更优秀。
Claims (5)
1.一种无人机自主寻路策略方法,其特征在于包括以下步骤:
(1)基于极坐标系对环境进行建模,首先将无人机等效为质点,将障碍物的体积等效为自身体积与无人机体积之和,在水平面上采用极坐标方式建立扇形栅格划分单元,无人机所在坐标s(t)为t+1时刻的极点;然后在三维环境中,在无人机的运动方向上按照极径距离对各障碍物进行聚类划分,将极径ρ方向上间距小于无人机机长1.2倍的障碍物聚为一类,并记为聚类结果n,n=1,2,3…N,同时在聚类结果n离无人机质点极径最小和最大处作虚拟环形柱面,从而得到2n+1个子区间;
(2)然后通过最大最小蚁群算法MMAS得到部分优化解,并作为EGA算法的初始值;
(3)利用MMAS和EGA算法进行同步运算,实现路径寻优;最后利用改进的变异算子和MMAS继续寻优,最终得到最优路径。
2.根据权利要求前所述无人机自主寻路策略方法,其特征在于:步骤(2)中,
先进行参数初始化,参数包括蚂蚁数量m1,挥发系数ρ,种群数量m2,交叉概率pc,变异概率pm,最大迭代次数iter_max,信息素重要程度因子α,启发函数重要程度因子β,初始化时迭代次数iter设置为1;
(2)通过迭代最优解定义算法的转换时刻,并将转换时刻MMAS的路径求解值和全局最优求解值作为EGA算法的初始解。
3.根据权利要求前所述无人机自主寻路策略方法,其特征在于:步骤3中MMAS和EGA算法路径寻优方法包括以下步骤:
首先,通过MMAS算法继续最优解的计算,并以上次迭代得到的最优解对路径信息素浓度进行更新,计算公式入使(1)
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&tau;</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>&rho;</mi>
</mrow>
<mo>)</mo>
</mrow>
<mo>*</mo>
<msub>
<mi>&tau;</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msubsup>
<mi>&Delta;&tau;</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
<mrow>
<mi>b</mi>
<mi>e</mi>
<mi>s</mi>
<mi>t</mi>
</mrow>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>&Delta;&tau;</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
<mrow>
<mi>b</mi>
<mi>e</mi>
<mi>s</mi>
<mi>t</mi>
</mrow>
</msubsup>
<mo>=</mo>
<mn>1</mn>
<mo>/</mo>
<msub>
<mi>L</mi>
<mrow>
<mi>b</mi>
<mi>e</mi>
<mi>s</mi>
<mi>t</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,τij(t)为t时刻ij两栅格间的信息素浓度,ρ为挥发系数,为迭代最优解的信息素浓度增量;
同时,将EGA算法每次迭代得到的最优解更新至信息素浓度,加快收敛速度和扩大收敛范围。
4.根据权利要求1所述无人机自主寻路策略方法,其特征在于:所述障碍物的体积在极径上的长度等效为自身长度和无人机长度之和。
5.根据权利要求1所述无人机自主寻路策略方法,其特征在于:无人机经过障碍物的最短安全距离为路径与障碍物边缘的最小距离为无人机长度的0.2~0.5倍。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710397912.0A CN107229998A (zh) | 2017-05-31 | 2017-05-31 | 一种无人机自主寻路策略方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710397912.0A CN107229998A (zh) | 2017-05-31 | 2017-05-31 | 一种无人机自主寻路策略方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107229998A true CN107229998A (zh) | 2017-10-03 |
Family
ID=59934264
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710397912.0A Withdrawn CN107229998A (zh) | 2017-05-31 | 2017-05-31 | 一种无人机自主寻路策略方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107229998A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107229287A (zh) * | 2017-06-28 | 2017-10-03 | 中国人民解放军海军工程大学 | 一种基于遗传蚂蚁算法的无人机全局路径规划方法 |
CN108444482A (zh) * | 2018-06-15 | 2018-08-24 | 东北大学 | 一种无人机自主寻路避障方法及系统 |
CN115134288A (zh) * | 2021-03-10 | 2022-09-30 | 中国移动通信集团广东有限公司 | 通信网络路由调度方法及系统 |
CN117387628A (zh) * | 2023-12-11 | 2024-01-12 | 深圳大学 | 一种基于有向质点蚁群的水下机器人路径规划方法及设备 |
-
2017
- 2017-05-31 CN CN201710397912.0A patent/CN107229998A/zh not_active Withdrawn
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107229287A (zh) * | 2017-06-28 | 2017-10-03 | 中国人民解放军海军工程大学 | 一种基于遗传蚂蚁算法的无人机全局路径规划方法 |
CN108444482A (zh) * | 2018-06-15 | 2018-08-24 | 东北大学 | 一种无人机自主寻路避障方法及系统 |
CN108444482B (zh) * | 2018-06-15 | 2021-10-22 | 东北大学 | 一种无人机自主寻路避障方法及系统 |
CN115134288A (zh) * | 2021-03-10 | 2022-09-30 | 中国移动通信集团广东有限公司 | 通信网络路由调度方法及系统 |
CN115134288B (zh) * | 2021-03-10 | 2023-08-15 | 中国移动通信集团广东有限公司 | 通信网络路由调度方法及系统 |
CN117387628A (zh) * | 2023-12-11 | 2024-01-12 | 深圳大学 | 一种基于有向质点蚁群的水下机器人路径规划方法及设备 |
CN117387628B (zh) * | 2023-12-11 | 2024-02-23 | 深圳大学 | 一种基于有向质点蚁群的水下机器人路径规划方法及设备 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112000131B (zh) | 基于人工势场法的无人机集群路径规划方法及系统 | |
CN107229998A (zh) | 一种无人机自主寻路策略方法 | |
CN109945881B (zh) | 一种蚁群算法的移动机器人路径规划方法 | |
WO2016045615A1 (zh) | 机器人静态路径规划方法 | |
CN108847037A (zh) | 一种面向非全局信息的城市路网路径规划方法 | |
CN112902969B (zh) | 一种无人机在数据收集过程中的路径规划方法 | |
CN107229287A (zh) | 一种基于遗传蚂蚁算法的无人机全局路径规划方法 | |
CN108388250B (zh) | 一种基于自适应布谷鸟搜索算法的水面无人艇路径规划方法 | |
CN110244733A (zh) | 一种基于改进蚁群算法的移动机器人路径规划方法 | |
CN111930121B (zh) | 一种室内移动机器人的混合路径规划方法 | |
CN105717926A (zh) | 基于改进蚁群算法的移动机器人旅行商优化方法 | |
CN103336526A (zh) | 基于协同进化粒子群滚动优化的机器人路径规划方法 | |
CN101739509B (zh) | 一种大规模虚拟人群路径导航方法 | |
CN112666957A (zh) | 一种基于改进蚁群算法的水下机器人路径规划方法 | |
CN101837591A (zh) | 基于双群协同竞争粒子群和Ferguson样条的机器人路径规划方法 | |
CN113759971B (zh) | 一种面向无人机协同侦察的路径规划方法 | |
CN113985888B (zh) | 一种基于改进蚁群算法的叉车路径规划方法及系统 | |
CN115357031B (zh) | 一种基于改进蚁群算法的船舶路径规划方法及系统 | |
CN112666981B (zh) | 基于原鸽群动态群组学习的无人机集群动态航路规划方法 | |
CN112511250A (zh) | 一种基于drl的多无人机空中基站动态部署方法及系统 | |
CN115866621B (zh) | 一种基于鲸鱼算法的无线传感器网络覆盖方法 | |
CN115202394A (zh) | 一种基于改进遗传算法的无人机全覆盖路径规划方法 | |
CN108924755A (zh) | 基于免疫粒子群优化的dv-hop室内定位方法 | |
CN115454132A (zh) | 一种面向山地光伏电站的无人机巡检三维路径规划方法及系统 | |
CN115952935A (zh) | 一种基于改进袋獾优化算法的无人机路径规划方法 |
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 | ||
WW01 | Invention patent application withdrawn after publication | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20171003 |