CN105629734B - 一种近空间飞行器的轨迹跟踪控制方法 - Google Patents
一种近空间飞行器的轨迹跟踪控制方法 Download PDFInfo
- Publication number
- CN105629734B CN105629734B CN201610084472.9A CN201610084472A CN105629734B CN 105629734 B CN105629734 B CN 105629734B CN 201610084472 A CN201610084472 A CN 201610084472A CN 105629734 B CN105629734 B CN 105629734B
- Authority
- CN
- China
- Prior art keywords
- angle
- flight
- formula
- instruction
- design
- 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 52
- 238000013461 design Methods 0.000 claims abstract description 57
- 230000003044 adaptive effect Effects 0.000 claims abstract description 30
- 239000002131 composite material Substances 0.000 claims description 17
- 239000011159 matrix material Substances 0.000 claims description 15
- 230000008901 benefit Effects 0.000 claims description 7
- 238000012545 processing Methods 0.000 claims description 7
- 238000005096 rolling process Methods 0.000 claims description 7
- 238000001914 filtration Methods 0.000 claims description 5
- 238000013016 damping Methods 0.000 claims description 3
- 238000011217 control strategy Methods 0.000 abstract description 3
- 238000012795 verification Methods 0.000 abstract description 2
- PXFBZOLANLWPMH-UHFFFAOYSA-N 16-Epiaffinine Natural products C1C(C2=CC=CC=C2N2)=C2C(=O)CC2C(=CC)CN(C)C1C2CO PXFBZOLANLWPMH-UHFFFAOYSA-N 0.000 description 13
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 8
- 238000009795 derivation Methods 0.000 description 8
- 238000004088 simulation Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 238000004458 analytical method Methods 0.000 description 4
- 230000000875 corresponding effect Effects 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000009897 systematic effect Effects 0.000 description 3
- 238000012938 design process Methods 0.000 description 2
- 238000005211 surface analysis Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 241000272517 Anseriformes Species 0.000 description 1
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000008602 contraction Effects 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 230000002596 correlated effect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000005183 dynamical system Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 210000001258 synovial membrane Anatomy 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Evolutionary Computation (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提供一种针对巡航飞行阶段的近空间飞行器NSV(Near Space Vehicle)六自由度十二状态模型,设计一种鲁棒自适应轨迹跟踪控制策略。首先,提出一种全新的动态模型近似方法应用于航迹控制器的设计。其次,利用自适应技术设计一种独立于控制器的干扰估计器。然后,采用动态逆和backstepping方法相结合,分别给出位置、姿态角和角速率控制器的设计方法。其中,应用指令滤波器来避免backstepping设计中微分膨胀问题,并通过补偿项修正由立项指令不能被完全执行所引起的跟踪误差,构造鲁棒项抑制干扰估计误差对轨迹跟踪的影响。下面结合具体的实施例对本发明的上述方法进行详细说明。
Description
技术领域
本发明涉及自动控制技术领域,具体涉及一种六自由度十二状态近空间飞行器的鲁棒自适应轨迹跟踪控制方法。
背景技术
近空间飞行器(Near Space Vehicle,NSV)具备战略、战术以及效费比等方面的优势,且已经成为21世纪世界航空航天领域一个极其重要的发展方向。目前,NSV的研究已经从概念和原理探索阶段进入以高超声速巡航弹、高超声速飞机、跨大气层飞行器和空天飞机等为应用背景的先期技术开发验证阶段。
众所周知,NSV作为一个新型的飞行器,有着诱人的应用前景。当然动态系统非线性、强耦合、参数快时变给控制带来了新的挑战。由于NSV高速飞行中,位置、空速、航姿和飞行环境之间存在着强耦合特性,航迹角和侧滑角对位置和姿态均有影响,如果将此忽略,这势必会影响飞控系统的跟踪性能,甚至可能破坏NSV的稳定性。因此在NSV飞控系统设计中,考虑航迹和侧滑对飞控系统的影响尤为重要。
发明内容
本发明要解决的技术问题是现有技术中缺乏对NSV的系统研究,对其进行轨迹跟踪时误差较大、稳定性较差。
为解决上述技术问题,本发明提供如下技术方案:
本发明提供一种近空间飞行器的轨迹跟踪控制方法,包括:
步骤1.建立近空间飞行器巡航飞行阶段的六自由度十二状态非线性模型;
步骤2.利用在线模型近似方法将所述航迹角回路模型的做近似处理;
步骤3.利用自适应干扰估计算法,获取复合干扰估计值;
步骤4.设计飞行控制器,本步骤与所述步骤3中的自适应干扰估计算法相互独立。
优选地,上述的近空间飞行器的轨迹跟踪控制方法,所述步骤1中的近空间飞行器巡航飞行阶段的六自由度十二状态非线性模型包括:
位置回路模型:
空速模型:
航迹角回路模型:
姿态角回路模型:
角速率回路模型:
优选地,上述的近空间飞行器的轨迹跟踪控制方法,步骤2中,利用在线模型近似方法将所述航迹角回路模型的做近似处理,将所述航迹角回路模型近似为:
优选地,上述的近空间飞行器的轨迹跟踪控制方法,步骤3中利用自适应干扰估计算法,获取的复合干扰估计值包括:
空速模型中的复合干扰估计值:
航迹角回路模型、姿态角回路模型和角速度回路模型中的复合干扰估计值
优选地,上述的近空间飞行器的轨迹跟踪控制方法,所述步骤4中.设计飞行控制器,其包括:
位置控制器:
空速控制器:
航迹控制器:
姿态角控制器:
角速率控制器:
本发明的上述技术方案与现有技术相比,至少具有以下有益效果:
本发明所述的近空间飞行器的轨迹跟踪控制方法,步骤2中利用在线模型近似方法将所述航迹角回路模型的做近似处理,将非仿射非线性系统变成一个全局的时变仿射模型,其可以很好的完成航迹角回路模型的全局逼近,能够很好地利用仿射非线性控制器的设计方法,以解决非仿射非线性系统的跟踪控制器设计问题。并且步骤3中的自适应干扰估计方法采用的自适应律与估计误差有关,而非状态或预测误差,所提出的自适应律具有两个优势,一是在系统跟踪误差有界时,仍可以保证干扰估计是准确的;二是与传统的自适应律比较,它具有设计简单、易于实现的优势。
附图说明
为了使本发明的内容更容易被清楚的理解,下面根据本发明的具体实施例并结合附图,对本发明作进一步详细的说明,其中
图1使本发明实施例所述的近空间飞行器的轨迹跟踪控制方法的方法流程图;
图2是本发明实施例所研究的NSV外形结构图、气动布局和坐标系示意图;
图3是本发明实施例所述飞行器巡航飞行的NSV控制系统原理框图;
图4是本发明实施例所述带有幅值和速率限制的指令滤波器原理框图;
图5是本发明实施例所述x,y,z坐标轴的位置跟踪轨迹仿真结果;
图6是本发明实施例所述空速和航迹的跟踪曲线的仿真结果;
图7是是本发明实施例所述姿态角和角速率的跟踪曲线仿真结果及其放大图;
图8是本发明实施例所述气动控制舵面和推力响应曲线仿真结果。
其中的附图标记为:
1-水平鸭翼,2-参考力矩中心/焦点,3-右升降副翼,4-方向舵,5-左升降副翼。
具体实施方式
本发明针对巡航飞行阶段的近空间飞行器NSV(Near Space Vehicle)六自由度十二状态模型,设计一种鲁棒自适应轨迹跟踪控制策略。首先,提出一种全新的动态模型近似方法应用于航迹控制器的设计。其次,利用自适应技术设计一种独立于控制器的干扰估计器。然后,采用动态逆和backstepping方法相结合,分别给出位置、姿态角和角速率控制器的设计方法。其中,应用指令滤波器来避免backstepping设计中微分膨胀问题,并通过补偿项修正由立项指令不能被完全执行所引起的跟踪误差,构造鲁棒项抑制干扰估计误差对轨迹跟踪的影响。下面结合具体的实施例对本发明的上述方法进行详细说明。
本实施例提供一种近空间飞行器的轨迹跟踪控制方法,如图1所示,包括如下步骤:
步骤1.建立近空间飞行器巡航飞行阶段的六自由度十二状态非线性模型;
步骤2.利用在线模型近似方法将所述航迹角回路模型的做近似处理;
步骤3.利用自适应干扰估计算法,获取复合干扰估计值;
步骤4.设计飞行控制器,本步骤与所述步骤3中的自适应干扰估计算法相互独立。
下面对每一步骤进行详细说明。
步骤1:建立近空间飞行器巡航飞行阶段的六自由度十二状态非线性模型。
本实施例所研究的NSV外形结构如图1所示。图中Ogxgygzg和Obxbybzb分别为地面坐标系和机体坐标系。其巡航分型阶段的六自由度十二状态非线性模型可以描述为式(1)至式(4):
上式中各个符号对应的含义分别为:
P=[x,y,z]T,(x,y,z)为飞行器在地面坐标系中的坐标,Pa=[γ,χ]T,γ为飞行器的航迹倾斜角,χ为飞行器的航迹方位角,Ω=[α,β,μ]T,α为飞行器的攻角,β为飞行器的侧滑角,μ为飞行器的滚转角,ω=[p,q,r]T,p为滚转角速率,q为俯仰角速率,r为偏航角速率,Iaero、maero和nnero分别为气动舵面为零时飞行器所受的气动滚转力矩、气动俯仰力矩和气动偏航力矩,T为发动机推力,M和g分别为质量和重力加速度,Ixx、Iyy和Izz分别为绕机体轴x、y和z的转动惯量,M=[lctrl,mctrl,nctrl],lctrl、mctrl和nctrl分别为滚转、俯仰和偏航方向上的控制力矩,L、Y和D分别为升力、侧向力和阻力,并且能够近似表示为:
上式中各个符号对应的含义分别为:
为动压且S为飞行器的气动参考面积,δe为左升降副翼舵偏转角,δα为右升降副翼舵偏转角,δr为方向舵偏转角,CL,α、等为气动参数,具体地可以通过文献:“都延丽.近空间飞行器姿态与轨迹的非线性自适应控制研究[D],南京航空航天大学,2010年”进行了解参数定义。在NSV飞行过程中,CL,α等气动参数存在不确定性及易受外部干扰的影响,所以 其中,和分别表示L,D,Y的标称值,和分别表示L,D,Y的未知受扰值。
基于以上分析,在内外环信号的层递关系下,根据时标分离原则和带宽不同,可以将式(1)至式(4)改写为:
上式中,dv、dΩ和dω均为对应回路的复合干扰,包括气动变化和参数摄动引起的不确定。
上式中,式(5)被称为NSV的外回路或位置回路,式(6)、式(7)和式(8)被称为NSV的内回路(包括空速和航迹角回路、姿态角回路和角速率回路)。飞行器控制系统的设计目的是在考虑复合干扰的情况下,根据位置指令Pc设计合适的推力指令和气动舵偏角指令,使得P渐近跟踪Pc。对于控制系统的设计包括控制器和舵面分配两个实现过程。本发明主要是针对控制器设计的。为了使本发明的发明要点及实现过程能够更清晰的被理解,给出控制系统的基本原理图,如图3所示。图3分为5部分:1)位置控制器设计;2)空速和航迹控制器设计;3)姿态角控制器设计;4)角速度控制器设计;5)在1)-4)控制计算下,通过控制分配得到NSV推力和气动舵面偏转角指令,完成NSV飞行任务。
步骤2.利用在线模型近似方法将所述航迹角回路模型的做近似处理。
针对NSV模型中的非仿射非线性航迹运动方程,即式(6)中的第二个方程,本实施例中提出一种在线的模型近似方法,考虑非仿射非线性系统:
式中,为可测的系统状态,Ωx为系统可行域,为系统的控制输入,Ωu为允许控制集,f(·,·)在域Ωx×Ωu为C∞类函数。
假设1在域Ωu内连续,且存在常数使得
有:
值得注意的是,假设1意味着系统式(9)具有“良好定义的相对阶”。在实际很多系统中,假设1均成立,如Chua’s电路和Rssler混沌等系统中。因此该假设有一定适用性。
引理1对非仿射非线性系统式(9),考虑时变的仿射非线性系统和一阶滤波器:
式中:
ξj(1≤j≤m)取值在之间,为一阶滤波器的状态,为设计的滤波时间矩阵。
在假设1下,非仿射非线性系统式(9)可由时变的仿射非线性系统式(11)近似,且O
(·)在域Ωx内满足局部Lipschitz条件(利普希茨连续条件),即使得:
下面对上述近似方法的准确性进行论证,证明过程如下:
将式(9)中f(x,u)在处进行Taylor展开,则式(11)可改写为:
将带入式(14)可得式(11)。
下面证明O(·)在域Ωx内满足局部Lipschitz条件。
根据文献Nonliner systems[M](第三版,Prentice Hall,2002年出版)的B3.1引理可知:若式(9)满足假设1条件,则f在Ωx×Ωu上满足Lipschitz条件,即存在常数L1,使得:
根据式(9)和式(11),代入式(10)和式(15),可得
式中:
基于式(16),若采用式(11)在线准确地近似式(9),即式(11)中O(·)看做式(9)的建模误差,必须要保证尽可能的小。因此选取式(12)中的滤波时间矩阵使得进而保证证毕。
需要注意的是,采用式(12)的目的本质上使获取u前一时刻取值。因此,一阶滤波器式(12)可由其他的滤波器所代替,如二阶线性滤波器,鲁棒二阶滑模积分滤波器等。另外,从引理1可知,所提出的近似方法将非仿射非线性系统变成一个全局的时变放射模型,其可以很好地利用仿射非线性控制器的设计方法,以解决非仿射非线性系统式(9)的跟踪控制器设计问题。为了方便后续讨论,在不引起歧义的情况下,省略相关变量的自变量,如f1(x)写成f1。
步骤3.利用自适应干扰估计算法,获取复合干扰估计值。
本实施例还提供一种自适应干扰估计算法,针对飞行器存在符合干扰的问题,许多研究学者曾经致力于其干扰估计算法研究,如模糊系统、神经网络和滑膜干扰重构等方法,但是这些方法均可能存在由控制误差引发干扰估计的继续更新,而导致系统跟踪效果变差,甚至引发系统失稳。
鉴于此,本实施例给出一种依赖于干扰估计误差的自适应干扰估计算法(Adaptive Disturbance Approximation Algorithm,ADAA),值得注意的是,本实施例所提出的ADAA是独立于控制器的设计过程。
现作出如下合理的假设:
假设2系统式(5)-式(8)的所有状态P、V、Pa、Ω和ω是可测量的。
假设3对于式(6)-式(8)的复合干扰|dv|和||di||,i=pa,Ω,ω,存在未知的正数ρi,i=pa,v,Ω,ω,使得:
||dΩ||≤ρΩδΩ(Ω),||dω||≤ρωδω(ω)
式中:δi(·),i=pa,v,Ω,ω为已知的非负光滑函数。由式(2)-式(4)易知复合干扰是关于NSV状态变量和气动参数的函数。在实际飞行中,状态变量和气动参数都不可能是无穷量,它们的取值会在一定的范围内。因而假设3是完全合理的。
在假设2和假设3下,根据式(6)-式(8),设计辅助状态预测器为:
式中,zva和zia为辅助状态,Ava>0和Aia>0为设计的正常数和适当维数正定矩阵,和为符合干扰的估计值,
ψv、和ψi为下面滤波器的输出:
式中:I2×2,I3×3均为对角单位阵。
定义和i=pa,Ω,ω分别为各个回路的复合干扰估计误差;evd=v-zv,eΩd=Ω-zΩa,eωd=ω-zωa为各自的预测误差。则有:
定义和结合式(19)和式(20),可得和选取干扰估计自适应律为:
式中Γva>0和分别为设计正常数和正定矩阵。
由式(21)可得干扰估计值和为:
式中和为干扰估计的初值,下面定理说明在式(21)下,和是有界的。
定理1针对不确定NSV系统式(6)-式(8),在假设2和3下,选取标量Qva∈R、矩阵Qia∈R3×3,i=Ω,ω和Lyapunov函数满足:
同时定义γia=Γia、γia=λmin(Γia),i=pa,Ω,ω,激发因子
和如下的收缩因子
则干扰估计误差和在估计算法式(21)作用下单调非增,且当t≥t0时,Lyapunov函数满足
下面对上述符合干扰的自适应干扰估计算法的准确性进行验证,证明过程如下:
当i=pa,Ω,ω时,根据式(21)和对求导可以得到:
此外:
对于i=pa,Ω,ω,整理式(24)可得定理1结论成立。当i=v时,证明过程与上述类似,在此不再累输。证毕。
需要说明的是,自适应律式(21)是与估计误差有关,而非状态或预测误差。由此,这里提出的自适应律具有两个优势:
1)在系统跟踪误差有界时,仍可以保证干扰估计是准确的。
2)与传统的自适应律比较,它具有设计简单,易于实现等优势。
由定理1可知,在自适应律式(21)下,可以保证干扰估计误差和是有界的,但并不能保证其上界任意的小,为此在控制器设计中需采用鲁棒项减弱估计误差和对控制效果的影响。
步骤4.设计飞行控制器。
为实现飞行器跟踪预定轨迹,需设计NSV的位置、空速、航迹角、姿态角和角速率控制器,且要有如下假设:
假设4位置信号P(t)和期望轨迹Pc(t)关于时间连续可微且有界的,且矩阵gΩ、gω非奇异。
考虑飞行状态存在幅值和速率受限问题,本文采用的指令滤波器获取中间指令的期望值及其微分信号。具体的指令滤波器如图4所示。图4中的幅值限制器和速率限制器保证了指令滤波器的输出在所定义的限制范围内。ξ和ωn分别为指令滤波器的阻尼和贷款。xd为理想指令,xc为实际指令,xd为实际指令的微分信号。详细的指令滤波器的分析,可以通过文献:“Nonlinear flight control design using constrained adaptivebackstepping”Journal of Guidance,Control and Dynamics,2007,30(2):322–336中进行了解。
首先,对位置控制器设计进行说明:
位置控制器(外环控制器)的设计思路为首先采用动态逆方法给出有关空速、航迹角理想指令的非线性函数;然后利用式(1)解算空速、航迹角理想指令,最后通过图4给出的指令滤波器得到合理的空速、航迹角实际指令。
定义位置跟踪误差对其求导,并代入式(5)可得:
在假设2下,理想的可以设计为:
式中:Kp>0为设计的正定矩阵,Vd为理想的空速指令,γd,χd分别为理想的航迹倾斜角和理想的航迹方位角指令。
下面由结算Vd和基于式(1),有:
在NSV安全飞行中,通常V>0及-90°≤γ≤90°(实际中,航迹倾斜角的变化远远小于这个范围)。因此,通过式(27)可解算出γd=-arcsin(fzd/Vd),χd=arctan2(fyd,fxd)。
在考虑空速、航迹倾斜角、航迹方位角的幅值、速率及带宽限制的约束下,将结算的Vd、γd和χd经过图4所示的各自指令滤波器得到实际的空速指令Vc、实际的航迹倾斜角指令γc和实际的航迹方位角指令χc及各自的微分信号。记实际的航迹角指令为
为分析Vd、γd和χd的指令滤波器引起的误差对位置的影响,引入位置辅助滤波器为:
式中zp为位置辅助滤波器的状态。
定义修正的位置误差为对其求导,并代入式(25)和式(28)得到:
显然,在式(26)下,可以保证ep渐近收敛。因此,下面需要设计慢回路中的空速和航迹角控制器使得V和Pa跟踪Vd和的滤波值,即Vc和
空速和航迹角控制器需要考虑以下三个方面:
1)NSV的空速变化较慢,且主要受发动机推力所影响;
2)航迹角的变化主要由姿态角所引起;
3)期望侧滑角保持为0°,以保证NSV高速飞行安全。
因此,选择推力作为空速的控制量,选择姿态角中的攻角,滚转角作为航迹角的控制量。
根据式(2)中的第一个子式,则式(6)的第一个方程具体为:
式中:gv=cosβcosα/M。
由于α和β安全变化范围为[-5°,10°]和[-5°,5°],所以gv≠0。由此,选择推力为T和空速的鲁棒控制器rv为:
rv=-λvev (32)
式中,kv、λv>0为设计参数,ev=V-Vc为空速误差,为经空速ADAA式(22)得到的dv的估计值。
根据式(2)的后两个子式,利用引理1对航迹角的运动方程式(6)近似,可得:
式中:是以Ω′=[α,μ]T为式(12)的输入得到的滤波值;动态建模误差,记c(·)=cos(·),s(·)=sin(·),则为:
定义跟踪误差对其求导,并代入式(33)可得:
式(34)存在动态建模误差项而且,根据引理1容易得到:
使得因此,为保证航迹角的跟踪精度,在其控制器设计中必须考虑抑制另外,采用航迹角的ADAA对式(33)中的进行估计,同时设计鲁棒控制器减少干扰估计误差的影响。基于以上分析,考虑α和μ受限时,在设计1下,设计理想的攻角指令αd、理想的滚转角指令μd、航迹角的鲁棒控制器及其辅助滤波器为:
其中
式中:Ω′d=[αd,μd]T,为设计参数,分别为设计的正定矩阵和正常数;为设计的非线性阻尼项;为的估计值;z′Ω=[zα,zμ]T为zΩ中两个分量,zΩ在式(44)中定义;为修正的航迹角误差;为航迹角辅助滤波器的状态;Ω′c=[αc,μc]T,αc和μc将在后续设计中定义。
针对Ω′存在着幅值、速率和带宽限制的问题,这里采用图2所示对Ω′d进行滤波,得到实际的攻角指令αc、实际的滚转角指令μc及各自的微分信号。并将Ω′c作为NSV姿态的跟踪目标。
为姿态角控制器设计时消除Ω′c-Ωc的误差影响,扩张和式(33)中的为:
最后,对姿态角控制器设计进行说明。这里需要强调的是从式(7)可以0出NSV姿态角之间存在着强耦合性。此外,由航迹角分析得出应将侧滑角为0°作为姿态控制目标之一。因此,选取Ωc=[αc,βc,μc]T为姿态跟踪信号。其中,βc=0。
定义姿态角误差
对求导,并代入式(7)可得:
在假设4下,选择理想的角速度指令ωd及姿态角的鲁棒控制器rΩ为:
rΩ=-τΩeΩ (43)
式中:ωd=[pd,qd,rd]T,pd,qd,rd分别为理想的滚转、俯仰和偏航角速率,KΩ,τΩ>0分别为设计正定的参数矩阵和正常数,为由姿态角的ADAA得到的dΩ估计值;eΩ将在式(44)中定义。
同样在考虑ω的幅值,速率及带宽限制的约束下,采用图4对ωd进行滤波,得到实际的滚转角速率指令pc、实际的俯仰速率指令qc、实际的俯偏航速率指令rc及各自的微分信号。
下面分析姿态角指令滤波器对姿态角的误差,以避免其对式(8)设计控制力矩的影响。定义修正的姿态角误差为并引入姿态角辅助滤波器为:
式中,zΩ=[zα,zβ,zμ]T为辅助滤波器的状态。
下面对角速率控制器设计进行说明。角速率跟踪控制目标是实现ω跟踪角速率指令ωc=[pc,qc,rc]T。控制输入为控制力矩M。
定义角速率误差eω=ω-ωc,对其求导,并代入式(8)可得:
在假设4下,为实现eω有界和抑制设计控制力矩M和角速率的鲁棒控制器rω为:
rω=-λωeω (47)
式中:Kω、λω>0分别为设计正定的参数矩阵、正常数,为经角速率ADAA式(22)得到的dω的干扰估计值。
综上所述,NSV轨迹控制系统中的T和M均给出了设计过程。
需要注意的是,上述设计给出所需的M,而NSV的作动器需舵面偏转角指令,因此,在考虑动作器动态及其存在幅值、速率受限时,可以利用本申请发明人前期的研究成果进行在线控制分配,具体算法见张强,吴庆宪,姜长生,王玉惠.近空间飞行器鲁棒自适应backstepping控制[J].控制理论与应用,2012,29(10):1263-1271。
下面分析闭环NSV系统的稳定性。
首先,定义λmin(·)代表对应矩阵的最小特征值。
定理2针对六自由度十二状态NSV模型式(1)-式(4),在满足假设1-3下,在采用位置控制器式(26)、推力控制器式(31)、航迹控制器式(35)、姿态角控制器式(42)和角速率控制器式(46)、且干扰估计分别对应ADAA式(22)的下标所示,鲁棒控制器分别如式(32)、式(36)、式(43)、和式(47)所示,辅助滤波器分别如式(37)和式(44)所示,则NSV闭环系统具有如下性质;
1)ep∈L∞∩L2,而且指数收敛于0;
2)ev,eΩ,eω在[t0,t)内均是关于eD输入状态实际稳定,即存在类函数,κ∞类函数v1、v2、v2、类函数使得当:
成立,其中
证明过程如下:
关于性质(1)的证明,取位置的Lyapunov函数为Vp=(1/2)||ep||2。对其求导,并代入式(29),有由文献Nonliner systems[M](第三版,Prentice Hall,2002年出版)中的定理4.10可知,式(29)的原点是全局指数稳定的。此外对两边同时积分可得,ep∈L2。
关于性质(2)的证明,ev,eΩ,eω的动态方程如下:
1)由式(30)-式(32),有:
2)由式(34)-式(37),有:
式中e′Ω=[eα,eμ]T。
3)由式(40)-式(44),有:
4)由式(45)-式(47),有
选取Lyapunov函数为:
沿着式(50)至式(53)对V求导,并代入式(32)、式(36)、式(43)、式(47)和式(38)利用young不等式和定理1,可得:
式中:τ=min{λs,
λΩ,λω}。
由定理1可知,一定存在常数δv>0,δΩ>0,δω>0使得 因此由式(55)和文献Nonliner systems[M](第三版,Prentice Hall,2002年出版)中的定理4.19可知,性质2成立。
为了验证所提控制策略的有效性,针对六自由度十二状态NSV模型式(1)-式(4),并将专利文献CN101937233A中提供的气动力和力矩系数标称值均摄动30%,进行飞控系统的仿真。其他仿真初始条件为:M=136080Kg,初始地面的坐标为[900,900,-300000]m,初始新航速度V=2800m/s,初始航迹角为γ=χ=0°;推力为T=200KN,初始姿态角和角速率分别为α0=1.0°,β0=0.0°,μ0=-0.2°,p0=q0=r0=0deg/s。
假设NSV预定轨迹如下:
zc=-3.0×1040<t≤250
式中,xc,yc,zc的度量单位均为米。
为克服符合干扰(气动力和力矩系数的不确定)的影响,空速、航迹、姿态角和角速率的ADAA参数分别为:Ava=1,Γva=0.5,AΩa=3I3×3,ΓΩa=0.3I3×3,Aωa=5I3×3,Γωa=diag{0.2,0.3,0.2}。
位置、空速、航迹角、姿态角和角速率的控制器及其鲁棒控制器参数为Kp=diag
{0.01,0.1,0.5},KΩ=2I2×2,Kω=4I2×2,rω=0.5,rΩ=1,rω=1.5。
带有幅值和速率受限的滤波器的参数如表1所示,由此得到的仿真结果如图5-8所示。
表1-指令滤波器参数表
图5的仿真结果说明即使在NSV的气动力和力矩系数摄动20%后,利用本发明的控制方法仍然很好地实现NSV跟踪期望的轨迹。从图6的仿真结果可以看出,利用在线复合干扰估计、补偿以及基于受限指令滤波的控制器,飞行器的空速和航迹角能在很短时间内收敛于实际的指令值,并且没有超调现象,调节时间较短。从图7可知,姿态角和角速率能快速打到对实际的指令精准跟踪的要求。从图8可知,推力和气动舵偏角满足实际NSV的物理要求。
本发明的上述实施例中,针对六自由度十二状态NSV非线性鲁棒自适应飞控系统的设计,针对NSV模型中存在着非仿射非线性描述的航迹模型,提出一种时变的仿射非线性系统近似航迹模型近似描述航迹运动的过程,采用动态逆和backstepping方法,并结合指令滤波器设计了外环(位置)和内环(空速、航迹角、姿态角、角速率)控制器,实现了NSV再不确定参数存在情况下的鲁棒轨迹跟踪控制。该方法不仅避免了backstepping设计中的微分膨胀问题,而且在考虑NSV状态幅值和速率约束下,保证了闭环NSV系统的稳定性。仿真结果表明该控制方案能够确保NSV拥有稳定的飞行特性,良好的控制性能及强鲁棒性能。
显然,上述实施例仅仅是为清楚地说明所作的举例,而并非对实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。而由此所引伸出的显而易见的变化或变动仍处于本发明创造的保护范围之中。
Claims (4)
1.一种近空间飞行器的轨迹跟踪控制方法,其特征在于,包括:
步骤1.建立近空间飞行器巡航飞行阶段的六自由度十二状态非线性模型;其包括:
位置回路模型:其中:
fp(V,Pa)=[Vcosγcosχ,Vcosγsinχ,-Vsinγ]T;
空速模型:其中:
航迹角回路模型:其中:
L、Y和D分别为升力、侧向力和阻力;
姿态角回路模型:其中:
角速率回路模型:其中:
diag(·)代表对角矩阵;Ixx、Iyy和Izz分别为绕机体轴x、y和z的转动惯量;Iaero、maero和naero分别为气动舵面为零时飞行器所受的气动滚转力矩、气动俯仰力矩和气动偏航力矩;
上式中的各变量表示的含义如下:
P为飞行器空间位置,P=[x,y,z]T,(x,y,z)为飞行器在地面坐标系中的坐标,Pa=[γ,χ]T,γ为飞行器的航迹倾斜角,χ为飞行器的航迹方位角,Ω=[α,β,μ]T,α为飞行器的攻角,β为飞行器的侧滑角,μ为飞行器的滚转角,V为空速,ω=[p,q,r]T,p为期望滚转角速率,q为期望俯仰角速率,r为期望偏航角速率,M=[lctrl,mctrl,nctrl],lctrl、mctrl和nctrl分别为滚转、俯仰和偏航方向上的控制力矩,T为发动机推力,dv、dΩ和dω均为对应回路的复合干扰,其包括由气动变化和参数摄动引起的不确定;
步骤2.利用在线模型近似方法将所述航迹角回路模型的做近似处理;
步骤3.利用自适应干扰估计算法,获取复合干扰估计值;
步骤4.设计飞行控制器,本步骤与所述步骤3中的自适应干扰估计算法相互独立。
2.根据权利要求1所述的近空间飞行器的轨迹跟踪控制方法,其特征在于,步骤2中,利用在线模型近似方法将所述航迹角回路模型的做近似处理,将所述航迹角回路模型近似为:
是以Ω′=[α,μ]T为式的输入得到的滤波值,其中,为一阶滤波器的状态,为设计的滤波时间矩阵;动态建模误差,
以上,
c(μ1)=cos(μ1),c(α1)=cos(α1),s(α1)=sin(α1),s(β)=sin(β),s(μ1)=sin(μ1),c(β)=cos(β),c(γ)=cos(γ)。
3.根据权利要求2所述的近空间飞行器的轨迹跟踪控制方法,其特征在于,步骤3中利用自适应干扰估计算法,获取的复合干扰估计值包括:
空速模型中的复合干扰估计值:
航迹角回路模型、姿态角回路模型和角速度回路模型中的复合干扰估计值
和为干扰估计值的初始值。
4.根据权利要求3所述的近空间飞行器的轨迹跟踪控制方法,其特征在于,所述步骤4中设计飞行控制器,其包括:
位置控制器:
空速控制器:
航迹控制器:
姿态角控制器:
角速率控制器:
Vd为期望的空速指令,γd和χd为期望的航迹倾斜角指令和期望的航迹方位角指令,Kp为设计的正定矩阵,为位置跟踪误差,P为飞行器空间位置,Pc为实际位置控制指令,为位置控制指令导数;T为推力,kv>0为设计参数,ev为空速误差,为dv的估计值,rv为空速的鲁棒控制器;Ωd′=[αd,μd]T,αd和μd分别为期望的攻角指令和期望的滚转角指令,为航迹修正跟踪误差,为设计参数, 为设计的非线性阻尼项,为航迹跟踪误差,为航迹控制指令导数,为的估计值;为航迹角的鲁棒控制器,z′Ω=[zα,zμ]T为zΩ中两个分量,zΩ为姿态角辅助滤波器的状态;ωd=[pd,qd,rd]T为期望的角速度指令,p为期望滚转角速率,q为期望俯仰角速率,r为期望偏航角速率,KΩ>0为设计的正定矩阵,为姿态角跟踪误差,为dΩ的估计值,Ωc=[αc,βc,μc]T为实际的姿态跟踪指令信号,为姿态角实际指令导数,rΩ为姿态角的鲁棒控制器,为修正的航迹角误差,为航迹角辅助滤波器的状态;M=[lctrl,mctrl,nctrl],lctrl、mctrl和nctrl分别为滚转、俯仰和偏航方向上的控制力矩,Kω为设计的正定矩阵,eω=ω-ωc为角速率误差,为dω的干扰估计值,为角速度实际指令导数,rω为角速率的鲁棒控制器,pd,qd,rd分别为理想的滚转、俯仰和偏航角速率,αc为实际的攻角指令、μc为实际的滚转角指令,βc=0。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610084472.9A CN105629734B (zh) | 2016-02-14 | 2016-02-14 | 一种近空间飞行器的轨迹跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610084472.9A CN105629734B (zh) | 2016-02-14 | 2016-02-14 | 一种近空间飞行器的轨迹跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105629734A CN105629734A (zh) | 2016-06-01 |
CN105629734B true CN105629734B (zh) | 2019-02-12 |
Family
ID=56044803
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610084472.9A Active CN105629734B (zh) | 2016-02-14 | 2016-02-14 | 一种近空间飞行器的轨迹跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105629734B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106325816B (zh) * | 2016-11-09 | 2018-12-25 | 烟台中飞海装科技有限公司 | 一种微分信号的提取方法及微分器 |
CN106843256B (zh) * | 2017-03-30 | 2020-08-07 | 上海航天控制技术研究所 | 一种采用位置速度双回路的卫星控制方法 |
CN108459611B (zh) * | 2018-05-21 | 2021-08-17 | 济南大学 | 一种近空间飞行器的姿态跟踪控制方法 |
CN108681331A (zh) * | 2018-05-21 | 2018-10-19 | 济南大学 | 一种近空间飞行器的姿态跟踪控制方法 |
CN109324503B (zh) * | 2018-08-28 | 2022-02-15 | 南京理工大学 | 基于鲁棒积分的多层神经网络电机系统控制方法 |
CN109176525A (zh) * | 2018-09-30 | 2019-01-11 | 上海神添实业有限公司 | 一种基于rbf的移动机械手自适应控制方法 |
CN110414110B (zh) * | 2019-07-19 | 2023-01-06 | 中仿智能科技(上海)股份有限公司 | 一种用于飞行失速状态下的飞机受力仿真方法 |
CN110488875B (zh) * | 2019-09-02 | 2022-07-12 | 中国人民解放军海军航空大学 | 基于动态逆的无人机跟踪目标初始段航向误差修正方法 |
CN110989640B (zh) * | 2019-10-24 | 2022-07-08 | 深圳市道通智能航空技术股份有限公司 | 一种飞行控制方法、飞行器及飞行系统 |
CN111459175B (zh) * | 2019-12-18 | 2021-07-27 | 北京航空航天大学 | 一种基于l1自适应控制器的尾座式无人机轨迹跟踪容错控制方法 |
CN111496796B (zh) * | 2020-05-08 | 2020-12-22 | 哈尔滨工业大学 | 基于指令滤波器的机械臂轨迹跟踪控制方法及装置 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101937233A (zh) * | 2010-08-10 | 2011-01-05 | 南京航空航天大学 | 近空间高超声速飞行器非线性自适应控制方法 |
CN104777844A (zh) * | 2015-02-12 | 2015-07-15 | 西安电子科技大学 | 一种高超声速临近空间飞行器航迹跟踪方法 |
-
2016
- 2016-02-14 CN CN201610084472.9A patent/CN105629734B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101937233A (zh) * | 2010-08-10 | 2011-01-05 | 南京航空航天大学 | 近空间高超声速飞行器非线性自适应控制方法 |
CN104777844A (zh) * | 2015-02-12 | 2015-07-15 | 西安电子科技大学 | 一种高超声速临近空间飞行器航迹跟踪方法 |
Non-Patent Citations (5)
Title |
---|
Fault tolerant control for a class of nonlinear systems with application to near space vehicle;Xu Y F,etal.;《Circuits System and Signal Process》;20111231;第655-672页 * |
基于Backstepping的近空间飞行器鲁棒自适应姿态控制;张强等;《南京航空航天大学学报》;20131031;第45卷(第5期);第590-598页 * |
基于Backstepping的非仿射非线性系统鲁棒控制;张强等;《控制与决策》;20140131;第29卷(第1期);第19-26页 * |
空天飞行器六自由度数学建模研究;朱亮等;《航天控制》;20060831;第24卷(第4期);第39-44页 * |
近空间飞行器非线性飞控系统鲁棒自适应控制;张强;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;20141215;第C031-26页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105629734A (zh) | 2016-06-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105629734B (zh) | 一种近空间飞行器的轨迹跟踪控制方法 | |
He et al. | Adaptive output feedback fault-tolerant control design for hypersonic flight vehicles | |
Smith et al. | Disturbance observer based control with anti-windup applied to a small fixed wing UAV for disturbance rejection | |
CN107807663B (zh) | 基于自适应控制的无人机编队保持控制方法 | |
Zhang et al. | Adaptive sliding mode control for re-entry attitude of near space hypersonic vehicle based on backstepping design | |
CN109358499A (zh) | 基于速度与航向双重制导的无人船精确路径跟踪控制方法 | |
Qian et al. | Dynamic surface active fault tolerant control design for the attitude control systems of UAV with actuator fault | |
CN104238357A (zh) | 一种近空间飞行器的容错滑模控制方法 | |
Wang et al. | Attitude tracking control for variable structure near space vehicles based on switched nonlinear systems | |
Bu et al. | Novel auxiliary error compensation design for the adaptive neural control of a constrained flexible air-breathing hypersonic vehicle | |
Hu et al. | Fuzzy reliable tracking control for flexible air-breathing hypersonic vehicles | |
Zhao et al. | Drag-based composite super-twisting sliding mode control law design for Mars entry guidance | |
Duan et al. | Automatic landing for carrier-based aircraft under the conditions of deck motion and carrier airwake disturbances | |
Hu et al. | ADP-based intelligent tracking algorithm for reentry vehicles subjected to model and state uncertainties | |
Cao et al. | Robust flight control design using sensor-based backstepping control for unmanned aerial vehicles | |
Xing et al. | Active Wind Rejection Control for a Quadrotor UAV Against Unknown Winds | |
Nguyen et al. | Hybrid intelligent flight control with adaptive learning parameter estimation | |
Melnyk et al. | Digital control of lateral autopilot system applied to an UAV: optimal control strategy | |
Sadati et al. | Backstepping controller design using neural networks for a fighter aircraft | |
Babar et al. | Robust integrated lateral guidance and control of UAVs | |
Wang et al. | Integrated 3‐D flight trajectory tracking control with aerodynamic constraints on attitude and control surfaces | |
Song et al. | An integrated sliding model dynamic inversion control method for reusable launch vehicle reentry attitude control | |
Emami et al. | Disturbance observer-based adaptive neural guidance and control of an aircraft using composite learning | |
Tal et al. | Differential games based autonomous rendezvous for aerial refueling | |
Zhang et al. | Dynamic output feedback H∞ attitude control for hypersonic gliding vehicles |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |