CN113359861B - 一种无人飞艇编队飞行控制方法及*** - Google Patents
一种无人飞艇编队飞行控制方法及*** Download PDFInfo
- Publication number
- CN113359861B CN113359861B CN202110830757.3A CN202110830757A CN113359861B CN 113359861 B CN113359861 B CN 113359861B CN 202110830757 A CN202110830757 A CN 202110830757A CN 113359861 B CN113359861 B CN 113359861B
- Authority
- CN
- China
- Prior art keywords
- controller
- formation
- output quantity
- airship
- virtual
- 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
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 157
- 238000000034 method Methods 0.000 title claims abstract description 74
- 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 22
- 230000004888 barrier function Effects 0.000 claims description 26
- 230000003044 adaptive effect Effects 0.000 claims description 24
- 238000005259 measurement Methods 0.000 claims description 18
- 238000004364 calculation method Methods 0.000 claims description 9
- 239000013598 vector Substances 0.000 claims description 8
- 239000011159 matrix material Substances 0.000 claims description 5
- 238000013461 design Methods 0.000 description 11
- 238000012544 monitoring process Methods 0.000 description 4
- 238000004891 communication Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000005484 gravity Effects 0.000 description 3
- 230000007246 mechanism Effects 0.000 description 3
- 230000002411 adverse Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000004880 explosion Methods 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 239000013641 positive control Substances 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 230000001360 synchronised effect Effects 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)
- Feedback Control In General (AREA)
Abstract
本发明涉及一种无人飞艇编队飞行控制方法及***。所述方法包括:根据期望编队队形确定包含相对位置限制值的障碍李雅普诺夫Lyapunov函数;利用反步法和障碍Lyapunov函数设计虚拟控制器并进行解算,得到虚拟控制器输出量;根据虚拟控制器输出量计算自适应控制器输出量;根据自适应控制器输出量,利用反步法设计编队控制器;对编队控制器进行解算,得到编队控制器输出量;根据所述编队控制器输出量控制无人飞艇的螺旋桨转速。本发明方法及***针对有编队飞行进行轨迹跟踪飞行任务需求的网络化欠驱动无人飞艇,考虑其执行器延迟问题和相对位置受限要求,实现了无人飞艇编队飞行的高精度和稳定控制。
Description
技术领域
本发明涉及自动控制技术领域,特别是涉及一种无人飞艇编队飞行控制方法。
背景技术
无人飞艇是一种轻于空气的航空器,它与气球最大的区别在于具有推进和控制飞行的装置。平流层飞艇是一种依靠尖端科技制造而成的可以长期悬浮于平流层高空的,用于对地球表面进行军事与民用侦察、观测的无人飞艇。
平流层飞艇具有以下应用前景:
1)通信终端:一个平流层飞艇平台在20千米定点高度时,它的地面有效覆盖面积可达数万平方公里,可以为广大区域提供高速通信服务;
2)区域监视:平流层飞艇集合航空器近地飞行与同步轨道卫星定点监视的优点,可以对指定大范围区域进行定点高分辨率监视;
3)气象观测:平流层飞艇飞行高度位于云层之上,可以用来观测台风等极限气象现象。
在此基础上,多个平流层飞艇协同组网还可以在空中形成网络,平流层飞艇可以同卫星、地面基站协作,实现通信、监视与观测的广域覆盖。然而,现有的平流层飞艇的编队控制方法没有考虑存在的执行器延迟问题和相对位置受限要求,因此编队控制的精度和稳定性较低。
发明内容
本发明的目的是提供一种无人飞艇编队飞行控制方法及***,针对有编队飞行进行轨迹跟踪飞行任务需求的网络化欠驱动无人飞艇,考虑其执行器延迟问题和相对位置受限要求,提出了基于其非线性模型的一种编队飞行轨迹跟踪控制方法,以实现无人飞艇编队飞行的高精度和稳定控制。
为实现上述目的,本发明提供了如下方案:
一种无人飞艇编队飞行控制方法,包括:
获取期望编队队形;
根据所述期望编队队形确定包含相对位置限制值的障碍李雅普诺夫Lyapunov函数;
利用反步法和所述障碍Lyapunov函数设计虚拟控制器;
对所述虚拟控制器进行解算,得到虚拟控制器输出量;所述虚拟控制器输出量包括消除所述无人飞艇的期望位置与实际位置之间的误差所需的期望速度与期望角速度;
根据所述虚拟控制器输出量计算自适应控制器输出量;
根据所述自适应控制器输出量,利用反步法设计编队控制器;
对所述编队控制器进行解算,得到编队控制器输出量;所述编队控制器输出量包括消除所述无人飞艇的期望速度和期望角速度与实际速度和实际角速度之间的误差所需的控制量;
根据所述编队控制器输出量控制所述无人飞艇的螺旋桨转速。
可选地,所述根据所述期望编队队形确定包含相对位置限制值的障碍Lyapunov函数,具体包括:
根据所述期望编队队形计算轨迹跟踪误差;
根据所述轨迹跟踪误差确定包含相对位置限制值的所述障碍Lyapunov函数。
可选地,所述对所述虚拟控制器进行解算,得到虚拟控制器输出量,具体包括:
根据所述轨迹跟踪误差确定测量误差;
根据所述测量误差设计触发条件;
根据所述触发条件得到自触发控制器的触发时刻;
在所述触发时刻对所述虚拟控制器进行解算,得到虚拟控制器输出量。
可选地,所述根据所述虚拟控制器输出量计算自适应控制器输出量,具体包括:
根据所述虚拟控制器输出量确定所述期望速度和期望角速度与所述实际速度和实际角速度之间的速度和角速度误差量;
根据所述速度和角速度误差量生成虚拟状态量;
根据所述虚拟状态量确定饱和补偿器输出量和所述自适应控制器输出量。
可选地,所述根据所述自适应控制器输出量,利用反步法设计编队控制器,具体包括:
根据所述速度和角速度误差量、所述饱和补偿器输出量以及所述自适应控制器输出量,利用反步法设计所述编队控制器。
一种无人飞艇编队飞行控制***,包括:
期望编队队形获取模块,用于获取期望编队队形;
障碍Lyapunov函数确定模块,用于根据所述期望编队队形确定包含相对位置限制值的障碍李雅普诺夫Lyapunov函数;
虚拟控制器确定模块,用于利用反步法和所述障碍Lyapunov函数设计虚拟控制器;
虚拟控制器解算模块,用于对所述虚拟控制器进行解算,得到虚拟控制器输出量;所述虚拟控制器输出量包括消除所述无人飞艇的期望位置与实际位置之间的误差所需的期望速度与期望角速度;
自适应控制器输出量计算模块,用于根据所述虚拟控制器输出量计算自适应控制器输出量;
编队控制器确定模块,用于根据所述自适应控制器输出量,利用反步法设计编队控制器;
编队控制器解算模块,用于对所述编队控制器进行解算,得到编队控制器输出量;所述编队控制器输出量包括消除所述无人飞艇的期望速度和期望角速度与实际速度和实际角速度之间的误差所需的控制量;
编队飞行控制模块,用于根据所述编队控制器输出量控制所述无人飞艇的螺旋桨转速。
可选地,所述障碍Lyapunov函数确定模块具体包括:
轨迹跟踪误差计算单元,用于根据所述期望编队队形计算轨迹跟踪误差;
障碍Lyapunov函数确定单元,用于根据所述轨迹跟踪误差确定包含相对位置限制值的所述障碍Lyapunov函数。
可选地,所述虚拟控制器解算模块具体包括:
测量误差确定单元,用于根据所述轨迹跟踪误差确定测量误差;
触发条件确定单元,用于根据所述测量误差设计触发条件;
触发时刻确定单元,用于根据所述触发条件得到自触发控制器的触发时刻;
虚拟控制器解算单元,用于在所述触发时刻对所述虚拟控制器进行解算,得到虚拟控制器输出量。
可选地,所述自适应控制器输出量计算模块具体包括:
速度和角速度误差量确定单元,用于根据所述虚拟控制器输出量确定所述期望速度和期望角速度与所述实际速度和实际角速度之间的速度和角速度误差量;
虚拟状态量生成单元,用于根据所述速度和角速度误差量生成虚拟状态量;
自适应控制器输出量确定单元,用于根据所述虚拟状态量确定饱和补偿器输出量和所述自适应控制器输出量。
可选地,所述编队控制器确定模块具体包括:
编队控制器确定单元,用于根据所述速度和角速度误差量、所述饱和补偿器输出量以及所述自适应控制器输出量,利用反步法设计所述编队控制器。
根据本发明提供的具体实施例,本发明公开了以下技术效果:
本发明提供了一种无人飞艇编队飞行控制方法及***,所述方法包括:获取期望编队队形;根据所述期望编队队形确定包含相对位置限制值的障碍李雅普诺夫Lyapunov函数;利用反步法和所述障碍Lyapunov函数设计虚拟控制器;对所述虚拟控制器进行解算,得到虚拟控制器输出量;所述虚拟控制器输出量包括消除所述无人飞艇的期望位置与实际位置之间的误差所需的期望速度与期望角速度;根据所述虚拟控制器输出量计算自适应控制器输出量;根据所述自适应控制器输出量,利用反步法设计编队控制器;对所述编队控制器进行解算,得到编队控制器输出量;所述编队控制器输出量包括消除所述无人飞艇的期望速度和期望角速度与实际速度和实际角速度之间的误差所需的控制量;根据所述编队控制器输出量控制所述无人飞艇的螺旋桨转速。本发明方法及***针对有编队飞行进行轨迹跟踪飞行任务需求的网络化欠驱动无人飞艇,考虑其执行器延迟问题和相对位置受限要求,提出了基于其非线性模型的一种编队飞行轨迹跟踪控制方法,实现了无人飞艇编队飞行的高精度和稳定控制。
此外,本发明方法及***还结合了自适应算法设计方法、事件驱动控制方法和反步控制理论。由本发明方法控制的闭环***是Lyapunov稳定的,并且所设计的事件驱动控制器可以有效节约带宽资源和计算资源。在此基础上,在平流层飞艇的编队飞行过程中,相对位置误差是被限制住的,执行器延迟的不利影响可以被消除,这就为存在执行器延迟问题和相对位置受限要求的无人飞艇编队飞行工程实现提供了有效的设计手段。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本发明一种无人飞艇编队飞行控制方法的流程图;
图2为本发明实施例提供的无人飞艇的示意图;
图3为本发明一种无人飞艇编队飞行控制***的结构图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明的目的是提供一种无人飞艇编队飞行控制方法及***,针对有编队飞行进行轨迹跟踪飞行任务需求的网络化欠驱动无人飞艇,考虑其执行器延迟问题和相对位置受限要求,提出了基于其非线性模型的一种编队飞行轨迹跟踪控制方法,以实现无人飞艇编队飞行的高精度和稳定控制,为无人飞艇在存在执行器延迟问题和相对位置受限要求、考虑带宽资源与计算资源进行编队飞行时提供一种新型控制方法。
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
图1为本发明一种无人飞艇编队飞行控制方法的流程图。本发明方法考虑了执行器延迟、相对位置受限以及带宽资源与计算资源,其主要构思分成两个回路:位置/姿态角控制回路与速度/角速度控制回路。在位置/姿态角控制回路中,根据给定同编队中的邻居信息与期望编队队形,将相对位置限制设计进障碍Lyapunov函数,利用反步法与障碍Lyapunov函数设计虚拟控制器,最终通过此虚拟控制器给出期望速度与期望角度。在速度/角速度控制回路中,根据上一个回路给出的期望速度与期望角速度,设计控制器跟踪该期望速度与期望角速度,形成两级级联控制,实现无人飞艇的编队控制的同时,在控制器的设计中利用自适应控制技术,设计自适应律消除执行器延迟带来的影响。控制器的输出可等比转换为无人飞艇的螺旋桨转速。
为了方便理解本发明方法中采用的各个函数,现将各个函数中使用的参数及其对应含义介绍如下:
ΡiΡi=[x,y,z,φ,θ,ψ]Τ为飞艇i的当前位置与当前姿态角,i=0时该飞艇i为领航飞艇,i=1,2,3,...时该飞艇i为跟随飞艇;
ΔΡi,jΔΡi,j=[Δxi,j,Δyi,j,Δzi,j,Δφi,j,Δθi,j,Δψi,j]Τ为期望编队队形,其中Δxi,j,Δyi,j,Δzi,j为与时间无关的期望队形,Δφi,j,Δθi,j,Δψi,j在飞艇编队控制中一般设为0;
ΘiΘi=[u,v,w,p,q,r]Τ为飞艇i的当前(实际)速度与当前(实际)姿态角速度,i=0时该飞艇i为领航飞艇,i=1,2,3,...时该飞艇i为跟随飞艇;
ξ 跟踪误差,包括轨迹跟踪误差ξP,i以及速度/角速度误差量ξΘ,i;
Kxx 控制参数;
τi 飞艇i的编队控制器输出量,可对应到六自由度电机推力与推力产生的力矩;
Ri R=diag{Rζ,Rγ}为坐标系转换相关矩阵,具体定义见下文;
Mi 飞艇受力分析相关矩阵,具体定义见下文;
Ni N=N1+N2+N3为飞艇受力分析相关矩阵,具体定义见下文;
t 当前时刻;
x 飞艇北向位置;
y 飞艇东向距离;
z 飞艇垂向位置,方向向下;
φ 飞艇滚转角;
θ 飞艇俯仰角;
ψ 飞艇偏航角;
u 飞艇前向速度,方向向前;
v 飞艇侧向速度,方向向右;
w 飞艇垂向速度,方向向下;
p 飞艇滚转角速度;
q 飞艇俯仰角速度;
r 飞艇偏航角速度;
▽ 飞艇体积;
ρ 大气密度;
xg,yg,zg 飞艇重心位置
Ix,Iy,Iz 飞艇转动惯量
Ixz 飞艇惯性积
k1,k2,k3 飞艇惯性因子
Bf 飞艇浮力;
m 飞艇质量;
g 重力加速度;
Fa,Ma 飞艇气动力与气动力矩。
本发明实施例提供的无人飞艇的示意图如图2所示,其中O为飞艇坐标系原点、CV为飞艇形心、CG为飞艇重心、BRF为飞艇坐标系、Og为地面坐标系原点、ERF为地面坐标系。
在本发明方法及***中使用的平流层飞艇(无人飞艇)编队成员模型为:
其中,i=1,2,…,n,n为平流层飞艇编队成员数;Ρi和Θi分别表示第i个平流层飞艇的位置和速度矢量;τi为对应的控制量,td为输入时延,di为所受干扰。
其中,
基于以上构思和参数含义解释,如图1所示,本发明提供的一种无人飞艇编队飞行控制方法具体包括:
步骤1:获取期望编队队形。
在步骤1中所述的给定期望编队队形为ΔΡi,j=[Δxi,j,Δyi,j,Δzi,j,Δφi,j,Δθi,j,Δψi,j]Τ,其中Δxi,j,Δyi,j,Δzi,j为与时间无关的期望队形,Δφi,j,Δθi,j,Δψi,j在飞艇编队控制中一般设为0。
步骤2:根据所述期望编队队形确定包含相对位置限制值的障碍李雅普诺夫Lyapunov函数;具体包括步骤201-202。
步骤201:根据所述期望编队队形计算轨迹跟踪误差;轨迹跟踪误差计算如下:
其中ξP,i为飞艇i的轨迹跟踪误差,Pi为被控飞艇编队成员i的位置信息,而Pj为飞艇i同编队中其他成员的位置信息(邻居信息),lij为权重系数,n为平流层飞艇编队成员数。
步骤202:根据所述轨迹跟踪误差确定包含相对位置限制值的所述障碍Lyapunov函数。
根据所述轨迹跟踪误差ξP,i设计包含相对位置限制值的障碍Lyapunov函数:
其中b为相对位置限制值组成的列向量,bk为该列向量的第k个元素。
步骤3:利用反步法和所述障碍Lyapunov函数设计虚拟控制器。
则虚拟控制器可设计为:
步骤4:对所述虚拟控制器进行解算,得到虚拟控制器输出量。
步骤4主要为虚拟速度控制器计算,用于计算消除期望位置与实际位置之间的误差所需虚拟控制器输出量所述虚拟控制器输出量包括消除所述无人飞艇的期望位置与实际位置之间的误差所需的期望速度与期望角速度。所述步骤4具体包括步骤401-404。
步骤401:根据所述轨迹跟踪误差确定测量误差。
测量误差计算如下:
eΡ,i(t)=Πi(t)-Πi(tk)。
步骤402:根据所述测量误差设计触发条件。
触发条件计算如下:
Ωi(t)=[Ωi,k(t)]T
步骤403:根据所述触发条件得到自触发控制器的触发时刻。
其中,
接下来结合触发条件可得
因此可得,
其中Θi、Θj分别表示飞艇i、j的速度矢量。l1和l2是正值中间量,T表示时间。
步骤404:在所述触发时刻对所述虚拟控制器进行解算,得到虚拟控制器输出量。
步骤5:根据所述虚拟控制器输出量计算自适应控制器输出量。
所述步骤5包括虚拟状态量生成与自适应控制器设计和计算,计算用来消除执行器延迟影响的自适应控制器输出量。具体包括步骤501-503。
步骤501:根据所述虚拟控制器输出量确定所述期望速度和期望角速度与所述实际速度和实际角速度之间的速度和角速度误差量。
为了避免在后面的运算中出现微分***的情况,利用指令滤波器的输出量来代替对虚拟控制器的输出值直接求导。
定义指令滤波器为:
本发明中,定义期望速度/角速度与当前速度/角速度的误差量为:
其中,ξΘ,i即为期望速度和期望角速度与实际(当前)速度和实际(当前)角速度之间的速度和角速度误差量。本发明中,符号“/”表示“和”。
步骤502:根据所述速度和角速度误差量生成虚拟状态量。
根据所述速度和角速度误差量ξΘ,i设计虚拟状态量为:
步骤503:根据所述虚拟状态量确定饱和补偿器输出量和所述自适应控制器输出量。
其中,ξΔτ,i为饱和补偿器输出量,为自适应控制器输出量。K5,K6,K2和K4均为控制参数。τi为编队控制器输出,是虚拟控制器输出τ0,i经饱和函数得到的,则Δτi为饱和误差量Δτi=τi-τ0,i。
其中饱和函数为:
步骤6:根据所述自适应控制器输出量,利用反步法设计编队控制器;具体包括:
根据所述速度和角速度误差量、所述饱和补偿器输出量以及所述自适应控制器输出量,利用反步法设计所述编队控制器。
步骤7:对所述编队控制器进行解算,得到编队控制器输出量。
所述步骤7主要包括编队控制器计算,用于计算消除期望速度/角速度与实际速度/角速度之间的误差所需的控制量τi。
定义测量误差:
基于上述测量误差,设计如下的事件触发函数:
当时,定义事件触发,飞艇i进行编队控制器的解算并输出编队控制器输出量τi,所述编队控制器输出量包括消除无人飞艇i的期望速度和期望角速度与实际速度和实际角速度之间的误差所需的控制量。此处的编队控制器输出量τi可等比转换为螺旋桨转速。
步骤8:根据所述编队控制器输出量控制所述无人飞艇的螺旋桨转速。
步骤7得到的编队控制器输出量τi可等比转换为螺旋桨转速。控制工程师在应用过程中可根据实际飞艇编队给定期望编队队形ΔPi,j,并将由本发明方法计算得到的编队控制器输出量τi直接传输至执行机构,实现对存在执行器延迟和相对位置受限的平流层飞艇的编队飞行控制。
本发明提供的一种无人飞艇编队飞行控制方法,考虑了执行器延迟、相对位置受限、带宽资源与计算资源,控制工程师可以按照本发明方法并结合实际参数实现存在执行器延迟问题和相对位置受限要求的无人飞艇编队飞行控制。本发明方法结合了自适应算法设计方法、事件驱动控制方法和反步控制理论。由本发明方法控制的闭环***是Lyapunov稳定的,并且所设计的事件驱动控制器可以有效节约带宽资源和计算资源。在此基础上,在平流层飞艇的编队飞行过程中,相对位置误差是被限制住的,执行器延迟的不利影响可以被消除,这就为存在执行器延迟问题和相对位置受限要求的无人飞艇编队飞行工程实现提供了有效的设计手段。
基于本发明提供的一种无人飞艇编队飞行控制方法,本发明还提供一种无人飞艇编队飞行控制***。如图3所示,所述***包括:
期望编队队形获取模块901,用于获取期望编队队形;
障碍Lyapunov函数确定模块902,用于根据所述期望编队队形确定包含相对位置限制值的障碍李雅普诺夫Lyapunov函数;
虚拟控制器确定模块903,用于利用反步法和所述障碍Lyapunov函数设计虚拟控制器;
虚拟控制器解算模块904,用于对所述虚拟控制器进行解算,得到虚拟控制器输出量;所述虚拟控制器输出量包括消除所述无人飞艇的期望位置与实际位置之间的误差所需的期望速度与期望角速度;
自适应控制器输出量计算模块905,用于根据所述虚拟控制器输出量计算自适应控制器输出量;
编队控制器确定模块906,用于根据所述自适应控制器输出量,利用反步法设计编队控制器;
编队控制器解算模块907,用于对所述编队控制器进行解算,得到编队控制器输出量;所述编队控制器输出量包括消除所述无人飞艇的期望速度和期望角速度与实际速度和实际角速度之间的误差所需的控制量;
编队飞行控制模块908,用于根据所述编队控制器输出量控制所述无人飞艇的螺旋桨转速。
其中,所述障碍Lyapunov函数确定模块902具体包括:
轨迹跟踪误差计算单元,用于根据所述期望编队队形计算轨迹跟踪误差;
障碍Lyapunov函数确定单元,用于根据所述轨迹跟踪误差确定包含相对位置限制值的所述障碍Lyapunov函数。
所述虚拟控制器解算模块904具体包括:
测量误差确定单元,用于根据所述轨迹跟踪误差确定测量误差;
触发条件确定单元,用于根据所述测量误差设计触发条件;
触发时刻确定单元,用于根据所述触发条件得到自触发控制器的触发时刻;
虚拟控制器解算单元,用于在所述触发时刻对所述虚拟控制器进行解算,得到虚拟控制器输出量。
所述自适应控制器输出量计算模块905具体包括:
速度和角速度误差量确定单元,用于根据所述虚拟控制器输出量确定所述期望速度和期望角速度与所述实际速度和实际角速度之间的速度和角速度误差量;
虚拟状态量生成单元,用于根据所述速度和角速度误差量生成虚拟状态量;
自适应控制器输出量确定单元,用于根据所述虚拟状态量确定饱和补偿器输出量和所述自适应控制器输出量。
所述编队控制器确定模块906具体包括:
编队控制器确定单元,用于根据所述速度和角速度误差量、所述饱和补偿器输出量以及所述自适应控制器输出量,利用反步法设计所述编队控制器。
本发明提供的一种无人飞艇编队飞行控制方法及***,考虑了执行器延迟、相对位置受限、带宽资源与计算资源,与现有技术比,其优点在于:
1、本发明方法及***能够实现平流层飞艇编队飞行的高精度和稳定控制。
2、本发明方法及***可以消除执行器延迟带来的影响,同时可以保证编队成员之间的相对位置保持在预定的范围内,不会出现相对位置偏离过大导致***性能下降的情境。
3、本发明方法及***通过设计自触发和事件触发机制,大大减少状态信息传输频次与控制器输出解算频次,大大节约了带宽资源与计算资源。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的***而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不应理解为对本发明的限制。
Claims (6)
1.一种无人飞艇编队飞行控制方法,其特征在于,包括:
获取期望编队队形;
根据所述期望编队队形确定包含相对位置限制值的障碍Lyapunov函数;
所述根据所述期望编队队形确定包含相对位置限制值的障碍Lyapunov函数,具体包括:
根据所述期望编队队形计算轨迹跟踪误差:
根据所述轨迹跟踪误差确定包含相对位置限制值的所述障碍Lyapunov函数:
利用反步法和所述障碍Lyapunov函数设计虚拟控制器;
对所述虚拟控制器进行解算,得到虚拟控制器输出量;所述虚拟控制器输出量包括消除所述无人飞艇的期望位置与实际位置之间的误差所需的期望速度与期望角速度;
根据所述虚拟控制器输出量计算自适应控制器输出量;
对所述编队控制器进行解算,得到编队控制器输出量;所述编队控制器输出量包括消除所述无人飞艇的期望速度和期望角速度与实际速度和实际角速度之间的误差所需的控制量;
根据所述编队控制器输出量控制所述无人飞艇的螺旋桨转速。
2.根据权利要求1所述的方法,其特征在于,所述对所述虚拟控制器进行解算,得到虚拟控制器输出量,具体包括:
根据所述轨迹跟踪误差确定测量误差;
根据所述测量误差设计触发条件;
根据所述触发条件得到自触发控制器的触发时刻;
在所述触发时刻对所述虚拟控制器进行解算,得到虚拟控制器输出量。
3.根据权利要求2所述的方法,其特征在于,所述根据所述虚拟控制器输出量计算自适应控制器输出量,具体包括:
根据所述虚拟控制器输出量确定所述期望速度和期望角速度与所述实际速度和实际角速度之间的速度和角速度误差量;
根据所述速度和角速度误差量生成虚拟状态量;
根据所述虚拟状态量确定饱和补偿器输出量和所述自适应控制器输出量。
4.一种无人飞艇编队飞行控制***,其特征在于,包括:
期望编队队形获取模块,用于获取期望编队队形;
障碍Lyapunov函数确定模块,用于根据所述期望编队队形确定包含相对位置限制值的障碍李雅普诺夫Lyapunov函数,具体包括:
根据所述期望编队队形计算轨迹跟踪误差:
根据所述轨迹跟踪误差确定包含相对位置限制值的所述障碍Lyapunov函数:
虚拟控制器确定模块,用于利用反步法和所述障碍Lyapunov函数设计虚拟控制器;
虚拟控制器解算模块,用于对所述虚拟控制器进行解算,得到虚拟控制器输出量;所述虚拟控制器输出量包括消除所述无人飞艇的期望位置与实际位置之间的误差所需的期望速度与期望角速度;
自适应控制器输出量计算模块,用于根据所述虚拟控制器输出量计算自适应控制器输出量;
编队控制器解算模块,用于对所述编队控制器进行解算,得到编队控制器输出量;所述编队控制器输出量包括消除所述无人飞艇的期望速度和期望角速度与实际速度和实际角速度之间的误差所需的控制量;
编队飞行控制模块,用于根据所述编队控制器输出量控制所述无人飞艇的螺旋桨转速。
5.根据权利要求4所述的***,其特征在于,所述虚拟控制器解算模块具体包括:
测量误差确定单元,用于根据所述轨迹跟踪误差确定测量误差;
触发条件确定单元,用于根据所述测量误差设计触发条件;
触发时刻确定单元,用于根据所述触发条件得到自触发控制器的触发时刻;
虚拟控制器解算单元,用于在所述触发时刻对所述虚拟控制器进行解算,得到虚拟控制器输出量。
6.根据权利要求5所述的***,其特征在于,所述自适应控制器输出量计算模块具体包括:
速度和角速度误差量确定单元,用于根据所述虚拟控制器输出量确定所述期望速度和期望角速度与所述实际速度和实际角速度之间的速度和角速度误差量;
虚拟状态量生成单元,用于根据所述速度和角速度误差量生成虚拟状态量;
自适应控制器输出量确定单元,用于根据所述虚拟状态量确定饱和补偿器输出量和所述自适应控制器输出量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110830757.3A CN113359861B (zh) | 2021-07-22 | 2021-07-22 | 一种无人飞艇编队飞行控制方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110830757.3A CN113359861B (zh) | 2021-07-22 | 2021-07-22 | 一种无人飞艇编队飞行控制方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113359861A CN113359861A (zh) | 2021-09-07 |
CN113359861B true CN113359861B (zh) | 2022-06-10 |
Family
ID=77540144
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110830757.3A Active CN113359861B (zh) | 2021-07-22 | 2021-07-22 | 一种无人飞艇编队飞行控制方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113359861B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115826416B (zh) * | 2023-02-20 | 2023-05-23 | 北京航空航天大学 | 一种网络拒止环境下多飞艇协同控制方法及其*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012021581A1 (en) * | 2010-08-10 | 2012-02-16 | IREL Solutions Group Ltd. | Airship |
CN105094144A (zh) * | 2015-09-02 | 2015-11-25 | 北京天航华创科技股份有限公司 | 一种无人飞艇自适应抗风路径跟踪控制方法 |
CN108897340A (zh) * | 2018-09-10 | 2018-11-27 | 北京航空航天大学 | 一种通信和计算约束下航天器编队飞行相对位置控制方法 |
CN109002058A (zh) * | 2018-09-10 | 2018-12-14 | 北京航空航天大学 | 基于事件触发的航天器编队飞行相对位置协同控制方法 |
CN113009930A (zh) * | 2021-03-05 | 2021-06-22 | 北京航空航天大学 | 一种无人飞艇编队飞行轨迹跟踪控制方法及*** |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8949090B2 (en) * | 2013-01-28 | 2015-02-03 | The Boeing Company | Formation flight control |
-
2021
- 2021-07-22 CN CN202110830757.3A patent/CN113359861B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012021581A1 (en) * | 2010-08-10 | 2012-02-16 | IREL Solutions Group Ltd. | Airship |
CN105094144A (zh) * | 2015-09-02 | 2015-11-25 | 北京天航华创科技股份有限公司 | 一种无人飞艇自适应抗风路径跟踪控制方法 |
CN108897340A (zh) * | 2018-09-10 | 2018-11-27 | 北京航空航天大学 | 一种通信和计算约束下航天器编队飞行相对位置控制方法 |
CN109002058A (zh) * | 2018-09-10 | 2018-12-14 | 北京航空航天大学 | 基于事件触发的航天器编队飞行相对位置协同控制方法 |
CN113009930A (zh) * | 2021-03-05 | 2021-06-22 | 北京航空航天大学 | 一种无人飞艇编队飞行轨迹跟踪控制方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN113359861A (zh) | 2021-09-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103488814B (zh) | 一种适用于再入飞行器姿态控制的闭环仿真*** | |
CN105159305B (zh) | 一种基于滑模变结构的四旋翼飞行控制方法 | |
Moutinho et al. | Airship robust path-tracking: A tutorial on airship modelling and gain-scheduling control design | |
Azinheira et al. | A backstepping controller for path‐tracking of an underactuated autonomous airship | |
CN107544262B (zh) | 一种运载火箭自适应精确回收控制方法 | |
CN108873929B (zh) | 一种固定翼飞机自主着舰方法及*** | |
CN111399531B (zh) | 高超声速飞行器滑翔段制导与姿态控制一体化设计方法 | |
Zuo et al. | Three-dimensional path-following backstepping control for an underactuated stratospheric airship | |
US20100314487A1 (en) | Predicting and correcting trajectories | |
CN108549785B (zh) | 一种基于三维飞行剖面的高超声速飞行器精准弹道快速预测方法 | |
CN111290426B (zh) | 一种航空器自动规避逃逸路径的预测控制方法 | |
Zheng et al. | Hovering control for a stratospheric airship in unknown wind | |
Zhou et al. | Station-keeping control of an underactuated stratospheric airship | |
CN113359861B (zh) | 一种无人飞艇编队飞行控制方法及*** | |
CN113009930B (zh) | 一种无人飞艇编队飞行轨迹跟踪控制方法及*** | |
CN107678442B (zh) | 一种基于双模型下的四旋翼自主着船控制方法 | |
Wang et al. | Path following of the autonomous airship with compensation of unknown wind and modeling uncertainties | |
CN107817818A (zh) | 一种模型不确定飞艇航迹跟踪有限时间控制方法 | |
CN111897219A (zh) | 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 | |
Yamasaki et al. | Advanced pure pursuit guidance via sliding mode approach for chase UAV | |
CN114265420B (zh) | 适于高动态、控制慢响应的制导控制一体化设计方法 | |
Wang et al. | Three dimensional path-following control of an under-actuated airship | |
Zhu et al. | Spatial adaptive integral LOS path following control for an under-actuated stratospheric airship | |
De Paiva et al. | Sliding mode control for the path following of an unmanned airship | |
Peng et al. | Flight control design with hierarchical dynamic inversion |
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 |