CN104597911A - 空中加油受油机自适应最优对接轨迹跟踪飞行控制方法 - Google Patents
空中加油受油机自适应最优对接轨迹跟踪飞行控制方法 Download PDFInfo
- Publication number
- CN104597911A CN104597911A CN201410712667.4A CN201410712667A CN104597911A CN 104597911 A CN104597911 A CN 104597911A CN 201410712667 A CN201410712667 A CN 201410712667A CN 104597911 A CN104597911 A CN 104597911A
- Authority
- CN
- China
- Prior art keywords
- msub
- mtd
- mrow
- mtr
- mover
- 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.)
- Pending
Links
- 230000003044 adaptive effect Effects 0.000 title claims abstract description 48
- 210000001503 joint Anatomy 0.000 title claims abstract description 32
- 238000000034 method Methods 0.000 title claims abstract description 31
- 238000013528 artificial neural network Methods 0.000 claims abstract description 23
- 238000012821 model calculation Methods 0.000 claims abstract description 8
- 239000011159 matrix material Substances 0.000 claims description 40
- 238000003032 molecular docking Methods 0.000 claims description 27
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims description 15
- 230000004044 response Effects 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 claims description 6
- 238000005315 distribution function Methods 0.000 claims description 6
- 238000012546 transfer Methods 0.000 claims description 6
- 238000012545 processing Methods 0.000 claims description 4
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000003284 homeostatic effect Effects 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 238000012360 testing method Methods 0.000 claims description 3
- 230000003416 augmentation Effects 0.000 claims description 2
- 238000004422 calculation algorithm Methods 0.000 abstract description 15
- 238000004364 calculation method Methods 0.000 abstract description 3
- 239000003921 oil Substances 0.000 description 193
- 230000006870 function Effects 0.000 description 19
- 238000013461 design Methods 0.000 description 10
- 230000008569 process Effects 0.000 description 10
- 238000005516 engineering process Methods 0.000 description 6
- 238000013459 approach Methods 0.000 description 5
- 230000007246 mechanism Effects 0.000 description 5
- 230000001052 transient effect Effects 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 239000000295 fuel oil Substances 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 239000000446 fuel Substances 0.000 description 3
- 238000012423 maintenance Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 230000007123 defense Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 230000002035 prolonged effect Effects 0.000 description 2
- 230000004913 activation Effects 0.000 description 1
- 230000003190 augmentative effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001537 neural effect Effects 0.000 description 1
- 238000003062 neural network model Methods 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明一种空中加油机和受油机自适应最优对接轨迹跟踪的飞行控方法,包括受油机模型计算模块、不确定干扰神经网络辨识器模块、跟踪轨迹生成模块、状态估计模块、自适应更新律模块、自适应控制律模块和最优控制律模块,还包括信号采集的传感器和用于计算处理的运算器及存储器。通过引入投影算子对自适应系统的控制参数进行自适应更新和估计,经过低通滤波器后对产生的自适应信号进行滤波,得到相应的自适应信号增量,再将这个增量同时作用与受油机及相应的状态估计模块,然后根据两者的误差和受油机的实际状态量,对下一个控制时刻的自适应控制算法的参数进行自适应更新和估计,从而最终实现广义误差为零,受油机与加油锥套精确对接。
Description
技术领域
本发明涉及飞行器飞行控制技术领域,尤其涉及一种空中加油机和受油机自适应最优对接轨迹跟踪的飞行控方法。
背景技术
空中加油技术归纳来说,是在空中由一架航空器给另外一架或者几架航空器加注燃油,增长续航时间和增大飞行航程的飞行技术。在现代空中战斗中大领域的攻防要求下,空中加油技术能够大大增加参与作战飞机的战斗能力,并且逐渐成为各国增加无人机、侦察机、战斗机等国防军事力量的重要发展方向和现代军用飞机的基本功能之一。目前,空中加油技术因其突出的优点和重要的军事价值,已经逐渐成为不可或缺的空中后援平台,将现代战争中一些曾经不可想象的作战任务变成事实。根据相关资料显示,空中加油技术在近些年发生的高技术局域战争中应用更为广泛。
参与空中加油操作的飞机分为加油机和受油机两类,空中加油技术的快速发展也带来了加油机的研发需求。空中加油机作为空中加油的支援平台,是专门装载燃油,提供加油操作的飞机。而受油机在空中加油的过程中,则主要负责跟踪加油机,与加油机的加油设备进行精确对接,接受加油机输送的燃油,从而增大其航程,延长其滞空时间。
在受油机与加油锥套近距离对接和输送燃油的过程中,除了存在大气湍流的影响,加油机尾涡作用和控制失效等参数不确定性因素也不容忽视。由于很难建立精确的受油机模型,因此,亟需提高受油机控制系统的抗干扰能力、动态性能和鲁棒性能,提高受油机控制系统的快速自适应能力,使得受油机能够在稳定跟踪对接导引律的同时,达到期望的瞬态响应,且保证闭环系统性能和满足稳定性的要求。
发明内容
受油机与加油锥套近距离对接和输送燃油的过程中,受油机受到大气湍流、加油尾涡干扰、执行机构失效等不确定动态干扰影响了空中加油对接和跟踪保持,受油机控制系统的快速自适应能力差,受油机跟踪对接导引律的同时达不到期望的瞬态响应,难以保证闭环系统性能和稳定性的要求。本发明的目的是针对前述的现有技术中存在的问题,提供如下的技术方案。
本发明的技术方案是提供一种空中加油受油机自适应最优对接轨迹跟踪飞行控制方法,其设计要点在于,包括:
受油机模型计算模块,用于存储受油机气动参数,生成受油机的线性模型系统矩阵信号和控制矩阵信号,所述线性模型系统矩阵信号和控制矩阵信号发送到最优控制模块,线性模型系统矩阵信号和控制矩阵信号发送到状态估计模块;
传感器,用于采集空中受油机的飞行状态信号,传感器把所采集的飞行状态信号发送到最优控制律模块、不确定干扰神经网络辨识器模块、自适应更新律模块和自适应控制律模块;
不确定干扰神经网络辨识器模块,生成受油机系统的不确定干扰信号,发送到状态估计模块;
跟踪轨迹生成模块,生成受油机的受油插头与加油机的加油锥套相对接的受油机的理想飞行轨迹信号,发送到最优控制律模块和状态估计模块;
状态估计模块,生成受油机的干扰估计值信号,发送到自适应控制律模块;生成受油机的飞行状态估计量信号,飞行状态估计量信号和传感器采集的飞行状态信号进行运算处理获得的飞行状态误差信号发送到自适应更新律模块;
自适应更新律模块,生成受油机的飞行状态控制参数估计值信号,发送到自适应控制律模块和状态估计模块;
自适应控制律模块,生成受油机的自适应控制量信号,发送到状态估计模块和自适应更新律模块;
最优控制律模块,生成受油机最优控制量信号,发送到状态估计模块,所述最优控制量信号与自适应控制律模块输出的自适应控制量信号综合后输出到受油机舵面控制器。
本发明还有如下进一步改进的技术方案。
进一步地,所述受油机模型计算模块包括以下方程:
受油机简化为一个解耦的六维自由度飞机模型,其运动方程分为三个子系统,以状态方程的形式描述如下:
Xi(0)=Xi0,
其中i=1,2,3;且Λl≤Λi≤Λu;代表加油机尾涡流不确定干扰量信号。分析加油机风洞试验中受油机所受作用的数据,得到加油机尾涡流不确定干扰Δi(Y)变化率的样本值,并通过不确定干扰神经网络辨识器模块进行拟合;
受油机的控制外回路的输入量X(t)和输出量Y(t)分别为:
Y(t)=[Y1(t) Y2(t) Y3(t)]T=[l(t) h(t) y(t)]T,
其中,第一个子系统使用受油机发动机的推力输入控制受油机和加油锥套之间的水平间距,它的状态向量、系统状态矩阵和控制输入分别是:
式中,l为受油机相对于加油机的前向距离,V为受油机的飞行速度,δT为受油机的油门输入量,为受油机的气动参数。
第二个子系统使用受油机升降舵输入控制受油机和加油锥套之间的垂直间距,它的状态向量、系统状态矩阵和控制输入分别是
X2=[α θ q h]T
式中,α为受油机迎角,θ为受油机俯仰角,q为受油机俯仰角速率,h为受油机与加油机之间相对高度,δe为升降舵输入。Zα,M′α,M′q,为受油机气动参数。
第三个子系统使用受油机副翼输入控制受油机和加油锥套之间的侧向间距,它的状态向量、系统矩阵和控制输入分别是
X3=[φ β p r y]T
式中,β为受油机的侧滑角,φ为受油机的滚转角,p,r为受油机机体轴角速率;δα为受油机副翼输入量;Y(.),L(.),N(.),M(.)为受油机气动参数。θ0,γ0为受油机基准俯仰角与轨迹角,V0为受油机基准速度,g为重力加速度。
进一步地,所述不确定干扰神经网络辨识器模块包括以下方程:
采用径向基函数(RBF)神经网络对受油机系统的不确定干扰Δi(Y)进行拟合,得到拟合等效后的Δi(Y)为Δi(Y)=wi TΦi(Y)+εi(Y),
||εi(Y)||≤εi *,
Y∈Di,
其中,Φi(Y)代表pi×1维矢量,是输出Y的一个高斯分布函数矩阵;代表一个未知常数权重矩阵,可以通过自适应更新律模块进行更新估计;εi *代表集合Di上一致有界的近似误差;
高斯分布函数矩阵Φi(Y)第i个元素的表达式为
式中,参数κi和υi代表预先定义的神经网络的中心和宽度,通过分析加油机的加油尾涡流影响样本结果进行选定。
进一步地,所述跟踪轨迹生成模块包括以下方程:
初始时刻加油锥套距离受油插头在惯性空间下的相对位置为(Xd,Yd,Zd),要求受油机在tf时间内完成对接;设初始位移为则最终要求的位置为(0,0,0),即实现受油插头与加油锥套的对接,参考轨迹方程为
xref(t)=f(t)αx,
yref(t)=f(t)αy,
zref(t)=f(t)αz,
其中f(t)≡[t4 t5 t6 t7],
参考轨迹分两个阶段:第一阶段在t1时间内受油机完成YN,ZN方向上的纠偏,使得受油插头在飞行方向上对准加油锥套;第二阶段消除受油机在飞行方向上相对距离差,使受油插头与加油锥套对接。
进一步地,所述状态估计模块用于对受油机的状态进行动态估计,对应的动态响应即为期望的受油机的动态响应,其状态方程为
其中,代表自适应参数估计值。
进一步地,所述自适应更新律模块包括以下方程:
其中,为系统跟踪误差,Γ>0代表自适应率,可以设定为较大数值,从而保证系统的快速自适应性能;P=PT>0代表李雅普诺夫方程的解,且Qi>0;Proj(·,·)为投影算子。
进一步地,所述自适应控制律模块包括以下方程:
自适应控制量其表达式为
其中,ki>0代表自适应系统反馈增益;代表输入信号的拉氏变换,其表达式为
传递函数Di(s)能够保证闭环等效传递函数Ci(s)严格正稳,Ci(s)为
其中,i=1,2,3;且低通增益Ci(0)=1。
进一步地,所述最优控制律模块包括以下方程:
Xi(0)=Xi0,
其中i=1,2,3;
引入积分误差变量
得到增广后的系统动态方程
定义代价函数通过选择Qi和Ri,求解Ricatti方程方程得到最优控制量
本发明的跟踪飞行控制方法,应用于空中加油受油机的对接轨迹跟踪飞行控制,建立精确的受油机模型,实现控制受油机在大气湍流、加油尾涡干扰、执行机构失效等不确定动态干扰情形下的空中加油对接和跟踪保持,保证控制系统具有快速的自适应反应能力。
有益效果
1)理想对接跟踪轨迹的设计确保了参考飞行轨迹是可行的,并且不会导致舵面的控制饱和,使受油机飞行轨迹平滑,并能够平缓接近加油锥套并对接。
2)最优控制律中选择合适的反馈增益矩阵,使得在加油尾涡等干扰下,能够保证闭环系统具有期望的动态响应特性和稳定性能;而当加油尾涡等动态变化且存在执行机构失效等不确定干扰时,自适应控制信号不为零,且由自适应律不断在线更新自适应控制器参数,使得系统在自适应控制信号的控制下,误差信号收敛至零。
3)针对对接跟踪过程中的不确定干扰因素,采用自适应控制的方法设计了受油机对接跟踪控制系统,提高了受油机在不确定干扰、执行机构失效等情形下的空中加油对接和跟踪保持的性能,提高了系统的动态性能、自适应更新速率和鲁棒性能,适用于大动态干扰下的自主空中加油对接跟踪控制过程。
附图说明
图1本发明受油机自适应最优对接轨迹跟踪控制方法原理图。
图2本发明参考对接轨迹与受油机实际对接轨迹曲线。
图3本发明受油机与加油锥套的对接轨迹跟踪曲线。
具体实施方式
为了阐明本发明的技术方案及技术目的,下面结合附图及具体实施方式对本发明做进一步的介绍。
自适应控制算法的设计思想在于采用状态估计模块代替固定的参考模型,使其更能代表实际对接情形下受油机期望的动态性能。通过引入投影算子对自适应系统的控制参数进行自适应更新和估计,经过低通滤波器后对产生的自适应信号进行滤波,得到相应的自适应信号增量,再将这个增量同时作用与受油机及相应的状态估计模块,然后根据两者的误差和受油机的实际状态量,对下一个控制时刻的自适应控制算法的参数进行自适应更新和估计,从而最终实现广义误差为零,受油机与加油锥套精确对接、跟踪的控制目标。
自适应控制方法具有诸多优点:(1)具有快速的自适应能力,仅受系统硬件计算速度的限制;(2)能够将控制系统的自适应能力和鲁棒性能进行解耦设计;(3)保证系统具有良好的瞬态性能;(4)具有统一边界的瞬态响应,不受初始条件、未知参数值变化的影响。
如图1所示,本发明的一种空中加油受油机自适应最优对接轨迹跟踪飞行控制方法,包括受油机模型计算模块、不确定干扰神经网络辨识器模块、跟踪轨迹生成模块、状态估计模块、自适应更新律模块、自适应控制律模块和最优控制律模块,还包括信号采集的传感器和用于计算处理的运算器及存储器。受油机模型计算模块,用于存储受油机气动参数,生成受油机的线性模型系统矩阵信号和控制矩阵信号,所述线性模型系统矩阵信号和控制矩阵信号发送到最优控制模块,线性模型系统矩阵信号和控制矩阵信号发送到状态估计模块;传感器,用于采集空中受油机的飞行状态信号,传感器把所采集的飞行状态信号发送到最优控制律模块、不确定干扰神经网络辨识器模块、自适应更新律模块和自适应控制律模块;不确定干扰神经网络辨识器模块,生成受油机系统的不确定干扰信号,发送到状态估计模块;跟踪轨迹生成模块,生成受油机的受油插头与加油机的加油锥套相对接的受油机的理想飞行轨迹信号,发送到最优控制律模块和状态估计模块;状态估计模块,生成受油机的干扰估计值信号,发送到自适应控制律模块;生成受油机的飞行状态估计量信号,飞行状态估计量信号和传感器采集的飞行状态信号进行运算处理获得的飞行状态误差信号发送到自适应更新律模块;自适应更新律模块,生成受油机的飞行状态的控制参数估计值信号,发送到自适应控制律模块和状态估计模块;自适应控制律模块,生成受油机的自适应控制量信号,发送到状态估计模块和自适应更新律模块最优控制律模块,生成受油机最优控制量信号,发送到状态估计模块,所述最优控制量信号与自适应控制律模块输出的自适应控制量信号综合后输出到受油机舵面控制器。
(1)受油机模型计算模块
为了开展自适应控制算法的设计工作,将受油机看作一个解耦的六自由度飞机模型,将受油机的运动方程分为三个子系统,以状态方程的形式描述如下:
Xi(0)=Xi0,
其中i=1,2,3;且Λl≤Λi≤Λu;代表加油机尾涡流不确定干扰量信号。分析加油机风洞试验中受油机所受作用的数据,得到加油机尾涡流不确定干扰Δi(Y)变化率的样本值,并通过不确定干扰神经网络辨识器模块进行拟合。
受油机的控制外回路的输入量X(t)和输出量Y(t)分别为:
Y(t)=[Y1(t) Y2(t) Y3(t)]T=[l(t) h(t) y(t)]T,
其中,第一个子系统使用受油机发动机的推力输入控制受油机和加油锥套之间的水平间距,它的状态向量、系统状态矩阵和控制输入分别是:
式中,l为受油机相对于加油机的前向距离,V为受油机的飞行速度,δT为受油机的油门输入量,为受油机的气动参数。
第二个子系统使用受油机升降舵输入控制受油机和加油锥套之间的垂直间距,它的状态向量、系统状态矩阵和控制输入分别是
X2=[α θ q h]T
式中,α为受油机迎角,θ为受油机俯仰角,q为受油机俯仰角速率,h为受油机与加油机之间相对高度,δe为受油机升降舵输入。Zα,M′α,M′q,为受油机气动参数。
第三个子系统使用受油机副翼输入控制受油机和加油锥套之间的侧向间距,它的状态向量、系统矩阵和控制输入分别是
X3=[φ β p r y]T
式中,β为受油机的侧滑角,φ为受油机的滚转角,p,r为受油机机体轴角速率;δα为受油机副翼输入量;Y(.),L(.),N(.),M(.)为受油机气动参数。θ0,γ0为受油机基准俯仰角与轨迹角,V0为受油机基准速度,g为重力加速度。
当受油机系统输入信号为,LQR轨迹控制器的反馈参数矩阵为Ki时,第i个子系统的状态方程为:
其中,i=1、2、3,代表受油机的参考对接轨迹输入,Δi[Y(t)]代表系统的不确定动态干扰;Λi代表受油机执行机构的有效参数值,当无控制失效时,Λi=1。在外回路LQR控制的基础上,假设则受油机的状态方程可以修改为:
Y(t)=cTx(t)
其中,kg代表相应的参考输入矩阵,
(2)不确定干扰神经网络辨识器模块
对于受油机系统的不确定动态干扰Δi(Y),采用神经网络辨识器模块进行逼近和动态拟合,选择径向基函数(Radical Basis Function,RBF)神经网络模型,以高精度逼近实际对接过程的不确定干扰。网络分三层,第一层为信号源结点组成的输入层,仅传输信号;第二层为隐含层,隐单元的变换函数是RBF函数,采用非线性优化策略,学习速度较慢;第三层为输出层,响应输入模式的作用,调整线性权,采用线性优化策略,学习速度较快。建模学习算法中求解的参数有:径向基函数中心、方差及隐含层到输出层的权值。设样本期望输出值为d,样本总数为P,隐含层结点数为h,高斯函数为径向基函数,则激活函数为
其中,参数ci和σi代表预先定义的神经网络的中心和宽度,由加油尾涡的影响结果进行选定。
采用上述的径向基函数(RBF)神经网络对受油机系统的不确定干扰Δi(Y)进行拟合,得到拟合等效后的Δi(Y)为
Δ(Y)=wi TΦi(Y)+εi(Y),
||εi(Y)||≤εi *,
Y∈Di,
其中,Φi(Y)代表pi×1维矢量,是输出Y的一个高斯分布函数矩阵;代表一个未知常数权重矩阵,可以通过自适应更新律模块进行更新估计;εi *代表集合Di上一致有界的近似误差;
高斯分布函数矩阵Φi(Y)第i个元素的表达式为
式中,参数κi和υi代表预先定义的神经网络的中心和宽度,通过分析加油机的加油尾涡流影响样本结果进行选定。
在控制算法设计中,不确定加油尾涡干扰Δi(Y)的拟合结果通常影响控制算法的性能,因此需要给出神经网络的拟合范围和要求。假设基于径向基神经网络分布的拟合误差集合Di为:
其中,σi>0代表一个任意小的正常数,其他三个参数值分别代表参考信号瞬态跟踪误差边界、不确定性干扰因素拟合的误差边界和闭环参考系统的跟踪误差边界。
当设计的自适应控制算法中,神经网络拟合误差范围属于集合Di时,可以认为系统对加油尾涡的不确定干扰拟合较为准确,能够作为控制信号的参考输入之一。
(3)状态估计模块
状态估计模块用于对受油机的状态进行动态估计,对应的动态响应即为期望的受油机的动态响应,其状态方程为
其中,代表自适应参数估计值,由自适应控制算中的自适应更新律模块不断计算并更新得到该数值。
(4)自适应更新律模块
定义系统的状态量跟踪误差为
引入投影算子对可调机构参数进行自适应更新,则可调系统参数估计值的自适应律为包括以下方程
其中,Γ>0代表自适应率,可以设定为较大数值,从而保证系统的快速自适应性能;P=PT>0代表李雅普诺夫方程的解,且Qi>0;Proj(·,·)表示两者的投影算子。
(5)自适应控制律模块
可调控制器的输出量经低通滤波器滤波之后,成为输入受油机的自适应控制信号uad,各子系统的自适应控制信号设计如下:
自适应控制输出其表达式为
其中,ki>0代表自适应系统反馈增益;代表输入信号的拉氏变换,其表达式为
传递函数Di(s)能够保证闭环等效传递函数Ci(s)严格正稳,Ci(s)为
其中,i=1,2,3;低通增益Ci(0)=1;Λi代表各子系统执行机构效率,正常工作时Λi=1。通过在反馈通道中加入低通滤波系统Ci(s),能够减弱控制信号中产生的高频振荡。
(6)最优控制律模块
外回路控制系统设计中,基于状态反馈线性二次调节器(LQR)的控制算法作用是在一定的加油尾涡干扰下,保证受油机轨迹控制系统的基本稳定。
当不确定因素干扰为零,即Λi=1且Δi=0时,子系统状态方程为
Xi(0)=Xi0,
其中i=1,2,3;
引入积分误差变量
在系统的状态量中加入以上积分误差,得到增广后的系统动态特性如下
各子系统中的控制信号ui有如下形式:
其中,代表第i个子系统基础控制算法的控制信号,代表自适应控制信号。
当基本控制算法是LQR控制算法时,可以通过求解状态反馈增益 使得价值函数最小,定义代价函数
其中,Qi和Ri代表各子系统中LQR控制算法的设计参数,均为正定矩阵,且满足Ricatti方程。
由此,推导出闭环系统的状态方程如下:
假设xi(t)=[Xi(t) yi(t)]T,得到增广后的闭环系统的状态方程为:
由上式分析可知,外回路LQR轨迹控制算法设计的目标选择合适的反馈增益矩阵Ki,使得在一定的加油尾涡干扰下,能够保证闭环系统具有期望的动态响应特性和稳定性能。而当加油尾涡动态变化且存在执行机构失效等不确定干扰时,自适应控制信号uad(t)不为零,且由自适应律不断在线更新可调控制算法参数,使得系统在自适应控制信号的控制下,误差信号收敛至零。
(7)跟踪轨迹生成模块
跟踪轨迹生成模块的目的是产生一个可行轨迹,这个轨迹能够驱动受油机的插头与加油锥套相接。假定对接机动在时间间隔(t0,tf)内完成。为了确保参考轨迹是可行的,并且不会导致舵面的控制饱和,可以将对接时刻tf设定为一个受油机和加油锥套之间初始偏移量的函数。
初始时刻加油锥套距离受油机插头在惯性空间(ONXNYNZN)下的相对位置为(Xd,Yd,Zd),要求受油机在tf时间内完成对接。设计受油机参考飞行轨迹,使受油机受油插头能够平缓接近加油锥套并对接。
根据受油机状态和控制的约束,最终时间tf为:
其中,“ceil”函数是将括号中的结果四舍五入到最接近的整数,并且γf是一个设计参数,它的选择能够使得受油机和锥套之间的接近速率变得足够小。根据软式加油设备规格,接近速率通常小于1.2m/s。由于加油机和受油机具有相同的初始速度和方向,所以t0时刻的初始偏移量是一个常数。初始位移被定义为:
参考轨迹方程为
xref(t)=f(t)αx,
yref(t)=f(t)αy,
zref(t)=f(t)αz,
其中f(t)≡[t4 t5 t6 t7],
αx的四个系数可通过最终偏移量和tf时刻的速度、加速度以及位置的三阶导数均为零确定为:
参考轨迹为yref,zref,定义如下:
yref(t)=f(t)αy
zref(t)=f(t)αz
其中,αy和αz的四个系数也是由在t1时刻的最终偏移量、零初速度、加速度以及加速度的导数计算产生的:
参考轨迹分两个阶段:第一阶段在t1时间内受油机完成YN,ZN方向上的纠偏,使得受油插头在飞行方向上对准加油锥套。第二阶段消除受油机在飞行方向上相对距离差,使受油插头与加油锥套对接。
(一)第一阶段
对接机动的第一阶段的目的是使得受油机在YN和ZN方向上与锥套保持一致。第一阶段从t0持续到t1,t1由总时间的一个分数因子决定,即
t1=γ1tf
选择合适的参数γ1,确保参考轨迹光滑变化,即使得受油机能够有足够的有效操纵裕度跟踪参考轨迹,且保证下述边界条件成立
(二)第二阶段
在这个阶段中,受油机必须跟踪锥套侧向和垂直方向上位置的扰动变化,这个阶段将从t1持续到tf,并在最终达到加油锥套的惯性位置,完成对接。假设,该阶段中锥套的惯性位置为:
定义t1时刻之后的跟踪轨迹为:
其中增益Kref的定义如下:
通过Kref的定义,实现了一个从第一阶段到第二阶段的平稳切换,即设计的参考轨迹中没有中断点。由增益Kref的定义可知,Kref在t1时刻为0逐渐增加到t2时刻为1。t2由下式决定:
t2=γ2tf
其中,参数γ2是由设计得到。
假如不考虑加油锥套的运动在YN、ZN上的运动,那么第二阶段的轨迹设计可以简化为:当受油机进入第二阶段以后,侧向和垂直方向上的相对位置没有变化,只有受油机相对于锥套在XN方向上有相对速度。
下面在综合动态干扰下,即同时存在剧烈大气湍流干扰、不确定加油尾涡干扰和控制失效的作用下,对自适应对接跟踪控制系统进行仿真验证,此时的空中加油高度同样设定为6000米,对应的大气湍流动荡幅度为σu=σv=σw=3(m/s)。
空中加油对接跟踪初始时刻,以受油机为参考坐标点,即受油机的坐标值为(0,0,0)m,此时加油锥套的相对位置为(l0,y0,h0)=(100,50,50)m,在0~50s的对接跟踪过程中,自适应对接跟踪控制器应当控制受油机按照一定的光滑导引律接近加油锥套,克服初始的相对位置偏差,完成受油插头与加油锥套的精确对接。当存在综合动态干扰时,受油机自适应对接控制器的非线性仿真结果如图2-3所示。
经理论建模和仿真分析,本发明成果达到了预期的目的:在剧烈大气湍流干扰、不确定加油尾涡流干扰和控制失效等综合动态干扰下,自适应控制器都能够对不确定干扰因素进行精确估计,产生对应的自适应信号从而减弱作用在受油机上的动态综合干扰,对接误差均小于,可以认为是成功的对接机动,保证了受油机与加油锥套完成精确对接和跟踪的飞行任务,且对接跟踪过程中,受油机的各控制量和状态量都在可行的范围之内。
以上显示和描述了本发明的基本原理、主要特征和本发明的优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,本发明要求保护范围由所附的权利要求书、说明书及其等效物界定。
Claims (8)
1.一种空中加油受油机自适应最优对接轨迹跟踪飞行控制方法,其特征在于,包括:
受油机模型计算模块,用于存储受油机气动参数,生成受油机的线性模型系统矩阵信号和控制矩阵信号,所述线性模型系统矩阵信号和控制矩阵信号发送到最优控制模块,线性模型系统矩阵信号和控制矩阵信号发送到状态估计模块;
传感器,用于采集空中受油机的飞行状态信号,传感器把所采集的飞行状态信号发送到最优控制律模块、不确定干扰神经网络辨识器模块、自适应更新律模块和自适应控制律模块;
不确定干扰神经网络辨识器模块,生成受油机系统的不确定干扰信号,发送到状态估计模块;
跟踪轨迹生成模块,生成受油机的受油插头与加油机的加油锥套相对接的受油机理想飞行轨迹信号,发送到最优控制律模块和状态估计模块;
状态估计模块,生成受油机的干扰估计值信号,发送到自适应控制律模块;生成受油机的飞行状态估计量信号,飞行状态估计量信号和传感器采集的飞行状态信号进行运算处理获得的飞行状态误差信号发送到自适应更新律模块;
自适应更新律模块,生成受油机的飞行状态控制参数估计值信号,发送到自适应控制律模块和状态估计模块;
自适应控制律模块,生成受油机的自适应控制量信号,发送到状态估计模块和自适应更新律模块;
最优控制律模块,生成受油机最优控制量信号,发送到状态估计模块,所述最优控制量信号与自适应控制律模块输出的自适应控制量信号综合后输出到受油机舵面控制器。
2.根据权利要求1所述的一种空中加油受油机自适应最优对接轨迹跟踪飞行控制方法,其特征在于,所述受油机模型计算模块包括以下方程:
受油机简化为一个解耦的六维自由度飞机模型,其运动方程分为三个子系统,以状态方程的形式描述如下:
Xi(0)=Xi0,
其中i=1,2,3;且Λl≤Λi≤Λu;代表加油机尾涡流不确定干扰量信号。分析加油机风洞试验中受油机所受作用的数据,得到加油机尾涡流不确定干扰Δi(Y)变化率的样本值,并通过不确定干扰神经网络辨识器模块进行拟合;
受油机的控制外回路的输入量X(t)和输出量Y(t)分别为:
Y(t)=[Y1(t) Y2(t) Y3(t)]T=[l(t) h(t) y(t)]T,
其中,第一个子系统使用受油机发动机的推力输入控制受油机和加油锥套之间的水平间距,它的状态向量、系统状态矩阵和控制输入分别是:
式中,l为受油机相对于加油机的前向距离,V为受油机的飞行速度,δT为受油机的油门输入量,为受油机的气动参数。
第二个子系统使用受油机升降舵输入控制受油机和加油锥套之间的垂直间距,它的状态向量、系统状态矩阵和控制输入分别是
式中,α为受油机迎角,θ为受油机俯仰角,q为受油机俯仰角速率,h为受油机与加油机之间相对高度,δe为升降舵输入。Zα,M′α,M′q,为受油机气动参数。
第三个子系统使用受油机副翼输入控制受油机和加油锥套之间的侧向间距,它的状态向量、系统矩阵和控制输入分别是
式中,β为受油机的侧滑角,φ为受油机的滚转角,p,r为受油机机体轴角速率;δa为受油机副翼输入量;Y(.),L(.),N(.),M(.)为受油机气动参数。θ0,γ0为受油机基准俯仰角与轨迹角,V0为受油机基准速度,g为重力加速度。
3.根据权利要求1所述的一种空中加油受油机自适应最优对接轨迹跟踪飞行控制方法,其特征在于,所述不确定干扰神经网络辨识器模块包括以下方程:
采用径向基函数(RBF)神经网络对受油机系统的不确定干扰Δi(Y)进行拟合,得到拟合等效后的Δi(Y)为
Δi(Y)=wi TΦi(Y)+εi(Y),
||εi(Y)||≤εi *,
Y∈Di,
其中,Φi(Y)代表pi×1维矢量,是输出Y的一个高斯分布函数矩阵;代表一个未知常数权重矩阵,可以通过自适应更新律模块进行更新估计;εi *代表集合Di上一致有界的近似误差;
高斯分布函数矩阵Φi(Y)第i个元素的表达式为
式中,参数κi和υi代表预先定义的神经网络的中心和宽度,通过分析加油机的加油尾涡流影响样本结果进行选定。
4.根据权利要求1所述的一种空中加油受油机自适应最优对接轨迹跟踪飞行控制方法,其特征在于,所述跟踪轨迹生成模块包括以下方程:
初始时刻加油锥套距离受油插头在惯性空间下的相对位置为(Xd,Yd,Zd),要求受油机在tf时间内完成对接;设初始位移为侧最终要求的位置为(0,0,0),即实现受油插头与加油锥套的对接,参考轨迹方程为
xref(t)=f(t)ax,
yref(t)=f(t)ay,
zref(t)=f(t)az,
其中
参考轨迹分两个阶段:第一阶段在t1时间内受油机完成YN,ZN方向上的纠偏,使得受油插头在飞行方向上对准加油锥套;第二阶段消除受油机在飞行方向上相对距离差,使受油插头与加油锥套对接。
5.根据权利要求1所述的一种空中加油受油机自适应最优对接轨迹跟踪飞行控制方法,其特征在于,所述状态估计模块用于对受油机的状态进行动态估计,对应的动态响应即为期望的受油机的动态响应,其状态方程为
其中,代表自适应参数估计值。
6.根据权利要求1所述的一种空中加油受油机自适应最优对接轨迹跟踪飞行控制方法,其特征在于,所述自适应更新律模块包括以下方程:
其中,为系统跟踪误差,Γ>0代表自适应率,可以设定为较大数值,从而保证系统的快速自适应性能;P=PT>0代表李雅普诺夫方程的解,且Qi>0;Proj(·,·)为投影算子。
7.根据权利要求1所述的一种空中加油受油机自适应最优对接轨迹跟踪飞行控制方法,其特征在于,所述自适应控制律模块包括以下方程:
自适应控制输出其表达式为
其中,ki>0代表自适应系统反馈增益;代表输入信号的拉氏变换,其表达式为
传递函数Di(s)能够保证闭环等效传递函数Ci(s)严格正稳,Ci(s)为
其中,i=1,2,3;且低通增益Ci(0)=1。
8.根据权利要求1所述的一种空中加油受油机自适应最优对接轨迹跟踪飞行控制方法,其特征在于,所述最优控制律模块包括以下方程:
Xi(0)=Xi0,
其中i=1,2,3;
引入积分误差变量
得到增广后的系统动态方程
定义代价函数通过选择Qi和Ri,求解Ricatti方程方程得到最优控制量输出
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410712667.4A CN104597911A (zh) | 2014-11-28 | 2014-11-28 | 空中加油受油机自适应最优对接轨迹跟踪飞行控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410712667.4A CN104597911A (zh) | 2014-11-28 | 2014-11-28 | 空中加油受油机自适应最优对接轨迹跟踪飞行控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN104597911A true CN104597911A (zh) | 2015-05-06 |
Family
ID=53123766
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410712667.4A Pending CN104597911A (zh) | 2014-11-28 | 2014-11-28 | 空中加油受油机自适应最优对接轨迹跟踪飞行控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104597911A (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105084285A (zh) * | 2015-08-11 | 2015-11-25 | 中国航空工业集团公司西安飞机设计研究所 | 加油设备与受油机自动对接的控制方法及装置 |
CN105302158A (zh) * | 2015-10-23 | 2016-02-03 | 南京航空航天大学 | 基于Dubins路径的无人机空中加油最短时间会合方法 |
CN106998084A (zh) * | 2016-01-26 | 2017-08-01 | 丰唐物联技术(深圳)有限公司 | 无人机充电方法及系统 |
CN108536132A (zh) * | 2018-03-20 | 2018-09-14 | 南京航空航天大学 | 一种固定翼无人机空中加油平台及其加油方法 |
CN108983815A (zh) * | 2018-08-03 | 2018-12-11 | 北京航空航天大学 | 一种基于终端迭代学习控制的抗干扰自主对接控制方法 |
CN109062044A (zh) * | 2018-08-03 | 2018-12-21 | 北京航空航天大学 | 一种终端迭代学习对接控制方法 |
CN109164716A (zh) * | 2018-08-03 | 2019-01-08 | 北京航空航天大学 | 一种抑制柔性拖拽系统末端摆动的控制方法 |
CN111176329A (zh) * | 2020-02-12 | 2020-05-19 | 中国空气动力研究与发展中心高速空气动力研究所 | 一种基于风洞试验数据的编队飞行混合性能函数构建方法 |
CN111352435A (zh) * | 2018-12-20 | 2020-06-30 | 中国科学院沈阳自动化研究所 | 一种无人机编队自主空中加油方法 |
CN113517927A (zh) * | 2021-04-22 | 2021-10-19 | 长春理工大学 | 大气湍流扰动自适应对消方法、装置及通信系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1705116A2 (en) * | 2005-03-24 | 2006-09-27 | The Boeing Company | Systems and methods for automatically and semiautomatically controlling aircraft refueling |
CN102004454A (zh) * | 2009-08-31 | 2011-04-06 | 波音公司 | 用于控制加油锥套的方法和设备 |
CN104133480A (zh) * | 2014-04-17 | 2014-11-05 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种基于机器视觉的空中受油引导控制方法 |
-
2014
- 2014-11-28 CN CN201410712667.4A patent/CN104597911A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1705116A2 (en) * | 2005-03-24 | 2006-09-27 | The Boeing Company | Systems and methods for automatically and semiautomatically controlling aircraft refueling |
CN102004454A (zh) * | 2009-08-31 | 2011-04-06 | 波音公司 | 用于控制加油锥套的方法和设备 |
CN104133480A (zh) * | 2014-04-17 | 2014-11-05 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种基于机器视觉的空中受油引导控制方法 |
Non-Patent Citations (1)
Title |
---|
刘曌: "软式自主空中加油受油机飞行控制技术研究", 《中国优秀硕士学位论文全文数据库工程科技II辑》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105084285A (zh) * | 2015-08-11 | 2015-11-25 | 中国航空工业集团公司西安飞机设计研究所 | 加油设备与受油机自动对接的控制方法及装置 |
CN105084285B (zh) * | 2015-08-11 | 2017-08-11 | 中国航空工业集团公司西安飞机设计研究所 | 加油设备与受油机自动对接的控制方法及装置 |
CN105302158A (zh) * | 2015-10-23 | 2016-02-03 | 南京航空航天大学 | 基于Dubins路径的无人机空中加油最短时间会合方法 |
CN105302158B (zh) * | 2015-10-23 | 2018-05-22 | 南京航空航天大学 | 基于Dubins路径的无人机空中加油最短时间会合方法 |
CN106998084A (zh) * | 2016-01-26 | 2017-08-01 | 丰唐物联技术(深圳)有限公司 | 无人机充电方法及系统 |
CN108536132A (zh) * | 2018-03-20 | 2018-09-14 | 南京航空航天大学 | 一种固定翼无人机空中加油平台及其加油方法 |
CN109164716A (zh) * | 2018-08-03 | 2019-01-08 | 北京航空航天大学 | 一种抑制柔性拖拽系统末端摆动的控制方法 |
CN109062044A (zh) * | 2018-08-03 | 2018-12-21 | 北京航空航天大学 | 一种终端迭代学习对接控制方法 |
CN108983815A (zh) * | 2018-08-03 | 2018-12-11 | 北京航空航天大学 | 一种基于终端迭代学习控制的抗干扰自主对接控制方法 |
CN109062044B (zh) * | 2018-08-03 | 2020-10-09 | 北京航空航天大学 | 一种终端迭代学习对接控制方法 |
CN109164716B (zh) * | 2018-08-03 | 2020-10-20 | 北京航空航天大学 | 一种抑制柔性拖拽系统末端摆动的控制方法 |
CN111352435A (zh) * | 2018-12-20 | 2020-06-30 | 中国科学院沈阳自动化研究所 | 一种无人机编队自主空中加油方法 |
CN111352435B (zh) * | 2018-12-20 | 2021-07-16 | 中国科学院沈阳自动化研究所 | 一种无人机编队自主空中加油方法 |
CN111176329A (zh) * | 2020-02-12 | 2020-05-19 | 中国空气动力研究与发展中心高速空气动力研究所 | 一种基于风洞试验数据的编队飞行混合性能函数构建方法 |
CN111176329B (zh) * | 2020-02-12 | 2020-09-18 | 中国空气动力研究与发展中心高速空气动力研究所 | 一种基于风洞试验数据的编队飞行混合性能函数构建方法 |
CN113517927A (zh) * | 2021-04-22 | 2021-10-19 | 长春理工大学 | 大气湍流扰动自适应对消方法、装置及通信系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104597911A (zh) | 空中加油受油机自适应最优对接轨迹跟踪飞行控制方法 | |
Li et al. | Adaptive backstepping-based flight control system using integral filters | |
CN106444799B (zh) | 基于模糊扩张状态观测器和自适应滑模的四旋翼无人机控制方法 | |
CN110347170B (zh) | 可重复使用运载器再入段鲁棒容错制导控制系统及工作方法 | |
CN111399531B (zh) | 高超声速飞行器滑翔段制导与姿态控制一体化设计方法 | |
Qian et al. | Dynamic surface active fault tolerant control design for the attitude control systems of UAV with actuator fault | |
Wiese et al. | Adaptive control of a generic hypersonic vehicle | |
CN105425812B (zh) | 一种基于双模型下的无人机自动着舰轨迹控制方法 | |
Lai et al. | On-board trajectory generation for collision avoidance in unmanned aerial vehicles | |
Valasek et al. | Fault-tolerant adaptive model inversion control for vision-based autonomous air refueling | |
Wang et al. | Composite practically fixed time controller design for a hypersonic vehicle with multisource uncertainty and actuator fault | |
CN109703769B (zh) | 一种基于预瞄策略的空中加油对接控制方法 | |
Tandale et al. | Fault-tolerant structured adaptive model inversion control | |
Liu et al. | Trajectory stabilization control for aerial recovery of cable-drogue-UAV assembly | |
Sun et al. | Adaptive nonlinear relative motion control of quadrotors in autonomous shipboard landings | |
CN109582039A (zh) | 一种采用相对导航信息的j2摄动下最优队形重构方法 | |
Stepanyan et al. | Visual tracking of a maneuvering target | |
Moncayo et al. | Performance analysis of fault tolerant UAV baseline control laws with L1 adaptive augmentation | |
Van Oort et al. | Full-envelope modular adaptive control of a fighter aircraft using orthogonal least squares | |
Burken et al. | Adaptive flight control design with optimal control modification for F-18 aircraft model | |
An et al. | Relative position control design of receiver UAV in flying-boom aerial refueling phase | |
Kim et al. | Evaluation of cooperative guidance for formation flight of fixed-wing UAVs using mesh network | |
Padhi et al. | Neuro-adaptive augmented dynamic inversion based PIGC design for reactive obstacle avoidance of UAVs | |
Chen et al. | Take-off and landing control for a coaxial ducted fan unmanned helicopter | |
Chu et al. | Three-dimensional trajectory tracking control of underactuated autonomous underwater 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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20150506 |
|
RJ01 | Rejection of invention patent application after publication |