CN113311859A - 一种无人机集群有限时间仿射编队飞行控制方法 - Google Patents
一种无人机集群有限时间仿射编队飞行控制方法 Download PDFInfo
- Publication number
- CN113311859A CN113311859A CN202110504818.7A CN202110504818A CN113311859A CN 113311859 A CN113311859 A CN 113311859A CN 202110504818 A CN202110504818 A CN 202110504818A CN 113311859 A CN113311859 A CN 113311859A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- following
- cluster
- piloting
- 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.)
- Granted
Links
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 91
- 238000000034 method Methods 0.000 title claims abstract description 51
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 title claims abstract description 33
- PXFBZOLANLWPMH-UHFFFAOYSA-N 16-Epiaffinine Natural products C1C(C2=CC=CC=C2N2)=C2C(=O)CC2C(=CC)CN(C)C1C2CO PXFBZOLANLWPMH-UHFFFAOYSA-N 0.000 title claims abstract description 25
- 239000011159 matrix material Substances 0.000 claims abstract description 37
- 238000004891 communication Methods 0.000 claims abstract description 17
- 230000008569 process Effects 0.000 claims abstract description 7
- 239000013598 vector Substances 0.000 claims description 48
- 230000008859 change Effects 0.000 claims description 15
- 230000003993 interaction Effects 0.000 claims description 14
- 238000004088 simulation Methods 0.000 claims description 13
- 238000001514 detection method Methods 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 5
- 238000006243 chemical reaction Methods 0.000 claims description 5
- 230000002452 interceptive effect Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 claims description 2
- 230000003213 activating effect Effects 0.000 claims description 2
- 230000004913 activation Effects 0.000 claims description 2
- 230000004888 barrier function Effects 0.000 description 8
- 230000009466 transformation Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000006399 behavior Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 235000001968 nicotinic acid Nutrition 0.000 description 1
- 230000004083 survival effect Effects 0.000 description 1
- 238000013519 translation 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
本发明公开一种无人机集群有限时间仿射编队飞行控制方法:确定无人机集群名义编队构型,根据无人机集群名义编队构型选择领航无人机;确定无人机集群的通信拓扑,基于该通信拓扑和名义编队构型,求解无人机集群的应力矩阵;计算领航无人机与环境中的障碍间的避障势函数;生成领航无人机的期望位置和速度;计算领航无人机的有限时间飞行控制律;更新领航无人机的飞行状态;计算跟随无人机的有限时间飞行控制律;更新跟随无人机的飞行状态;持续该过程直至满足终止条件。本发明方法实现简单,在无人机集群的编队形状上具有很大灵活性,保证无人机集群能在有限时间内形成时变编队构型,对不确定环境和机动变化具有很好的适应能力。
Description
技术领域
本发明涉及一种无人机集群有限时间仿射编队飞行控制方法,属于无人机集群协同控制技术领域。
背景技术
无人机集群通过信息的交互共享,可以功能分布化的形式执行协同搜索、救援、侦察和打击等任务,从而有效提高体系生存率和任务执行能力,具有部署方式灵活、鲁棒性强和可扩展性好等诸多优势。无人机集群编队飞行是指多架具有自主能力的无人机按照一定几何构型进行三维空间排列,且在飞行过程中可保持稳定队形,并能根据外部环境和任务需求等动态调整编队构型。
目前常见的无人机编队飞行控制方法主要包括基于行为、虚拟结构、一致性理论和仿生的方法等。这些方法大多集中在使无人机集群按照一定的几何构型进行三维空间部署,即通过对无人机集群内部机间的位置、位移或方位等分别施加一定的代数约束。虽然这些方法在解决无人机集群的编队飞行控制问题方面已经取得了很大的进展,但是这些方法在实际应用中仍然具有很大的局限性。其中,无人机集群的编队飞行控制要求每架无人机在复杂不确定的环境中仅利用有限的局部信息,形成某种面向任务的几何构型,并保持该构型协同机动以完成任务。然而,上述编队飞行控制方法难以解决不同机动条件下具有时变的平移、旋转和变尺度的编队控制问题。此外,目前大多数的编队控制方法都集中在渐近收敛到期望的编队构型,这意味着所期望的编队构型不能在有限时间内得到保证。然而从实际应用来看,无人机集群快速集结形成期望的编队构型以及快速避开飞行环境中的障碍物,并在避开障碍物后能够快速形成新的编队构型对无人机集群至关重要。
针对现有无人机编队飞行控制方法在编队构型设计不灵活、鲁棒性和适应性能力不足的问题,本发明旨在通过设计一种无碰撞的无人机集群有限时间仿射编队飞行控制方法,提高无人机集群对不确定飞行环境和机动变化的适应能力。与其他编队飞行控制方法相比,该方法不需要通过指定无人机机间的绝对位置、方位或相对位置、方位来定义无人机集群的编队构型。相反地,该方法基于仿射变换的性质,通过对无人机集群的名义编队构型进行仿射变换可以得到时变的编队构型;结合所设计的无人机与飞行环境中障碍间的成对光滑避障势函数,基于Lyapunov有限时间稳定性理论设计有限时间仿射编队飞行控制律,通过控制集群中的少数无人机(领航无人机)的机动就可以使整个无人机集群在有限时间内形成并保持新的编队构型,并避免无人机与障碍物发生碰撞,保障无人机集群的安全。
发明内容
1、发明目的:
本发明提供了一种无人机集群有限时间仿射编队飞行控制方法,其目的是提供一种分布式的有限时间无人机集群时变编队飞行控制方法,旨在提高无人机集群对不确定飞行环境和机动变化的适应能力,从而有效提高无人机集群编队飞行水平。
2、技术方案:
本发明针对受限环境下的无人机集群协同控制问题,提供了一种无人机集群有限时间仿射编队飞行控制方法,该方法的实现框图如图1所示,主要的实现步骤如下:
步骤一:初始化
在三维空间中,随机生成n≥4架无人机的初始飞行状态,包括空间位置pi=[xi,yi,zi]T、空速Vi、航向角ψi和高度变化率hi,其中下标i表示无人机的编号。在无人机集群的飞行环境中放置no个边界光滑的障碍物,初始化最大仿真时间Tmax和采样时间Ts。
步骤二:确定无人机集群的名义编队构型,并根据无人机集群的名义编队构型选择领航无人机
根据无人机集群的任务需求,确定无人机集群的名义编队构型p为:
步骤三:确定无人机集群的通信拓扑,并基于该通信拓扑和名义编队构型,求解无人机集群的应力矩阵
用有向图G=(V,E)来描述该无人机集群系统的通信拓扑,其中顶点集V={1,2,3,…,n}表示无人机的编号,边集表示无人机集群内部无人机间的交互关系,边(i,j)∈E表示无人机i可以接受来自无人机j的信息。根据无人机集群中领航无人机和跟随无人机的不同,进一步将顶点集V划分为领航无人机顶点集Vl和跟随无人机顶点集Vf,其关系满足V=Vf∪Vl,将无人机i的邻域无人机集合定义为Ni={j|(i,j)∈E,用wij来描述无人机集群系统中无人机i与无人机j之间的交互强度,则可以得到与无人机集群通信拓扑G相对应的应力矩阵Ω=[Ωij]∈Rn×n为:
其中,无人机集群内部个体间的交互强度wij需满足以下代数约束:
即:无人机集群中的任意一架无人机i的领域内的无人机j∈Ni对其施加的力是平衡的。
基于无人机集群的通信拓扑G、如式(1)所示的无人机集群名义编队构型p以及如式(3)所示的代数约束,根据无人机集群中领航无人机和跟随无人机的不同,进一步将无人机集群的应力矩阵Ω划分为如下形式:
其中,Ωll表示领航无人机之间的交互应力矩阵,Ωlf表示领航无人机与跟随无人机之间的交互应力矩阵,Ωfl表示跟随无人机与领航无人机之间的交互应力矩阵,Ωff表示跟随无人机之间的交互应力矩阵。无人机集群的应力矩阵的秩需满足rank(Ω)=n-4。
步骤四:计算领航无人机与环境中的障碍物间的避障势函数
其中,pok表示障碍物Ok边界上的任意一点。
其中,ρε(·)为光滑的激活函数,用于在无人机感知到飞行环境中的障碍物时激活无人机的避障模式,其表达式为:
其中,0<ε<1。
步骤五:生成领航无人机的期望位置和期望速度
步骤六:计算领航无人机的有限时间飞行控制律
对于无人机集群中的领航无人机i∈Vl,计算领航无人机i的实际位置pi与期望位置之间的误差向量和实际速度与期望速度之间的误差向量其中,然后,基于所获得的位置误差向量和速度误差向量由式(7)得到的无人机与障碍物间的光滑避障势函数以及由式(10)得到的无人机障碍检测标志fi,设计如式(11)所示的领航无人机i的类滑模变量si为:
其中,c1i>0、c2i>0、c3i>0、c4i>0和γ1i>1均为常数,sgn(·)为符号函数。用于计算位置误差向量的分数阶,且如果fi≠0,那么ξ=0,否则ξ∈R+。为光滑避障势函数关于向量场的梯度,该项主要用于无人机在受限环境中的制导以确保无人机能够避开环境中的障碍物。基于Lyapunov稳定性理论,根据式(11),可得领航无人机i的控制律为:
将由式(12)计算得到的控制律代入如下式所示的控制指令转换律可得领航无人机i的自动驾驶仪控制指令为:
步骤七:更新领航无人机的飞行状态
将由式(13)计算所得的自动驾驶仪控制指令Vi C、和代入如式(14)所示的领航无人机i的动力学模型中,然后更新领航无人机i的飞行状态,得到下一时刻无人机i的位置pi=[xi,yi,zi]T,速度Vi,航向ψi和高度变化率hi。
i∈Vl
步骤八:计算跟随无人机的有限时间飞行控制律
根据所有领航无人机的位置向量i∈Vl和速度向量基于如式(1)所示的名义编队构型和在步骤三中得到的无人机集群的应力矩阵Ω,求解跟随无人机的在该时刻的期望位置向量和期望速度向量其中为克罗内克运算符,I3为3×3维的单位矩阵。
步骤九:更新跟随无人机的飞行状态
将由步骤八计算得到的自动驾驶仪控制指令和代入如下所示的跟随无人机j的动力学模型中,然后更新跟随无人机j的飞行状态,得到下一时刻无人机j的位置pj=[xj,yj,zj]T,速度Vj,航向ψj和高度变化率hj。
j∈Vf
步骤十:判断是否停止迭代
仿真迭代次数t=t+Ts。若t大于最大仿真时间Tmax,则仿真结束,进入步骤十一;否则,返回步骤四。
步骤十一:输出无人机集群在受限环境中的仿射编队飞行控制结果
输出无人机集群在受限环境中的仿射编队飞行控制结果,包括飞行轨迹和飞行状态的变化曲线等。
3、优点及效果:
本发明提出了一种无人机集群有限时间仿射编队飞行控制方法,可用于解决受限环境中无人机集群的快速时变编队飞行控制问题。本发明所提出的编队飞行控制方法的优势主要体现在:首先,基于仿射变换的性质,通过对无人机集群的名义编队构型进行仿射变换可以得到时变的编队构型,该方法不需要通过指定无人机机间的绝对位置、方位或相对位置、方位来定义无人机集群的编队构型。其次,所设计的有限时间仿射编队控制律能够保证无人机集群在有限时间内快速形成时变的编队构型。此外,通过引入无人机与障碍间的避障势函数,可以避免无人机与障碍物发生碰撞,保证无人机集群的安全。对于无人机集群来说,本发明所提出的方法不仅在编队形状上具有很大的灵活性,而且对不确定环境和机动变化具有很好的适应性。
附图说明
图1受限环境中无人机集群有限时间编队飞行控制流程图
图2无人机集群的通信拓扑
图3a、b受限环境中无人机集群有限时间编队飞行轨迹图,其中,图3a为受限环境中无人机集群有限时间编队飞行轨迹图的俯视图;图3b为受限环境中无人机集群有限时间编队飞行轨迹图的三维图。
图4无人机集群的飞行速度变化曲线
图5无人机集群的航向角变化曲线
图6无人机集群的高度变化率变化曲线
图7无人机集群的X方向上的控制律分量的变化曲线
图8无人机集群的Y方向上的控制律分量的变化曲线
图9无人机集群的Z方向上的控制律分量的变化曲线
图10无人机集群的X方向上的位置跟踪误差变化曲线
图11无人机集群的Y方向上的位置跟踪误差变化曲线
图12无人机集群的Z方向上的位置跟踪误差变化曲线
图中标号及符号说明如下:
X——三维空间中的横坐标
Y——三维空间中的纵坐标
Z——三维空间中的纵坐标
UAV——Unmanned Aerial Vehicle无人机
m——距离的单位米
s——时间的单位秒
m/s——速度的单位米/秒
rad——角度的单位弧度
Vi——无人机i的飞行速度
ψi——无人机i的航向角
hi——无人机i的高度变化率
uxi——无人机i的控制律在X方向上的分量
uyi——无人机i的控制律在Y方向上的分量
uzi——无人机i的控制律在Z方向上的分量
epi,1——无人机i在X方向上的位置跟踪误差
epi,2——无人机i在Y方向上的位置跟踪误差
epi,3——无人机i在Z方向上的位置跟踪误差
具体实施方式
见图1,下面通过具体的无人机集群有限时间仿射编队控制实例来验证本发明所提出的方法的有效性。该方法的具体步骤如下:
步骤一:初始化
在三维空间中,随机生成n=9架无人机的初始飞行状态,包括空间位置p1=[-1.64,2.35,14.77]Tm、p2=[-0.17,1.84,11.76]Tm、p3=[0.73,2.39,7.36]Tm、p4=[-0.87,1.02,7]Tm、p5=[-1.09,-0.58,10.71]Tm、p6=[-2.82,-1.60,11.58]Tm、p7=[-1.51,0.52,5.90]Tm、p8=[-1.09,1.65,7.10]Tm和p9=[-0.54,1.71,14.03]Tm,空速Vi=10m/s、航向角ψi=0rad和高度变化率hi=0m/s,其中下标i表示无人机的编号。最大仿真时间和采样时间分别设置为Tmax=35s和Ts=0.01s。
此外,在环境中放置6个障碍物,其中两个障碍物为圆柱体,其半径为4m,高度为15m,中心位置分别位于[60,9,0]m和[200,-9,0]m,剩余四个障碍物分别为长宽高等于[40,3,16]m和[40,12,2]m的长方体。
步骤二:确定无人机集群的名义编队构型,并根据无人机集群的名义编队构型选择领航无人机
步骤三:确定无人机集群的通信拓扑,并基于该通信拓扑和名义编队构型,求解无人机集群的应力矩阵
用如图2所示的有向图G=(V,E)来表示这9架无人机的通信拓扑,其中顶点集为V={1,2,3,4,5,6,7,8,9},领航无人机顶点集Vl={1,2,3,4}和跟随无人机顶点集Vf={5,6,7,8,9}。根据无人机集群的通信拓扑G确定无人机i的邻域无人机集合Ni={j|(i,j)∈E,进一步结合如式(1)所示的无人机集群名义编队构型以及如式(3)所示的无人机集群内部个体间的交互强度wij的代数约束,计算无人机集群的应力矩阵Ω,可得到:
步骤四:计算领航无人机与环境中的障碍物间的避障势函数
将领航无人机的障碍感知半径设置为dsen=5m,根据式(6)计算无人机i,i∈Vl在障碍物Ok边界上的投影位置向量通过式(5)判断每架领航无人机的障碍感知范围内是否存在障碍,如果存在,则无人机的邻域障碍集合为否则将无人机与障碍物间的最小安全距离设置为dsafe=3m,避障势函数的参数选取为υ=0.3,ε=0.4,然后基于无人机的邻域障碍集合根据式(7)至式(9)计算出每架无人机与障碍物间的避障势函数此外,根据无人机的邻域障碍集合是否为空集,确定无人机当前是否应该激活避障模式,即:如果那么无人机的障碍检测标志fi=1,否则fi=0。
步骤五:生成领航无人机的期望位置和期望速度
对于无人机集群中的领航无人机i∈Vl,生成领航无人机i在该时刻的期望位置向量期望速度向量以及期望速度向量的一阶导数其中,领航无人机的期望位置向量分别设置为: 和期望速度向量均设置为:i∈Vl,期望速度向量的一阶导数均设置为:i∈Vl。
步骤六:计算领航无人机的有限时间飞行控制律
计算领航无人机i,i∈Vl的实际位置pi与期望位置之间的误差向量和实际速度期望速度之间的误差向量其中,然后,基于所获得的位置误差向量和速度误差向量由式(7)得到的无人机与障碍物间的光滑避障势函数以及由式(10)得到的无人机障碍检测标志fi。选取参数c1i=10,c2i=2,c3i=1,c4i=1和γ1i=1.7,将其代入式(11)可得领航无人机i的类滑模变量为 其中,如果fi≠0,那么ξ=0,否则ξ∈R+。然后选取参数λ1i=10,λ2i=2和γ2i=0.6,并将其代入式(12)可得领航无人机i的控制律为最后将该控制律代入如式(13)所示的控制律转换律可得领航无人机i的自动驾驶仪控制指令Vi C、和
步骤七:更新领航无人机的飞行状态
将由步骤六获得的自动驾驶仪控制指令Vi C、和代入如式(14)所示的领航无人机i的动力学模型中,更新领航无人机i的飞行状态,得到下一时刻无人机i的位置pi=[xi,yi,zi]T,速度Vi,航向ψi和高度变化率hi。其中,无人机的马赫数保持自动驾驶仪、航向保持自动驾驶仪和高度保持自动驾驶仪的时间常数分别设置为和
步骤八:计算跟随无人机的有限时间飞行控制律
其中为克罗内克运算符,I3为3×3维的单位矩阵。定义j∈Vf为由所有跟随无人机在该时刻的位置向量构成的位置矩阵,计算其与期望位置的误差基于该误差,选取参数c5=2,c6=0.1,γ3=1.2,根据式(15)可得跟随无人机的类滑模变量为然后选择参数λ3=2,λ4=0.1和γ4=0.2,根据式(16)计算出跟随无人机的控制律同样地,将计算得到的控制律uf代入式(13)可得每架跟随无人机j,j∈Vf的自动驾驶仪控制命令和
步骤九:更新跟随无人机的飞行状态
将由步骤八计算得到的自动驾驶仪控制指令和代入式(17)所示的跟随无人机j的动力学模型中,然后更新跟随无人机j的飞行状态,得到下一时刻无人机j的位置pj=[xj,yj,zj]T,速度Vj,航向ψj和高度变化率hj。其中,无人机的马赫数保持自动驾驶仪、航向保持自动驾驶仪和高度保持自动驾驶仪的时间常数分别设置为和
步骤十:判断是否停止迭代
仿真迭代次数t=t+Ts。若t大于最大仿真时间Tmax,则仿真结束,进入步骤十一;否则,返回步骤四。
步骤十一:输出无人机集群在受限环境中的仿射编队飞行控制结果
输出仿真结果,无人机集群在受限环境中的仿射编队飞行结果如图3至图12所示。图3a、b展示了由9架无人机组成的集群在具有障碍物的受限环境中从初始位置出发到形成时变编队的飞行轨迹。所提出的有限时间仿射编队飞行控制方法能够保证所有无人机在有限时间内形成理想的几何构型。同时,所有无人机都能实现协同机动。多无人机系统通过协同机动可以连续改变编队构型的质心、方向、尺寸等几何参数,以适应受限环境和快速变化的任务。即使只有领航无人机具备障碍检测能力,所有的无人机都能避免与障碍物发生碰撞,并协同避开障碍物或穿过障碍物之间的狭窄通道。图4至图6分别显示了9架无人机的飞行速度、航向角和高度变化率的变化曲线。图7至图9分别显示了9架无人机的控制分量在X、Y和Z方向上的变化曲线。图10至图12分别显示了9架无人机在X、Y和Z方向上的位置跟踪误差的变化曲线。从这些结果可以看出,领航无人机能够快速避开障碍物,当障碍物逐渐从无人机的感知区域内消失时,无人机可以在有限的时间内快速恢复到目标轨迹。此外,跟随无人机也可以在有限时间内无误差地跟踪上由其交互邻域无人机共同决定的时变的期望位置。
通过9架无人机集群的仿射编队飞行结果验证了通过本发明所提出的有限时间仿射编队飞行控制方法不仅能使无人机集群能在有限时间内形成时变的编队构型,保持协同机动,同时也能避开环境中存在的障碍物,保证无人机集群的飞行安全。
Claims (6)
1.一种无人机集群有限时间仿射编队飞行控制方法,其特征在于:该方法步骤如下:
步骤一:初始化
在三维空间中,随机生成n≥4架无人机的初始飞行状态,包括空间位置pi=[xi,yi,zi]T、空速Vi、航向角ψi和高度变化率hi,其中下标i表示无人机的编号;在无人机集群的飞行环境中放置no个边界光滑的障碍物,初始化最大仿真时间Tmax和采样时间Ts;
步骤二:确定无人机集群的名义编队构型,并根据无人机集群的名义编队构型选择领航无人机;
步骤三:确定无人机集群的通信拓扑,并基于该通信拓扑和名义编队构型,求解无人机集群的应力矩阵;
步骤四:计算领航无人机与环境中的障碍物间的避障势函数;
步骤五:生成领航无人机的期望位置和期望速度
步骤六:计算领航无人机的有限时间飞行控制律;
步骤七:更新领航无人机的飞行状态
将自动驾驶仪控制指令代入领航无人机i的动力学模型中,然后更新领航无人机i的飞行状态,得到下一时刻无人机i的位置pi=[xi,yi,zi]T,速度Vi,航向ψi和高度变化率hi;
步骤八:计算跟随无人机的有限时间飞行控制律;
步骤九:更新跟随无人机的飞行状态
将由步骤八计算得到的自动驾驶仪控制指令代入跟随无人机j的动力学模型中,然后更新跟随无人机j的飞行状态,得到下一时刻无人机j的位置pj=[xj,yj,zj]T,速度Vj,航向ψj和高度变化率hj;
步骤十:判断是否停止迭代
仿真迭代次数t=t+Ts;若t大于最大仿真时间Tmax,则仿真结束,进入步骤十一;否则,返回步骤四;
步骤十一:输出无人机集群在受限环境中的仿射编队飞行控制结果。
3.根据权利要求1所述的一种无人机集群有限时间仿射编队飞行控制方法,其特征在于:所述步骤三的具体过程如下:
用有向图G=(V,E)来描述该无人机集群系统的通信拓扑,其中顶点集V={1,2,3,…,n}表示无人机的编号,边集表示无人机集群内部无人机间的交互关系,边(i,j)∈E表示无人机i可以接受来自无人机j的信息;根据无人机集群中领航无人机和跟随无人机的不同,进一步将顶点集V划分为领航无人机顶点集Vl和跟随无人机顶点集Vf,其关系满足V=Vf∪Vl,将无人机i的邻域无人机集合定义为用wij来描述无人机集群系统中无人机i与无人机j之间的交互强度,则可以得到与无人机集群通信拓扑G相对应的应力矩阵Ω=[Ωij]∈Rn×n为:
其中,无人机集群内部个体间的交互强度wij需满足以下代数约束:
即:无人机集群中的任意一架无人机i的领域内的无人机j∈Ni对其施加的力是平衡的;
其中,Ωll表示领航无人机之间的交互应力矩阵,Ωlf表示领航无人机与跟随无人机之间的交互应力矩阵,Ωfl表示跟随无人机与领航无人机之间的交互应力矩阵,Ωff表示跟随无人机之间的交互应力矩阵;无人机集群的应力矩阵的秩需满足rank(Ω)=n-4。
4.根据权利要求1所述的一种无人机集群有限时间仿射编队飞行控制方法,其特征在于:所述步骤四的具体过程如下:
其中,pok表示障碍物Ok边界上的任意一点;
其中,ρε(·)为光滑的激活函数,用于在无人机感知到飞行环境中的障碍物时激活无人机的避障模式,其表达式为:
其中,0<ε<1;
5.根据权利要求1所述的一种无人机集群有限时间仿射编队飞行控制方法,其特征在于:所述步骤六的具体过程如下:
对于无人机集群中的领航无人机i∈Vl,计算领航无人机i的实际位置pi与期望位置之间的误差向量和实际速度与期望速度之间的误差向量其中,然后,基于所获得的位置误差向量和速度误差向量由式(7)得到的无人机与障碍物间的光滑避障势函数以及由式(10)得到的无人机障碍检测标志fi,设计如式(11)所示的领航无人机i的类滑模变量si为:
其中,c1i>0、c2i>0、c3i>0、c4i>0和γ1i>1均为常数,sgn(·)为符号函数;用于计算位置误差向量的分数阶,且如果fi≠0,那么ξ=0,否则ξ∈R+;为光滑避障势函数关于向量场的梯度,该项主要用于无人机在受限环境中的制导以确保无人机能够避开环境中的障碍物;基于Lyapunov稳定性理论,根据式(11),可得领航无人机i的控制律为:
将由式(12)计算得到的控制律代入如下式所示的控制指令转换律可得领航无人机i的自动驾驶仪控制指令为:
6.根据权利要求1所述的一种无人机集群有限时间仿射编队飞行控制方法,其特征在于:所述步骤八的具体过程如下:
根据所有领航无人机的位置向量i∈Vl和速度向量基于如式(1)所示的名义编队构型和在步骤三中得到的无人机集群的应力矩阵Ω,求解跟随无人机的在该时刻的期望位置向量和期望速度向量其中为克罗内克运算符,I3为3×3维的单位矩阵;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110504818.7A CN113311859B (zh) | 2021-05-10 | 2021-05-10 | 一种无人机集群有限时间仿射编队飞行控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110504818.7A CN113311859B (zh) | 2021-05-10 | 2021-05-10 | 一种无人机集群有限时间仿射编队飞行控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113311859A true CN113311859A (zh) | 2021-08-27 |
CN113311859B CN113311859B (zh) | 2022-05-10 |
Family
ID=77371828
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110504818.7A Active CN113311859B (zh) | 2021-05-10 | 2021-05-10 | 一种无人机集群有限时间仿射编队飞行控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113311859B (zh) |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114063652A (zh) * | 2021-11-23 | 2022-02-18 | 北京理工大学 | 基于应力矩阵优化的多智能体系统仿射编队控制方法 |
CN114138002A (zh) * | 2021-09-23 | 2022-03-04 | 天津大学 | 分布式多无人机编队群集行为动态障碍物避障控制方法 |
CN114384929A (zh) * | 2021-12-02 | 2022-04-22 | 上海航天控制技术研究所 | 一种基于偏差优化启发式算法的无人集群编队控制方法 |
CN114415733A (zh) * | 2022-03-30 | 2022-04-29 | 北京航空航天大学 | 一种用于节省通信带宽的无人机集群编队飞行方法 |
CN114442656A (zh) * | 2021-12-17 | 2022-05-06 | 北京航空航天大学 | 基于集群空间构架的有人/无人机共融集群编队控制方法 |
CN114661069A (zh) * | 2022-05-25 | 2022-06-24 | 西北工业大学深圳研究院 | 一种群体智能系统的编队控制方法 |
CN115033014A (zh) * | 2022-05-06 | 2022-09-09 | 北京理工大学 | 一种多无人机编队避障的分布式协同尺度决策方法及装置 |
CN115390589A (zh) * | 2022-10-27 | 2022-11-25 | 汕头大学 | 无人机集群控制方法、装置、电子设备及存储介质 |
CN115494859A (zh) * | 2022-06-30 | 2022-12-20 | 北京航空航天大学 | 一种基于迁移学习原鸽智能的无人机集群自主避障方法 |
CN115933631A (zh) * | 2022-09-14 | 2023-04-07 | 哈尔滨工程大学 | 一种应用于欠驱动无人艇的编队控制器构建方法及装置 |
CN116627053A (zh) * | 2023-05-29 | 2023-08-22 | 武汉船舶通信研究所(中国船舶集团有限公司第七二二研究所) | 一种无人平台集群通信网络的半实物仿真系统 |
CN116909319A (zh) * | 2023-09-14 | 2023-10-20 | 中国空气动力研究与发展中心空天技术研究所 | 一种分布式无人机集群编队控制方法 |
CN118363400A (zh) * | 2024-06-19 | 2024-07-19 | 西北工业大学 | 一种无人机有限时间编队集群协同决策与控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018145291A1 (en) * | 2017-02-10 | 2018-08-16 | SZ DJI Technology Co., Ltd. | System and method for real-time location tracking of drone |
CN109333529A (zh) * | 2018-09-20 | 2019-02-15 | 南京邮电大学 | 含预定义性能的多单臂机械手输出一致控制器及设计方法 |
CN111880557A (zh) * | 2020-07-02 | 2020-11-03 | 中国人民解放军军事科学院国防科技创新研究院 | 一种无人机集群编队飞行控制方法及装置 |
-
2021
- 2021-05-10 CN CN202110504818.7A patent/CN113311859B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018145291A1 (en) * | 2017-02-10 | 2018-08-16 | SZ DJI Technology Co., Ltd. | System and method for real-time location tracking of drone |
CN109333529A (zh) * | 2018-09-20 | 2019-02-15 | 南京邮电大学 | 含预定义性能的多单臂机械手输出一致控制器及设计方法 |
CN111880557A (zh) * | 2020-07-02 | 2020-11-03 | 中国人民解放军军事科学院国防科技创新研究院 | 一种无人机集群编队飞行控制方法及装置 |
Non-Patent Citations (7)
Title |
---|
CHAPA-GARCIA, R 等: "Formation flight of fixed-wing UAVs based on linear quadratic affine game", 《INTERNATIONAL CONFERENCE ON UNMANNED AIRCRAFT SYSTEMS (ICUAS)》 * |
XU, Y 等: "Affine formation control for heterogeneous multi-agent systems with directed interaction networks", 《NEURO COMPUTING》 * |
孙俊 等: "地球轨道航天器编队飞行动力学与控制研究综述", 《力学与实践》 * |
朱旭: "基于信息一致性的多无人机编队控制方法研究", 《中国博士学位论文全文数据库》 * |
杨庆凯 等: "基于仿射变换的微型无人机编队飞行控制技术", 《指挥与控制学报》 * |
杨雷恒 等: "飞翼无人机机动飞行非线性反步控制律设计", 《航空工程进展》 * |
段海滨 等: "2019年无人机热点回眸", 《科技导报》 * |
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114138002A (zh) * | 2021-09-23 | 2022-03-04 | 天津大学 | 分布式多无人机编队群集行为动态障碍物避障控制方法 |
CN114063652A (zh) * | 2021-11-23 | 2022-02-18 | 北京理工大学 | 基于应力矩阵优化的多智能体系统仿射编队控制方法 |
CN114063652B (zh) * | 2021-11-23 | 2023-11-17 | 北京理工大学 | 基于应力矩阵优化的多智能体系统仿射编队控制方法 |
CN114384929B (zh) * | 2021-12-02 | 2023-09-12 | 上海航天控制技术研究所 | 一种基于偏差优化启发式算法的无人集群编队控制方法 |
CN114384929A (zh) * | 2021-12-02 | 2022-04-22 | 上海航天控制技术研究所 | 一种基于偏差优化启发式算法的无人集群编队控制方法 |
CN114442656A (zh) * | 2021-12-17 | 2022-05-06 | 北京航空航天大学 | 基于集群空间构架的有人/无人机共融集群编队控制方法 |
CN114442656B (zh) * | 2021-12-17 | 2023-10-13 | 北京航空航天大学 | 基于集群空间构架的有人/无人机共融集群编队控制方法 |
CN114415733A (zh) * | 2022-03-30 | 2022-04-29 | 北京航空航天大学 | 一种用于节省通信带宽的无人机集群编队飞行方法 |
CN114415733B (zh) * | 2022-03-30 | 2022-07-22 | 北京航空航天大学 | 一种用于节省通信带宽的无人机集群编队飞行方法 |
CN115033014A (zh) * | 2022-05-06 | 2022-09-09 | 北京理工大学 | 一种多无人机编队避障的分布式协同尺度决策方法及装置 |
CN114661069A (zh) * | 2022-05-25 | 2022-06-24 | 西北工业大学深圳研究院 | 一种群体智能系统的编队控制方法 |
CN114661069B (zh) * | 2022-05-25 | 2022-09-06 | 西北工业大学深圳研究院 | 一种群体智能系统的编队控制方法 |
CN115494859A (zh) * | 2022-06-30 | 2022-12-20 | 北京航空航天大学 | 一种基于迁移学习原鸽智能的无人机集群自主避障方法 |
CN115933631A (zh) * | 2022-09-14 | 2023-04-07 | 哈尔滨工程大学 | 一种应用于欠驱动无人艇的编队控制器构建方法及装置 |
CN115390589B (zh) * | 2022-10-27 | 2023-02-28 | 汕头大学 | 无人机集群控制方法、装置、电子设备及存储介质 |
CN115390589A (zh) * | 2022-10-27 | 2022-11-25 | 汕头大学 | 无人机集群控制方法、装置、电子设备及存储介质 |
CN116627053A (zh) * | 2023-05-29 | 2023-08-22 | 武汉船舶通信研究所(中国船舶集团有限公司第七二二研究所) | 一种无人平台集群通信网络的半实物仿真系统 |
CN116627053B (zh) * | 2023-05-29 | 2024-05-03 | 武汉船舶通信研究所(中国船舶集团有限公司第七二二研究所) | 一种无人平台集群通信网络的半实物仿真系统 |
CN116909319A (zh) * | 2023-09-14 | 2023-10-20 | 中国空气动力研究与发展中心空天技术研究所 | 一种分布式无人机集群编队控制方法 |
CN116909319B (zh) * | 2023-09-14 | 2023-12-08 | 中国空气动力研究与发展中心空天技术研究所 | 一种分布式无人机集群编队控制方法 |
CN118363400A (zh) * | 2024-06-19 | 2024-07-19 | 西北工业大学 | 一种无人机有限时间编队集群协同决策与控制方法 |
CN118363400B (zh) * | 2024-06-19 | 2024-08-30 | 西北工业大学 | 一种无人机有限时间编队集群协同决策与控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113311859B (zh) | 2022-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113311859B (zh) | 一种无人机集群有限时间仿射编队飞行控制方法 | |
Saska et al. | Motion planning and control of formations of micro aerial vehicles | |
Wang et al. | Safe certificate-based maneuvers for teams of quadrotors using differential flatness | |
CN108445898B (zh) | 基于微分平坦特性的四旋翼无人飞行器系统运动规划方法 | |
Zheng et al. | Planning and tracking in image space for image-based visual servoing of a quadrotor | |
Roelofsen et al. | Reciprocal collision avoidance for quadrotors using on-board visual detection | |
Lee et al. | Formation flight of unmanned aerial vehicles using track guidance | |
Saska et al. | Navigation, localization and stabilization of formations of unmanned aerial and ground vehicles | |
Bhargavapuri et al. | Vision-based autonomous tracking and landing of a fully-actuated rotorcraft | |
CN108983816A (zh) | 多旋翼无人机变尺度协同监视编队飞行控制方法 | |
Lee et al. | Obstacle avoidance using image-based visual servoing integrated with nonlinear model predictive control | |
Zhu et al. | 3-D path-following control for a model-scaled autonomous helicopter | |
Patel et al. | An intelligent hybrid artificial neural network-based approach for control of aerial robots | |
Li et al. | Image-based visual servoing of rotorcrafts to planar visual targets of arbitrary orientation | |
Gonçalves et al. | Precise landing of autonomous aerial vehicles using vector fields | |
Kim et al. | Control of multi-agent collaborative fixed-wing UASs in unstructured environment | |
CN114911265A (zh) | 一种四旋翼无人机编队协同机动控制方法 | |
CN115639830A (zh) | 一种空地智能体协同编队控制系统及其编队控制方法 | |
Kumar et al. | Differential flatness based hybrid PID/LQR flight controller for complex trajectory tracking in quadcopter UAVs | |
Xi et al. | Smooth quadrotor trajectory generation for tracking a moving target in cluttered environments | |
Wang et al. | Quadrotor autonomous landing on moving platform | |
Zhang et al. | Hardware-in-the-loop simulation platform for unmanned aerial vehicle swarm system: Architecture and application | |
Davidi et al. | Formation flight using multiple integral backstepping controllers | |
Razinkova et al. | Tracking a moving ground object using quadcopter UAV in a presence of noise | |
Cordeiro et al. | Non linear controller and path planner algorithm for an autonomous variable shape formation flight |
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 |