CN109375645B - 基于群集智能的多无人机协同区域巡视控制方法 - Google Patents
基于群集智能的多无人机协同区域巡视控制方法 Download PDFInfo
- Publication number
- CN109375645B CN109375645B CN201811298212.7A CN201811298212A CN109375645B CN 109375645 B CN109375645 B CN 109375645B CN 201811298212 A CN201811298212 A CN 201811298212A CN 109375645 B CN109375645 B CN 109375645B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicles
- patrol
- aerial vehicle
- cluster
- 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
- 238000000034 method Methods 0.000 title claims abstract description 56
- 238000012544 monitoring process Methods 0.000 claims abstract description 15
- 230000001360 synchronised effect Effects 0.000 claims abstract description 14
- 239000011159 matrix material Substances 0.000 claims description 12
- 238000004364 calculation method Methods 0.000 claims description 8
- 238000004422 calculation algorithm Methods 0.000 claims description 7
- 238000010845 search algorithm Methods 0.000 claims description 5
- 238000012512 characterization method Methods 0.000 claims description 3
- 238000007689 inspection Methods 0.000 claims description 3
- 230000000694 effects Effects 0.000 abstract description 7
- 238000010586 diagram Methods 0.000 description 3
- 230000015572 biosynthetic process Effects 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011478 gradient descent method Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001737 promoting effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本公开提供一种基于群集智能的多无人机协同区域巡视控制方法,使N架无人机在各自的目标位置做圆周运动,最终实现对目标区域的协同覆盖巡视,且达到稳定状态时,N架无人机进入同步监视模式或平衡监视模式,从而能够使多架无人机进行协同作业,扩大可巡视区域或提高巡视效果,且自主化程度高。
Description
技术领域
本公开涉及多无人机集群控制技术领域,尤其涉及一种基于群集智能的多无人机协同区域巡视控制方法。
背景技术
在军事和民用领域,常需要使用无人机在某一区域上空进行反复的飞行且其飞行轨迹能覆盖目标区域以完成侦察、监视、测绘、航拍等任务,我们将此类任务称之为区域巡视。
在无人机巡视领域,比如安防领域的对目标区域进行巡查监视,军用领域对敌方战场进行侦察监视等应用场景中,现有的方案中所使用的无人机大多是单架无人机,或多架无人机编队飞行。
然而,在实现本公开的过程中,本申请发明人发现,单架无人机的巡视区域较小,巡视效果较差,并且现有的方案大多是通过工作人员手动遥控,即使有少量的自动化巡视方案,但自主化程度不高,无法做到多架无人机协同自主飞行,现有技术中的多无人机编队算法仅实现了对轨迹的协同,没有实现对无人机相位(航向角)的协同控制,即无法实现让所有无人机做圆周运动的同时还能让它们的相位保持同步状态(所有无人机具有相同的航向角)或平衡状态(所有无人机的航向角均匀的分布在0-360°之间)。
公开内容
(一)要解决的技术问题
基于上述技术问题,本公开提供一种基于群集智能的多无人机协同区域巡视控制方法,以缓解现有技术中的无人机控制方案巡视区域小,巡视效果差,自主化程度低,无法实现对无人机相位的协同控制的技术问题。
(二)技术方案
本公开提供一种基于群集智能的多无人机协同区域巡视控制方法,使N架无人机在各自的目标位置做圆周运动,最终实现对目标区域的协同覆盖巡视,且达到稳定状态时,N架所述无人机进入同步监视模式或平衡监视模式,N≥2,包括:
步骤A:对巡视区域分割,控制N架无人机飞往各自指定位置;
步骤B:建立目标方程,使该目标方程取得极小值时,N架所述无人机的相位达到期望的相位分布;
步骤C:确定该目标方程在求取极小值过程中的下降方向和步长,并根据期望的相位分布,确定N架所述无人机的控制率;
步骤D:基于下降方向与步长,迭代计算所述控制率,并将所述控制率发送至N架所述无人机;
步骤E:重复步骤C至步骤D,直至终止协同巡视模式。
在本公开的一些实施例中,所述步骤B中,所述目标方程如下式所示:
在本公开的一些实施例中,所述步骤C中,基于BFGS方法,确定该目标方程在求取极小值过程中的下降方向。
在本公开的一些实施例中,所述步骤C中,该目标方程在求取极小值过程中的下降方向如下式所示:
其中,k表示第k次采集时刻。
在本公开的一些实施例中,所述步骤C中,通过线性搜索算法确定合适的步长。
在本公开的一些实施例中,通过线性搜索算法确定合适的步长,包括确定a1∈(0,1),α∈(0,1),令j=0;迭代j值,令j=j+1,直至f(xk+αjdk)≤f(xk)+a1αjgT(xk)dk;迭代结束,令αk=αj。
在本公开的一些实施例中,所述步骤C中:
同步监视模式下的控制率如下式所示:
平衡监视模式下的控制率如下式所示:
其中,ω0=[ω1,...,ωN]T,用于设定N架所述无人机的角速度。
在本公开的一些实施例中,所述步骤D包括:
步骤D1:算法初始化,包括:获取N架所述无人机的初始相位、设定巡航速度、期望角速度ω0以及对称正定矩阵Bk初始值B0=In;
步骤D2:在迭代计算过程中根据下式更新Bk:
其中,sk=xk+1-xk,yk=gk+1-gk,Bk是一个n×n对称正定矩阵;
步骤D3:确保Bk+1的正定性,并避免其接近奇异值。
在本公开的一些实施例中,所述步骤D2中,若Bk接近奇异值,通过下式对Bk进行修正:
(三)有益效果
从上述技术方案可以看出,本公开提供的基于群集智能的多无人机协同区域巡视控制方法具有以下有益效果的其中之一或其中一部分:
(1)本公开提供的基于群集智能的多无人机协同区域巡视控制方法,能够使多架无人机进行协同作业,扩大可巡视区域(每个无人机负责一块区域,同时可巡视面积就会扩大)或提高巡视效果(多架无人机在同一区域以不同高度巡视,可以弥补一架无人机巡视精度不够的缺点);
(2)本公开提供的基于群集智能的多无人机协同区域巡视控制方法相比于现有技术中的手动遥控方案自主化程度高;
(3)本公开提供的基于群集智能的多无人机协同区域巡视控制方法能够使所有无人机做圆周运动的同时还能让它们的相位保持同步状态或平衡状态。
附图说明
图1为本公开提供的基于群集智能的多无人机协同区域巡视控制方法的步骤流程图。
图2为本公开提供的基于群集智能的多无人机协同区域巡视控制方法的运算逻辑结构图。
图3为利用本公开提供的基于群集智能的多无人机协同区域巡视控制方法控制3架无人机实现同步监视模式的仿真结果图。
图4为利用本公开提供的基于群集智能的多无人机协同区域巡视控制方法控制3架无人机实现平衡监视模式的仿真结果图。
具体实施方式
本公开提供的基于群集智能的多无人机协同区域巡视控制方法能够使多架无人机进行协同作业,扩大可巡视区域并提高巡视效果。
为使本公开的目的、技术方案和优点更加清楚明白,以下结合具体实施例,并参照附图,对本公开进一步详细说明。
本公开提供一种基于群集智能的多无人机协同区域巡视控制方法,使N架无人机在各自的目标位置做圆周运动,最终实现对目标区域的协同覆盖巡视,且达到稳定状态时,N架无人机进入同步监视模式(所有无人机具有相同的航向角)或平衡监视模式(所有无人机的航向角均匀的分布在0-360°之间),N≥2,如图1至图2所示,包括:
步骤A:对巡视区域分割,控制N架无人机飞往各自指定位置;
步骤B:建立目标方程,使该目标方程取得极小值时,N架所述无人机的相位达到期望的相位分布;
步骤C:确定该目标方程在求取极小值过程中的下降方向和步长,并根据期望的相位分布,确定N架无人机的控制率;
步骤D:基于下降方向与步长,迭代计算所述控制率,并将所述控制率发送至N架所述无人机;
步骤E:重复步骤C至步骤D,直至终止协同巡视模式。
为使本公开实施例提供的基于群集智能的多无人机协同区域巡视控制方法更便于理解,以下通过建立系统模型,对本公开实施例提供的基于群集智能的多无人机协同区域巡视控制方法进行解释说明:
在一组含有N个无人机的无人机集群中,第m个无人机的系统模型描述为:
其中θm是第m个无人机的相位角,xm,是第m个无人机的位置坐标,m=1,...,N。Δt是采样时间,假定无人机m有一个正的定常巡航速度vm>0,且是其控制输入,为了便于分析,在本实施例中,省略Δt,并且上标m和下标m具有相同的含义。
为了定义一组N个无人机需要形成的两种期望形式(同步监视模式和平衡监视模式)的相位分布,首先通过下式定义参数pθ:
同步相位分布的定义为:当所有无人机的相位都相同时,对于m,n=1,...,N,随着t→∞,|pθ|→1,即:随着t→∞,θm-θn→0;
平衡相位分布的定义为:各个无人机的相位值使得随着t→∞,|pθ|→0。
在本公开的一些实施例中,步骤B中,目标方程如下式所示:
由于目标函数的形式是一个无约束非线性优化问题,无法直接求出问题的解析解,因此在本公开实施例中采用迭代优化算法,进行迭代求解。现有技术中常用的基于下降方向的优化算法中,根据下降方向的不同分为三种,第一种为梯度下降法其计算量小但收敛速度慢;第二种为牛顿法其收敛速度快但计算量大,第三种是BFGS方法,其计算量和梯度下降法相同,但收敛速度接近牛顿法,因此,在本公开的一些实施例中,步骤C中,基于BFGS方法,确定该目标方程在求取极小值过程中的下降方向。
在本公开的一些实施例中,步骤C中,该目标方程在求取极小值过程中的下降方向如下式所示:
其中,k表示第k次采集时刻。
在本公开的一些实施例中,步骤C中,通过线性搜索算法确定合适的步长,包括:
确定a1∈(0,1),α∈(0,1),令j=0;
迭代j值,令j=j+1,直至满足:
f(xk+αjdk)≤f(xk)+a1αjgT(xk)dk
迭代结束,令αk=αj。
在本公开的一些实施例中,所述步骤C中:
为了令无人机在以给定的角速度做圆周运动的同时实现同步相位分布,确定控制率如下式所示:
为了令无人机在以给定的角速度做圆周运动的同时实现平衡相位分布,确定控制率如下式所示:
其中,ω0=[ω1,...,ωN]T,用于设定N架所述无人机的角速度,采用上述控制率,N架无人机到达同步相位分布或平衡相位分布后将在各自位置做圆周运动,其各自运动半径rm=vm/|ωm|。
在本公开的一些实施例中,步骤D包括:
步骤D1:算法初始化,包括:获取N架所述无人机的初始相位、设定巡航速度、期望角速度ω0以及对称正定矩阵Bk初始值B0=In;
步骤D2:在迭代计算过程中根据下式更新Bk:
其中,sk=xk+1-xk,yk=gk+1-gk,Bk是一个n×n对称正定矩阵;
步骤D3:确保Bk+1的正定性,并避免其接近奇异值。
在本公开的一些实施例中,通过线搜索确定步长的方法并不能保证Bk的正定性,因此在步骤D2中,依据的值判断Bk+1的正定性:其中,当时,Bk+1为正定矩阵;当时,Bk+1为非正定矩阵,此时令Bk+1=Bk,即:
以下以两具体实施例,验证本公开实施例提供的基于群集智能的多无人机协同区域巡视控制方法的有效性:
实施例1:在本实施例中,一组包含三个无人机的无人机集群在初始位置的巡航速度分别为v1=1.5,v2=1,v3=0.8,初始相角分别为θ1=3π/4,θ2=π/2,θ3=π/4,如图3(a)所示,设定目标函数 并采用同步相位模式的控制率,期望角速度设定为ω1=ω2=ω3=0.5,仿真结果如图3(b)所示,从初始位置出发后,经过短暂的调整过程,所有无人机以期望的角速度围绕各自的目标圆心做圆周运动,并且,所有无人机的航向角可以始终保持一致。
实施例2:在本实施例中,一组包含三个无人机的无人机集群在初始位置的巡航速度分别为v1=1.5,v2=1,v3=0.8,初始相角分别为θ1=3π/4,θ2=π/2,θ3=π/4,如图4(a)所示,设定目标函数 并采用平衡相位模式的控制率,期望角速度设定为ω1=ω2=ω3=0.5,仿真结果如图4(b)所示,从初始位置出发后,经过短暂的调整过程,所有无人机以期望的角速度做圆周运动的同时可以实现航向角成平衡模式分布。
依据以上描述,本领域技术人员应当对本公开实施例提供的基于群集智能的多无人机协同区域巡视控制方法有了清楚的认识。
综上所述,本公开提供的基于群集智能的多无人机协同区域巡视控制方法通过建立目标方程,并对目标方程求取极小值,从而实现多架无人机进行协同作业,扩大可巡视区域并提高巡视效果。
还需要说明的是,实施例中提到的方向用语,例如“上”、“下”、“前”、“后”、“左”、“右”等,仅是参考附图的方向,并非用来限制本公开的保护范围。贯穿附图,相同的元素由相同或相近的附图标记来表示。在可能导致对本公开的理解造成混淆时,将省略常规结构或构造。
并且图中各部件的形状和尺寸不反映真实大小和比例,而仅示意本公开实施例的内容。另外,在权利要求中,不应将位于括号之间的任何参考符号构造成对权利要求的限制。
类似地,应当理解,为了精简本公开并帮助理解各个公开方面中的一个或多个,在上面对本公开的示例性实施例的描述中,本公开的各个特征有时被一起分组到单个实施例、图、或者对其的描述中。然而,并不应将该公开的方法解释成反映如下意图:即所要求保护的本公开要求比在每个权利要求中所明确记载的特征更多的特征。更确切地说,如前面的权利要求书所反映的那样,公开方面在于少于前面公开的单个实施例的所有特征。因此,遵循具体实施方式的权利要求书由此明确地并入该具体实施方式,其中每个权利要求本身都作为本公开的单独实施例。
以上所述的具体实施例,对本公开的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本公开的具体实施例而已,并不用于限制本公开,凡在本公开的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本公开的保护范围之内。
Claims (9)
1.一种基于群集智能的多无人机协同区域巡视控制方法,使N架无人机在各自的目标位置做圆周运动,最终实现对目标区域的协同覆盖巡视,且达到稳定状态时,N架所述无人机进入同步监视模式或平衡监视模式,N≥2,包括:
步骤A:对巡视区域分割,控制N架无人机飞往各自指定位置;
步骤B:建立目标方程,使该目标方程取得极小值时,N架所述无人机的相位达到期望的相位分布;
步骤C:确定该目标方程在求取极小值过程中的下降方向和步长,并根据期望的相位分布,确定N架所述无人机的控制率;
步骤D:基于下降方向与步长,迭代计算所述控制率,并将所述控制率发送至N架所述无人机;
步骤E:重复步骤C至步骤D,直至终止协同巡视模式;
其中,所述步骤B中,所述目标方程如下式所示:
2.根据权利要求1所述的基于群集智能的多无人机协同区域巡视控制方法,所述步骤C中,基于BFGS方法,确定该目标方程在求取极小值过程中的下降方向。
4.根据权利要求3所述的基于群集智能的多无人机协同区域巡视控制方法,所述步骤C中,通过线性搜索算法确定合适的步长。
5.根据权利要求4所述的基于群集智能的多无人机协同区域巡视控制方法,通过线性搜索算法确定合适的步长,包括:
确定a1∈(0,1),α∈(0,1),令j=0;
迭代j值,令j=j+1,直至f(xk+αjdk)≤f(xk)+a1αjgT(xk)dk;
迭代结束,令αk=αj。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811298212.7A CN109375645B (zh) | 2018-11-01 | 2018-11-01 | 基于群集智能的多无人机协同区域巡视控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811298212.7A CN109375645B (zh) | 2018-11-01 | 2018-11-01 | 基于群集智能的多无人机协同区域巡视控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109375645A CN109375645A (zh) | 2019-02-22 |
CN109375645B true CN109375645B (zh) | 2020-05-12 |
Family
ID=65396794
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811298212.7A Active CN109375645B (zh) | 2018-11-01 | 2018-11-01 | 基于群集智能的多无人机协同区域巡视控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109375645B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109947127A (zh) * | 2019-03-12 | 2019-06-28 | 深圳市道通智能航空技术有限公司 | 一种无人机监控方法、装置、设备及存储介质 |
CN112068584B (zh) * | 2020-06-16 | 2024-07-19 | 中国人民解放军军事科学院国防科技创新研究院 | 一种无人机区域覆盖控制系统及其控制方法 |
CN115857417B (zh) * | 2023-02-24 | 2023-04-28 | 中国烟草总公司四川省公司 | 基于智能遥感图像识别的无人机农药喷洒控制系统及方法 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105208347B (zh) * | 2015-10-08 | 2018-08-14 | 成都时代星光科技有限公司 | 铁路线空中无人机自动巡查与实时图像采集传输监控装置 |
CN105966568B (zh) * | 2016-05-20 | 2018-10-09 | 武汉理工大学 | 一种装备于海事巡航搜救无人艇的自适应可调节装置 |
CN106959700B (zh) * | 2017-03-21 | 2019-08-27 | 北京航空航天大学 | 一种基于上限置信区间算法的无人机群协同巡逻追踪轨迹规划方法 |
CN107976690B (zh) * | 2017-11-17 | 2021-04-30 | 西安电子科技大学 | 一种智能协同环境下的多无人机抗gps欺骗方法 |
US10037706B1 (en) * | 2017-12-08 | 2018-07-31 | Kitty Hawk Corporation | Aircraft movement limits for safe flight |
CN108196575B (zh) * | 2018-01-05 | 2020-11-03 | 湖北工业大学 | 一种无人机任务分配及路线规划方法 |
CN108227720A (zh) * | 2018-03-19 | 2018-06-29 | 徐州艾奇机器人科技有限公司 | 一种四轮驱动高速全天候无人驾驶巡逻车系统 |
CN108674681B (zh) * | 2018-03-22 | 2021-08-17 | 武汉理工大学 | 一种海陆两用自供能无人机航保基站 |
CN108445884A (zh) * | 2018-04-11 | 2018-08-24 | 上海大学 | 一种基于多无人艇协同的巡逻系统及方法 |
-
2018
- 2018-11-01 CN CN201811298212.7A patent/CN109375645B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109375645A (zh) | 2019-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Zhang et al. | Autonomous flight control of a nano quadrotor helicopter in a GPS-denied environment using on-board vision | |
CN102591358B (zh) | 一种多无人机的动态编队控制方法 | |
CN104062977B (zh) | 基于视觉slam的四旋翼无人机全自主飞行控制方法 | |
CN109375645B (zh) | 基于群集智能的多无人机协同区域巡视控制方法 | |
WO2019024303A1 (zh) | 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法 | |
CN108388269A (zh) | 基于四旋翼飞行器的无人机编队飞行控制方法 | |
CN106707749B (zh) | 一种针对仿生扑翼飞行机器人的控制方法 | |
CN111026160B (zh) | 一种四旋翼无人机轨迹跟踪控制方法 | |
CN108845588A (zh) | 一种基于非线性制导的四旋翼飞行器轨迹跟踪控制方法 | |
CN109976164A (zh) | 一种多旋翼无人机能量优化视觉覆盖轨迹规划方法 | |
CN105116914B (zh) | 一种平流层飞艇解析模型预测路径跟踪控制方法 | |
CN110673623B (zh) | 一种基于双环pd控制算法控制的四旋翼无人机着陆方法 | |
CN106527462A (zh) | 无人机控制装置 | |
CN109178345B (zh) | 一种用于空中动目标跟踪的云台指向及星体姿态协同控制方法 | |
CN107678442B (zh) | 一种基于双模型下的四旋翼自主着船控制方法 | |
CN110308742A (zh) | 基于同步策略的多无人机时变编队控制方法 | |
CN111176311A (zh) | 四旋翼无人机姿态的滑模延时估计控制方法及存储介质 | |
CN114815888A (zh) | 一种仿射形式的制导控制一体化控制方法 | |
Wang et al. | Path following of the autonomous airship with compensation of unknown wind and modeling uncertainties | |
CN108459611B (zh) | 一种近空间飞行器的姿态跟踪控制方法 | |
CN108427429B (zh) | 一种考虑动态指向约束的航天器视轴机动控制方法 | |
CN109976364A (zh) | 一种六旋翼飞行器姿态解耦控制方法 | |
CN109491402B (zh) | 基于集群控制的多无人机协同目标监视控制方法 | |
CN113608543A (zh) | 飞行器航迹自适应规划的方法、装置、设备及存储介质 | |
CN113110545A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |