CN113919194A - 一种基于滤波误差法的非线性飞行动力学系统辨识方法 - Google Patents

一种基于滤波误差法的非线性飞行动力学系统辨识方法 Download PDF

Info

Publication number
CN113919194A
CN113919194A CN202111040968.3A CN202111040968A CN113919194A CN 113919194 A CN113919194 A CN 113919194A CN 202111040968 A CN202111040968 A CN 202111040968A CN 113919194 A CN113919194 A CN 113919194A
Authority
CN
China
Prior art keywords
flight dynamics
nonlinear
dynamics system
identified
theta
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
Application number
CN202111040968.3A
Other languages
English (en)
Other versions
CN113919194B (zh
Inventor
汪清
郑凤麒
钱炜祺
丁娣
孔轶男
周宇
陈功
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Computational Aerodynamics Institute of China Aerodynamics Research and Development Center
Original Assignee
Computational Aerodynamics Institute of China Aerodynamics Research and Development Center
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Computational Aerodynamics Institute of China Aerodynamics Research and Development Center filed Critical Computational Aerodynamics Institute of China Aerodynamics Research and Development Center
Priority to CN202111040968.3A priority Critical patent/CN113919194B/zh
Publication of CN113919194A publication Critical patent/CN113919194A/zh
Application granted granted Critical
Publication of CN113919194B publication Critical patent/CN113919194B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/20Design optimisation, verification or simulation
    • G06F30/23Design optimisation, verification or simulation using finite element methods [FEM] or finite difference methods [FDM]
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F2119/00Details relating to the type or aim of the analysis or the optimisation
    • G06F2119/10Noise analysis or noise optimisation
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F2119/00Details relating to the type or aim of the analysis or the optimisation
    • G06F2119/14Force analysis or force optimisation, e.g. static or dynamic forces
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Hardware Design (AREA)
  • Evolutionary Computation (AREA)
  • Geometry (AREA)
  • General Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明提供一种基于滤波误差法的非线性飞行动力学系统辨识方法,包括如下步骤:步骤S100,将飞行动力学方程转换为含有加性过程噪声和测量噪声的非线性动力学系统,待辨识的模型参数θ由系统参数、初始状态和滤波增益参数构成;步骤S200,对于给定的测量噪声协方差矩阵R,采用Gauss‑Newton法最小化负对数似然函数,获得参数θ的最大似然估计,其中状态估计采用线性化Kalman滤波器;步骤S300,估计测量噪声协方差矩阵R;步骤S400,重复执行步骤S200~S300,直至收敛,得到非线性飞行动力学系统辨识结果;步骤S500,计算非线性飞行动力学系统辨识结果的不确定度。本发明适用范围更广、实用性更强。

Description

一种基于滤波误差法的非线性飞行动力学系统辨识方法
技术领域
本发明涉及航天技术领域,具体而言,涉及一种基于滤波误差法的非线性飞行动力学系统辨识方法。
背景技术
对于动力学系统辨识,最大似然法(Maximum Likelihood,ML)具有卓越的理论特性和经实践证明的实用性。根据其对随机噪声的不同处理方法,最大似然法分为三类:只考虑测量噪声的输出误差法(Output Error,OE)、只考虑过程噪声的方程误差法(EquationError,EE)、同时考虑过程噪声和测量噪声的滤波误差法(Filter Error,FE)。其中:
输出误差法是当前飞行器飞行动力学系统辨识领域最广泛使用的方法。其技术方案是:在动力学系统模型中只考虑测量噪声而不考虑过程噪声,待辨识参数由系统参数和初始状态构成,采用松弛迭代法交替估计未知参数和测量噪声协方差矩阵,其中,状态预测直接由状态方程数值积分得到。该方法的主要缺点是:只考虑测量噪声而不考虑过程噪声,当飞行试验遭遇湍流或存在其它过程噪声时,辨识结果散布显著增大,并且根据Cramer-Rao界给出的辨识结果不确定度不可信。
滤波误差法虽然理论提出得很早,但实际应用较少,主要原因是,理论上的滤波误差法需要预知系统过程噪声和测量噪声的统计特性,并且算法复杂,存在收敛性和可辨识性问题。较少的滤波误差法应用也主要局限于线性系统。对于非线性飞行动力学系统,仅R.V.Jategaonkar和E.Plaetschke在文献中提出了一种滤波误差法形式,并将其应用于飞机飞行试验气动参数辨识。其技术方案是,对于含加性过程噪声和测量噪声的中等非线性飞行动力学系统,将过程噪声协方差矩阵作为未知参数,与其他模型参数共同构成待辨识参数向量,采用松弛迭代法交替估计未知参数和测量噪声协方差,其中,状态估计采用一个基于恒定增益矩阵K的近似滤波器,该矩阵通过求解连续时间Riccati方程获得。Riccati方程中状态矩阵A和观测矩阵C采用系统关于初始状态的一阶近似,而不考虑他们随状态的变化。该方法的主要缺点是:1)辨识算法仅适用于稳定飞行器,而不适用于中立稳定和不稳定飞行器。这是因为,在该方法中,滤波增益矩阵K通过求解连续时间Riccati方程来得到。理论已经证明,Riccati方程存在唯一正定解的充要条件是,由状态矩阵A和观测矩阵C构成的线性系统是稳定且可观测的。对于中立稳定和不稳定飞行器,不满足稳定性条件。2)辨识算法仅适用于弱到中等非线性动力学系统,而不适用于强非线性动力学系统。这是因为,Riccati方程中状态矩阵A和观测矩阵C采用初始状态近似计算,而不考虑他们随状态的变化。对于强非线性动力学系统,状态矩阵A和观测矩阵C随状态变化较大,由上述Riccati方程计算的滤波增益矩阵K不能反映系统的真实情况,从而导致辨识结果偏差,甚至可能导致辨识算法不收敛。
发明内容
本发明旨在提供一种基于滤波误差法的非线性飞行动力学系统辨识方法,以解决现有滤波误差法因求解Riccati方程带来的适用范围受到极大限制的的问题。
本发明提供的一种基于滤波误差法的非线性飞行动力学系统辨识方法,包括如下步骤:
步骤S100,将飞行动力学方程转换为含有加性过程噪声和测量噪声的非线性动力学系统,构建待辨识的模型参数θ,所述待辨识的模型参数θ由系统参数、初始状态和滤波增益参数构成;
步骤S200,对于给定的测量噪声协方差矩阵R,采用Gauss-Newton法最小化负对数似然函数,获得所述待辨识的模型参数θ的最大似然估计;
步骤S300,估计测量噪声协方差矩阵R;
步骤S400,重复步骤S200和S300直至收敛,得到非线性飞行动力学系统辨识结果。
进一步的,步骤S100包括如下子步骤:
步骤S101,将飞行动力学方程写成如下含有加性过程噪声和测量噪声的非线性动力学系统:
x(t)=f[x(t),u(t),β]+w(t) (1)
y(t)=g[x(t),u(t),β] (2)
z(tk)=y(tk)+v(tk),k=1,2,…,N (3)
式中,x为n维状态向量;y为m维观测向量;u为l维控制向量;β为p维待辨识的系统参数;z为观测向量在N个离散时间点上的测量值,tk为第k个离散时间点;系统函数f和g分别为n维和m维非线性实数值向量函数;w为过程噪声、v为测量噪声;
步骤S102,构建待辨识的模型参数θ,表示为:
Figure BDA0003249183550000031
式中,β为系统参数;x0为非线性飞行动力学系统初始状态;λ为滤波增益参数;上标“T”表示向量或矩阵的转置。
进一步的,步骤S200包括如下子步骤:
步骤S201,采用负对数似然函数作为非线性飞行动力学系统辨识的判据函数J(θ):
Figure BDA0003249183550000032
式中,R为测量噪声防方差矩阵;
步骤S202,采用一阶近似的线性化Kalman滤波器对非线性飞行动力学系统进行状态估计:
状态预测方程为:
Figure BDA0003249183550000041
状态校正方程为:
Figure BDA0003249183550000042
观测方程为:
Figure BDA0003249183550000043
式中,K为Kalman滤波器的滤波增益矩阵;
步骤S203,采用中心差分计算观测量对待辨识的模型参数θ的灵敏度:
Figure BDA0003249183550000044
其中,δθj为待辨识的模型参数θ中的未知变量θj上的小扰动;
Figure BDA0003249183550000045
Figure BDA0003249183550000046
分别为在小扰动+δθj和-δθj作用下的响应变量。对于待辨识的模型参数θ中的每一个未知变量上的小扰动±δθj,可以采用与步骤S202中的状态估计类似的扰动系统方程计算得到扰动响应变量
Figure BDA0003249183550000047
Figure BDA0003249183550000048
步骤S204,采用Gauss-Newton法修正待辨识的模型参数θ:
Figure BDA0003249183550000049
Figure BDA00032491835500000410
式中,上标“(l)”表示第l步迭代,
Figure BDA00032491835500000411
表示第l步迭代的非线性飞行动力学系统辨识结果,Δθ表示待辨识的模型参数θ的修正量;
步骤S205,重复执行步骤S202~S204直至收敛,获得待辨识的模型参数θ的最大似然估计。
进一步的,步骤S300中的测量噪声协方差矩阵R采用下式进行估计:
Figure BDA00032491835500000412
进一步的,所述基于滤波误差法的非线性飞行动力学系统辨识方法还包括:
步骤S500,计算非线性飞行动力学系统辨识结果的不确定度。
进一步的,所述计算非线性飞行动力学系统辨识结果的不确定度的方法包括如下子步骤:
步骤S501,在有色残差下,非线性飞行动力学系统参数辨识结果
Figure BDA0003249183550000051
的修正协方差矩阵为:
Figure BDA0003249183550000052
式中,M为信息矩阵;S(i)为观测灵敏度;Rυυ(i-j)为输出残差的自相关函数;υ(i)为输出残差;分别采用下式计算:
Figure BDA0003249183550000053
Figure BDA0003249183550000054
Figure BDA0003249183550000055
υ(i)=z(ti)-y(ti) (17)
步骤S502,非线性飞行动力学系统参数辨识结果
Figure BDA0003249183550000056
的标准差
Figure BDA0003249183550000057
为修正协方差矩阵
Figure BDA0003249183550000058
中对角线元素的平方根:
Figure BDA0003249183550000059
步骤S503,置信水平0.95的非线性飞行动力学系统辨识结果
Figure BDA00032491835500000510
的不确定度为:
Figure BDA00032491835500000511
式中,
Figure BDA00032491835500000512
为置信水平0.95的非线性飞行动力学系统辨识结果
Figure BDA00032491835500000513
的不确定度。
综上所述,由于采用了上述技术方案,本发明的有益效果是:
本发明通过含有过程噪声和测量噪声的非线性飞行动力学系统,将滤波增益矩阵中的元素作为未知参数,与系统参数和初始状态共同构成待辨识的模型参数,并采用松弛迭代法交替估计待辨识的模型参数和测量噪声协方差矩阵,从而具有以下优点:(1)适用范围更广、实用性更强。不仅适用于稳定飞行器,而且适用于中立稳定和不稳定飞行器;不仅适用于弱到中等非线性动力学系统,而且适用于强非线性动力学系统。(2)实现更便捷。无需求解Riccati方程,在现有的输出误差算法框架下,只需将滤波增益增补为待辨识的模型参数,并在状态预测中增加校正步骤即可实现。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中的附图作简单地介绍,应当理解,以下附图仅示出了本发明的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。
图1为本发明的基于滤波误差法的非线性飞行动力学系统辨识方法的流程图。
图2为本发明实施例的基于滤波误差法的非线性飞行动力学系统辨识方法应用的详细流程图。
图3为示例一中的有噪声和无噪声下的飞机响应展示图。
图4为示例一种的Monte-Carlo仿真辨识结果分布图。
图5a为示例一中的输出误差法的仿真辨识拟合结果展示图。
图5b为示例一中的本发明基于滤波误差法的非线性飞行动力学系统辨识方法的仿真辨识拟合结果展示图。
图6为示例二中的一次偏航激励机动中的参数展示图。
图7为示例二中的模型飞行试验气动参数辨识结果展示图。
图8a为示例二中机动3的辨识拟合结果展示图。
图8b为示例二中机动11的辨识拟合结果展示图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。
因此,以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围,而是仅仅表示本发明的选定实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
实施例
如图1所示,本实施例提出一种基于滤波误差法的非线性飞行动力学系统辨识方法,包括:
步骤S100,将飞行动力学方程转换为含有加性过程噪声和测量噪声的非线性动力学系统,构建待辨识的模型参数θ,所述待辨识的模型参数θ由系统参数、初始状态和滤波增益参数构成。具体包括如下子步骤:
步骤S101,将飞行动力学方程写成如下含有加性过程噪声和测量噪声的非线性动力学系统:
x(t)=f[x(t),u(t),β]+w(t) (1)
y(t)=g[x(t),u(t),β] (2)
z(tk)=y(tk)+v(tk),k=1,2,…,N (3)
式中,x为n维状态向量;y为m维观测向量;u为l维控制向量;β为p维待辨识的系统参数;z为观测向量在N个离散时间点上的测量值,tk为第k个离散时间点;系统函数f和g分别为n维和m维非线性实数值向量函数;w为过程噪声、v为测量噪声。
步骤S102,对于飞行器飞行试验,用于气动参数辨识的激励机动时间通常较短,因此可以合理地假设滤波增益矩阵K是不变的。本步骤将滤波增益矩阵K中的元素(即滤波增益参数)记为向量λ,于是,可以构建待辨识的模型参数θ,表示为:
Figure BDA0003249183550000081
式中,x0为非线性飞行动力学系统初始状态;上标“T”表示向量或矩阵的转置,即βT为系统参数β的转置、
Figure BDA0003249183550000082
为的初始状态x0转置、λT为滤波增益参数λ的转置。换言之,所述待辨识的模型参数θ由系统参数β、初始状态x0、滤波增益参数λ构成。
步骤S200,对于给定的测量噪声协方差矩阵R,采用Gauss-Newton法最小化负对数似然函数,获得所述待辨识的模型参数θ的最大似然估计。具体包括如下子步骤:
步骤S201,采用负对数似然函数作为非线性飞行动力学系统辨识的判据函数J(θ):
Figure BDA0003249183550000083
式中,R为测量噪声协方差矩阵;
步骤S202,由于需要考虑过程噪声,因此必须采用合适的状态估计器。对于线性系统,Kalman滤波器是一种最优的状态估计器。对于本实施例在步骤S100中提出的非线性动力学系统(1)~(3),则采用一阶近似的线性化Kalman滤波器对非线性飞行动力学系统进行状态估计:
状态预测方程为:
Figure BDA0003249183550000084
状态校正方程为:
Figure BDA0003249183550000085
观测方程为:
Figure BDA0003249183550000091
式中,K为Kalman滤波器的滤波增益矩阵;
步骤S203,观测灵敏度
Figure BDA0003249183550000092
可以使用解析微分或有限差分近似进行计算。对于线性系统,通常采用解析微分法来计算灵敏度。然而,这需要通过对动力学系统中方程(1)和(2)求偏微分得到灵敏度方程的显式解,此外,还需要滤波增益矩阵的梯度。对于非线性动力学系统,针对每个新的非线性模型形式,都需要根据系统模型修改计算程序,这是十分繁琐甚至不可行的。而通过灵敏度的有限差分近似,则可以消除这些实际困难。因此本发明采用中心差分来计算观测量对待辨识的模型参数θ的灵敏度:
Figure BDA0003249183550000093
其中,δθj为待辨识的模型参数θ中的未知变量θj上的小扰动;
Figure BDA0003249183550000094
Figure BDA0003249183550000095
分别为在小扰动+δθj和-δθj作用下的响应变量。对于待辨识的模型参数θ中的每一个未知变量上的小扰动±δθj,采用与步骤S202中的状态估计(方程(6)~(8))类似的扰动系统方程计算得到扰动响应变量
Figure BDA0003249183550000096
Figure BDA0003249183550000097
对于系统参数β的每一个元素,扰动状态变量和扰动观测变量可以按照下式进行演化:
Figure BDA0003249183550000098
Figure BDA0003249183550000099
Figure BDA00032491835500000910
δβ为系统参数β上的小扰动,式(10)中扰动状态变量预测值
Figure BDA00032491835500000911
通过数值积分进行计算,式(11)中扰动状态变量校正值
Figure BDA00032491835500000912
和式(12)中扰动观测变量yp的计算非常简单。对于待辨识的模型参数θ的其他元素,即初始状态x0、滤波增益参数λ,考虑相应的扰动,采用与方程(11)~(12)类似的方法进行演化。
因此,将有限差分近似推广到滤波算法中时,针对待辨识的模型参数θ的每个元素,需要对扰动状态方程进行数值积分。这一变化带来的计算量的增加不会很大,即使是使用PC机,通常也能在数十秒内完成这些计算。
步骤S204,采用Gauss-Newton法修正待辨识的模型参数θ:
Figure BDA0003249183550000101
Figure BDA0003249183550000102
式中,上标“(l)”表示第l步迭代,
Figure BDA0003249183550000103
表示第l步迭代的非线性飞行动力学系统辨识结果,Δθ表示待辨识的模型参数θ的修正量;
步骤S205,重复执行步骤S202~S204直至收敛,获得待辨识的模型参数θ的最大似然估计。换言之,在给定测量噪声协方差矩阵R的情况下,采用Gauss-Newton法优化判据函数(5),辨识得到模型参数θ的最大似然估计。
步骤S300,估计测量噪声协方差矩阵R,具体可以采用下式对测量噪声协方差矩阵R进行估计:
Figure BDA0003249183550000104
步骤S400,重复执行步骤S200~S300直至收敛,得到非线性飞行动力学系统辨识结果。换言之,待辨识的模型参数θ和测量噪声协方差矩阵R的估计采用两步松弛迭代技术,第一步,在给定测量噪声协方差矩阵R的情况下,采用Gauss-Newton法优化判据函数(5),辨识出模型参数θ,第二步,由式(15)估计测量噪声协方差矩阵R。两步估计交替进行,直至收敛即可得到非线性飞行动力学系统辨识结果。
进一步的,本实施例还提出了辨识准度估计方法,即上述的基于滤波误差法的非线性飞行动力学系统辨识方法还包括:
步骤S500,计算非线性飞行动力学系统辨识结果的不确定度。具体包括如下子步骤:
步骤S501,在有色残差下,非线性飞行动力学系统参数辨识结果
Figure BDA0003249183550000111
的修正协方差矩阵为:
Figure BDA0003249183550000112
式中,M为信息矩阵;S(i)为观测灵敏度;Rυυ(i-j)为输出残差的自相关函数;υ(i)为输出残差。分别采用下式计算:
Figure BDA0003249183550000113
Figure BDA0003249183550000114
Figure BDA0003249183550000115
υ(i)=z(ti)-y(ti) (20)
步骤S502,非线性飞行动力学系统参数辨识结果
Figure BDA0003249183550000116
的标准差
Figure BDA0003249183550000117
为修正协方差矩阵
Figure BDA0003249183550000118
中对角线元素的平方根:
Figure BDA0003249183550000119
步骤S503,置信水平0.95的非线性飞行动力学系统辨识结果
Figure BDA00032491835500001113
的不确定度为:
Figure BDA00032491835500001110
式中,
Figure BDA00032491835500001111
为置信水平0.95的非线性飞行动力学系统辨识结果
Figure BDA00032491835500001112
的不确定度。需要说明的是,本实施例只是优选置信水平为0.95,当置信水平为其他值时,可以相应地调整式(21)的系数。
以下通过对上述的基于滤波误差法的非线性飞行动力学系统辨识方法的步骤S100~S500的具体应用进一步详述:
对于飞行器非线性动力学系统辨识,采用刚体六自由度动力学方程作为状态方程,其中线位移动力学方程建立在速度系下,角位移动力学方程通常建立在体轴系下。这种处理方法的优点是,所有状态变量均有测量数据,换言之,状态变量集是观测变量集的一个子集,滤波增益矩阵K的主元与次元分明,在大多数情况下可以只辨识主元,而将次元设置为0。
对于完整的六自由度动力学方程,状态向量xT=(V,α,β,p,q,r,θ,ψ,φ),观测向量yT=(V,α,β,p,q,r,ax,ay,az,θ,ψ,φ)。
状态方程:
Figure BDA0003249183550000121
Figure BDA0003249183550000122
Figure BDA0003249183550000123
Figure BDA0003249183550000124
Figure BDA0003249183550000125
Figure BDA0003249183550000126
Figure BDA0003249183550000127
Figure BDA0003249183550000131
Figure BDA0003249183550000132
式中,V为飞行速度;α为迎角;β为侧滑角;p,q,r为体轴系角速率分量;θ,ψ,φ为俯仰、偏航、滚转姿态角;
Figure BDA0003249183550000133
为动压;ρ为大气密度;c,l分别为纵向和横侧向参考长度;S为参考面积;m为飞行器质量;Jx,Jy,Jz,Jxz为相对于体轴的转动惯量和惯性积;
Figure BDA0003249183550000134
CD,CL,CC为速度系气动力系数;Cl,Cm,Cn为体轴系气动力矩系数;Fe为发动机推力,假设沿飞行器纵轴;wi为过程噪声。
观测方程:
Vm=V+vV (24a)
αm=α+vα (24b)
βm=β+vβ (24c)
pm=p+vp (24d)
qm=q+vq (24e)
rm=r+vr (24f)
Figure BDA0003249183550000135
Figure BDA0003249183550000136
Figure BDA0003249183550000137
θm=θ+vθ (24j)
ψm=ψ+vψ (24k)
φm=φ+vφ (24l)
式中,下标“m”表示测量值;nx,ny,nz为体轴系过载(即用重力加速度g无因次化的线加速度,其中nx沿体轴xb为正,ny沿体轴yb为正,nz沿体轴zb反方向为正);CA,CN,CY为体轴系气动力系数;vi为观测噪声。
速度系与体轴系气动力系数的关系式为:
CD=CA cosαcosβ-CYsinβ+CNsinαcosβ (25a)
CL=-CA sinα+CNcosα (25b)
CC=CA cosαsinβ+CYcosβ+CNsinαsinβ (25c)
体轴系气动力和力矩系数采用线性模型:
Figure BDA0003249183550000141
Figure BDA0003249183550000142
Figure BDA0003249183550000143
Figure BDA0003249183550000144
Figure BDA0003249183550000145
Figure BDA0003249183550000146
式中,δe,δr,δa分别为升降舵、方向舵、副翼偏角;M为马赫数;a为声速。
对于式(23)~(26)所描述的非线性飞行动力学系统,应用上述的基于滤波误差法的非线性飞行动力学系统辨识方法的步骤S100~S500,就可以进行气动参数辨识,并给出辨识结果的不确定度。如图2所示,具体如下:
Box 1:输入初始数据。包括:1)输入飞行器主要物理、几何参数;2)输入飞行试验实测数据;3)指定状态变量和观测变量;4)指定待辨识参数。
Box 2:确定待辨识模型参数的初值θ(0)。包括:气动参数(对应系统参数向量)、初始状态、滤波增益矩阵的辨识起始值。其中,气动参数取地面预测结果或方程误差法辨识结果,初始状态取实测结果,滤波增益矩阵主元(KV,V,Kα,α,Kβ,β,Kp,p,Kq,q,Kr,r,Kθ,θ,Kψ,ψ,Kφ,φ)取[0,1]区间的小正值(例如0.2),其他元素取为0。
Box 3:初步估计测量噪声协方差矩阵R。采用现有方法(如Morelli E.Estimatingnoise characteristics from flight test data using optimal Fouriersmoothing.Journal ofAircraft,1995,32(4):689-695)先初步估计测量噪声协方差矩阵。
Box 4:计算判据函数初值J(0)。利用松弛迭代得到的θ和R,由式(6)~(8)进行状态预测和校正以及观测量预测,得到y(tk),再由式(5)计算J(0)
Box 5:状态预测与校正,计算观测量y(tk)。利用第l-1次迭代得到的参数θ(l-1)和R,由式(6)~(8)进行状态预测和校正以及观测量预测,得到y(tk)。
Box 6:计算观测灵敏度
Figure BDA0003249183550000151
采用中心差分法,由式(9)计算观测灵敏度
Figure BDA0003249183550000152
其中扰动量δθj取为max(10-6j|,10-8)。
Box 7:计算待辨识参数修正量Δθ。利用松弛迭代得到的R、观测量实测值z(tk)、Box 5计算得到的y(tk)、以及Box 6计算得到的
Figure BDA0003249183550000153
由式(14)计算待辨识参数修正量Δθ。
Box 8:计算判据函数J(l)。利用松弛迭代得到的R、观测量实测值z(tk)、以及Box 5计算得到的y(tk),由式(5)计算判据函数J(l)。若J(l)<J(l-1)且|[J(l)-J(l-1)]/J(l-1)|<ε,则Gauss-Newton迭代收敛。ε为设定阈值,根据需求设定。
Box 9:修正Δθ。若J(l)>J(l-1),将减小步长,重新计算J(l),直至J(l)<J(l-1)
Box 10:估计测量噪声协方差矩阵R。Gauss-Newton迭代收敛后,比较当前准则函数值J(l)与前一步松弛迭代的判据函数Jpre,若|[J(l)-Jpre]/Jpre|<ε,则松弛迭代收敛,否则,由式(15)估计测量噪声协方差矩阵R,并令Jpre=J(l),进行下一次Gauss-Newton迭代。
Box 11:计算参数估计的不确定度
Figure BDA0003249183550000154
利用松弛迭代得到的R、观测量实测值z(tk)、Box 5计算得到的y(tk)、以及Box 6计算得到的
Figure BDA0003249183550000155
由式(16)~(22)计算参数估计的不确定度
Figure BDA0003249183550000161
Box 12:输出辨识结果。包括但不限于:1)输出待辨识模型参数的估计值
Figure BDA0003249183550000162
及其不确定度
Figure BDA0003249183550000163
2)输出观测量预测值y(tk);3)输出观测噪声协方差矩阵R。
在实际的气动参数辨识飞行试验中,纵向激励和横侧向激励往往是分别施加的,此时需要根据激励机动的具体情况,选择部分变量作为状态量和观测量,相应地选择部分气动参数、初始状态、滤波增益矩阵元素作为待辨识参数。
以下通过具体示例对本发明的基于滤波误差法的非线性飞行动力学系统辨识方法的步骤S100~S500的有益效果进行说明。
示例一:飞行仿真气动参数辨识
采用VFW-614ATTAS纵向飞行仿真数据,研究本发明的基于滤波误差法的非线性飞行动力学系统辨识方法在受控环境中的性能。飞行仿真初始状态为:高度h0=2517.2m,速度V0=130m/s,迎角α0=1.9°,俯仰角速率q0=0°/s,俯仰角θ0=1.75°。
仿真采用的气动力模型为:
Figure BDA0003249183550000164
Figure BDA0003249183550000165
Figure BDA0003249183550000166
气动参数基准值采用飞行试验数据辨识结果。
采用升降舵“3211”输入,以激发飞机的纵向运动模态。仿真计算过程中加入过程噪声,在仿真输出上加载测量噪声,过程噪声和测量噪声均为Gauss白噪声,其标准差列于表1。采样时间步长为40ms。
表1,飞行仿真过程噪声和测量噪声标准差:
Figure BDA0003249183550000167
Figure BDA0003249183550000171
共进行300次仿真,图3给出了仿真所采用的升降舵偏输入以及其中一次的仿真结果与无噪声结果的比较。可见,在过程噪声的影响下,飞行状态参数存在偏离无噪声结果的情况。
针对300次仿真结果,分别采用输出误差法和本发明的基于滤波误差法的非线性飞行动力学系统辨识方法开展气动参数辨识。辨识模型的状态方程为:
Figure BDA0003249183550000172
Figure BDA0003249183550000173
Figure BDA0003249183550000174
Figure BDA0003249183550000175
观测方程为:
Vm=V+vV (29a)
αm=α+vα (29b)
qm=q+vr (29c)
Figure BDA0003249183550000176
θm=θ+vθ (29e)
气动力模型为:
Figure BDA0003249183550000177
Figure BDA0003249183550000178
Figure BDA0003249183550000179
速度系气动力系数(CD,CL)与体轴系气动力系数(CA,CN)的关系式为:
CD=CA cos+CN sinα (31a)
CL=-CA sinα+CNcosα (31b)
待辨识的模型参数为:
Figure BDA0003249183550000181
图4显示了俯仰控制导数
Figure BDA0003249183550000182
和俯仰阻尼导数Cmq辨识结果的分布情况,可见Monte-Carlo仿真辨识结果近似服从正态分布。从两种方法对比来看,辨识结果均值相近,但本发明的基于滤波误差法的非线性飞行动力学系统辨识方法的散布范围明显较小。
表2列出了Monte-Carlo仿真辨识结果的统计特性,其中“均值”表示参数估计值的统计平均值,“2σ”表示参数估计值统计标准差的2倍,“平均U95”表示不确定度U95的统计平均值。表中还给出了气动参数的基准值。可见,两种方法辨识结果的均值都接近于基准值,但本发明的基于滤波误差法的非线性飞行动力学系统辨识方法的2σ显著小于输出误差法,这与图2所示分布情况是一致的。本发明的基于滤波误差法的非线性飞行动力学系统辨识方法的平均U95也小于输出误差法。
表2,Monte-Carlo仿真辨识结果统计特性:
Figure BDA0003249183550000183
图5a、图5b给出了其中一次的仿真辨识拟合结果,即辨识模型输出与仿真响应数据的比较。本发明的本发明的基于滤波误差法的非线性飞行动力学系统辨识方法由于增加了状态校正,辨识拟合结果明显好于输出误差法。
上述仿真辨识结果表明,在受过程噪声影响的情况下,本发明的本发明的基于滤波误差法的非线性飞行动力学系统辨识方法的辨识结果比输出误差法更可信。
示例二:
中国空气动力研究与发展中心利用缩比模型飞行试验,开展了一飞机布局的气动参数辨识飞行试验。飞行高度为1500~2000m,飞行速度为45~60m/s。测量参数包括体轴系线加速度和角速率、姿态角、操纵面偏转角、GPS位置和速度、气流角、静压、动压以及发动机转子的转速等,采样频率为100Hz。
为了辨识气动稳定和控制导数,分别在俯仰、偏航、滚转通道加载连续三个偶极方波激励,以激发试验模型的相关运动模态。进行了4个架次的飞行试验,共39个激励机动。从飞行试验数据来看,试验模型存在程度不同的持续“颠簸”现象,初步判断飞行空域有轻度到中度湍流。
本示例使用13个偏航激励机动飞行数据辨识航向气动参数。辨识模型的状态方程为:
Figure BDA0003249183550000191
Figure BDA0003249183550000192
观测方程为:
βm=β+vβ (34a)
rm=r+vr (34b)
Figure BDA0003249183550000201
气动力模型为:
Figure BDA0003249183550000202
Figure BDA0003249183550000203
速度系气动力系数CC与体轴系气动力系数CY的关系式为:
CC=CA cosαsinβ+CY cosβ+CN sinαsinβ (36)
待辨识参数为:
Figure BDA0003249183550000204
由于大气湍流和阵风等的影响,飞行试验中三通道之间的耦合较严重。图6给出了一次偏航激励机动中的舵偏角和角速率,可见机动过程中,湍流和阵风等产生俯仰和滚转扰动,飞控系统需要偏转升降舵和副翼以抑制扰动。因此,在辨识模型中需要考虑俯仰和滚转对偏航运动的影响,一种简单而实用的方法是,在方程(32)~(35)中,除状态参数β和r外,其他参数(V,α,p,q,θ,φ)取为实测数据。
分别采用输出误差法和本发明的基于滤波误差法的非线性飞行动力学系统辨识方法进行气动参数辨识。图7给出了主要气动参数
Figure BDA0003249183550000205
Figure BDA0003249183550000206
的辨识结果及其置信水平0.95不确定度。可见,本发明的基于滤波误差法的非线性飞行动力学系统辨识方法的辨识结果的散布范围总体上小于输出误差法。图中还给出了本发明的基于滤波误差法的非线性飞行动力学系统辨识方法的辨识结果的均值,用虚线表示。值得注意的是,对于本发明的基于滤波误差法的非线性飞行动力学系统辨识方法,辨识结果均值基本位于各次机动辨识结果的不确定度范围内,表明不确定度估计结果是合理的。很显然,输出误差法不具备这一特性。尽管输出误差法不确定度估计也是采用有色残差情况下的修正协方差方法,但由于辨识模型对实测数据的拟合较差,严重背离了参数辨识方法的适用条件,导致不确定度估计结果不可信。
图8a、图8b给出了机动3和机动11的辨识拟合结果。本发明的基于滤波误差法的非线性飞行动力学系统辨识方法对测量数据的拟合都很好。从输出误差法的辨识拟合结果来看,机动3的拟合较差,相应地,辨识结果的不确定度较大,而机动11的拟合较好,辨识结果不确定度也相应地较小,初步判断这是由不同湍流强度造成的。
表3列出了滤波增益矩阵主元Kβ,β和Kr,r的辨识结果及其不确定度,其他元素取为0。与估计值相比,不确定度较小,说明判据函数对滤波增益较敏感,辨识结果是可靠的。
表3,飞行试验滤波增益辨识结果:
Figure BDA0003249183550000211
上述辨识结果和分析表明,对于湍流中的飞行试验,本发明的基于滤波误差法的非线性飞行动力学系统辨识方法的辨识结果优于输出误差法。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (6)

1.一种基于滤波误差法的非线性飞行动力学系统辨识方法,其特征在于,包括如下步骤:
步骤S100,将飞行动力学方程转换为含有加性过程噪声和测量噪声的非线性动力学系统,构建待辨识的模型参数θ,所述待辨识的模型参数θ由系统参数、初始状态和滤波增益参数构成;
步骤S200,对于给定的测量噪声协方差矩阵R,采用Gauss-Newton法最小化负对数似然函数,获得所述待辨识的模型参数θ的最大似然估计;
步骤S300,估计测量噪声协方差矩阵R;
步骤S400,重复执行步骤S200~S300,直至收敛,得到非线性飞行动力学系统辨识结果。
2.根据权利要求1所述的基于滤波误差法的非线性飞行动力学系统辨识方法,其特征在于,步骤S100包括如下子步骤:
步骤S101,将飞行动力学方程写成如下含有加性过程噪声和测量噪声的非线性动力学系统:
x(t)=f[x(t),u(t),β]+w(t) (1)
y(t)=g[x(t),u(t),β] (2)
z(tk)=y(tk)+v(tk),k=1,2,…,N (3)
式中,x为n维状态向量;y为m维观测向量;u为l维控制向量;β为p维待辨识的系统参数;z为观测向量在N个离散时间点上的测量值,tk为第k个离散时间点;系统函数f和g分别为n维和m维非线性实数值向量函数;w为过程噪声、v为测量噪声;
步骤S102,构建待辨识的模型参数θ,表示为:
Figure FDA0003249183540000011
式中,β为系统参数;x0为非线性飞行动力学系统初始状态;λ为滤波增益参数;上标“T”表示向量或矩阵的转置。
3.根据权利要求2所述的基于滤波误差法的非线性飞行动力学系统辨识方法,其特征在于,步骤S200中包括如下子步骤:
步骤S201,采用负对数似然函数作为非线性飞行动力学系统辨识的判据函数J(θ):
Figure FDA0003249183540000021
式中,R为测量噪声协方差矩阵;
步骤S202,采用一阶近似的线性化Kalman滤波器对非线性飞行动力学系统进行状态估计:
状态预测方程为:
Figure FDA0003249183540000022
状态校正方程为:
Figure FDA0003249183540000023
观测方程为:
Figure FDA0003249183540000024
式中,K为Kalman滤波器的滤波增益矩阵;
步骤S203,采用中心差分计算观测量对待辨识的模型参数θ的灵敏度:
Figure FDA0003249183540000025
其中,δθj为待辨识的模型参数θ中的未知变量θj上的小扰动;yi,p+和yi,p-分别为在小扰动+δθj和-8θj作用下的响应变量;
步骤S204,采用Gauss-Newton法修正待辨识的模型参数θ:
Figure FDA0003249183540000026
Figure FDA0003249183540000031
式中,上标“(l)”表示第l步迭代,
Figure FDA0003249183540000032
表示第l步迭代的非线性飞行动力学系统辨识结果,Δθ表示待辨识的模型参数θ的修正量;
步骤S205,重复执行步骤S202~S204直至收敛,获得待辨识的模型参数θ的最大似然估计。
4.根据权利要求3所述的基于滤波误差法的非线性飞行动力学系统辨识方法,其特征在于,步骤S300中的测量噪声协方差矩阵R采用下式进行估计:
Figure FDA0003249183540000033
5.根据权利要求1-4任一项所述的基于滤波误差法的非线性飞行动力学系统辨识方法,其特征在于,所述基于滤波误差法的非线性飞行动力学系统辨识方法还包括:
步骤S500,计算非线性飞行动力学系统辨识结果的不确定度。
6.根据权利要求5所述的基于滤波误差法的非线性飞行动力学系统辨识方法,其特征在于,所述计算非线性飞行动力学系统辨识结果的不确定度的方法包括如下子步骤:
步骤S501,在有色残差下,非线性飞行动力学系统参数辨识结果
Figure FDA0003249183540000035
的修正协方差矩阵为:
Figure FDA0003249183540000034
式中,M为信息矩阵;S(i)为观测灵敏度;Rυυ(i-j)为输出残差的自相关函数;υ(i)为输出残差;分别采用下式计算:
Figure FDA0003249183540000041
Figure FDA0003249183540000042
Figure FDA0003249183540000043
υ(i)=z(ti)-y(ti) (17)
步骤S502,非线性飞行动力学系统参数辨识结果
Figure FDA0003249183540000044
的标准差
Figure FDA0003249183540000045
为修正协方差矩阵
Figure FDA0003249183540000046
中对角线元素的平方根:
Figure FDA0003249183540000047
步骤S503,置信水平0.95的非线性飞行动力学系统辨识结果
Figure FDA0003249183540000048
的不确定度为:
Figure FDA0003249183540000049
式中,
Figure FDA00032491835400000410
为置信水平0.95的非线性飞行动力学系统辨识结果
Figure FDA00032491835400000411
的不确定度。
CN202111040968.3A 2021-09-07 2021-09-07 一种基于滤波误差法的非线性飞行动力学系统辨识方法 Active CN113919194B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111040968.3A CN113919194B (zh) 2021-09-07 2021-09-07 一种基于滤波误差法的非线性飞行动力学系统辨识方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111040968.3A CN113919194B (zh) 2021-09-07 2021-09-07 一种基于滤波误差法的非线性飞行动力学系统辨识方法

Publications (2)

Publication Number Publication Date
CN113919194A true CN113919194A (zh) 2022-01-11
CN113919194B CN113919194B (zh) 2023-05-02

Family

ID=79233950

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111040968.3A Active CN113919194B (zh) 2021-09-07 2021-09-07 一种基于滤波误差法的非线性飞行动力学系统辨识方法

Country Status (1)

Country Link
CN (1) CN113919194B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114896830A (zh) * 2022-07-14 2022-08-12 中国空气动力研究与发展中心计算空气动力研究所 导弹非线性非定常气动力微分方程模型辨识方法
CN117951922A (zh) * 2024-03-26 2024-04-30 西安现代控制技术研究所 一种远程制导火箭在线气动系数辨识方法

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101600772B1 (ko) * 2014-09-02 2016-03-09 한국항공우주연구원 비행 동역학 모델을 활용한 항공기 정밀 추적 방법
CN106487297A (zh) * 2016-11-24 2017-03-08 北京邮电大学 一种基于协方差匹配无迹卡尔曼滤波算法的pmsm参数辨识方法
CN109740209A (zh) * 2018-12-20 2019-05-10 北京空天技术研究所 高超声速飞行器参数在线辨识方法及使用其的力学模型
CN109858137A (zh) * 2019-01-25 2019-06-07 哈尔滨工业大学 一种基于可学习扩展卡尔曼滤波的复杂机动飞行器航迹估计方法
CN110532621A (zh) * 2019-07-30 2019-12-03 北京航空航天大学 一种飞行器气动参数在线辨识方法
CN111783307A (zh) * 2020-07-07 2020-10-16 哈尔滨工业大学 一种高超声速飞行器状态估计方法
CN112800543A (zh) * 2021-01-27 2021-05-14 中国空气动力研究与发展中心计算空气动力研究所 一种基于改进Goman模型的非线性非定常气动力建模方法
CN113111597A (zh) * 2021-02-26 2021-07-13 南京航空航天大学 一种基于飞行数据的大气数据和扰动风估计方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101600772B1 (ko) * 2014-09-02 2016-03-09 한국항공우주연구원 비행 동역학 모델을 활용한 항공기 정밀 추적 방법
CN106487297A (zh) * 2016-11-24 2017-03-08 北京邮电大学 一种基于协方差匹配无迹卡尔曼滤波算法的pmsm参数辨识方法
CN109740209A (zh) * 2018-12-20 2019-05-10 北京空天技术研究所 高超声速飞行器参数在线辨识方法及使用其的力学模型
CN109858137A (zh) * 2019-01-25 2019-06-07 哈尔滨工业大学 一种基于可学习扩展卡尔曼滤波的复杂机动飞行器航迹估计方法
CN110532621A (zh) * 2019-07-30 2019-12-03 北京航空航天大学 一种飞行器气动参数在线辨识方法
CN111783307A (zh) * 2020-07-07 2020-10-16 哈尔滨工业大学 一种高超声速飞行器状态估计方法
CN112800543A (zh) * 2021-01-27 2021-05-14 中国空气动力研究与发展中心计算空气动力研究所 一种基于改进Goman模型的非线性非定常气动力建模方法
CN113111597A (zh) * 2021-02-26 2021-07-13 南京航空航天大学 一种基于飞行数据的大气数据和扰动风估计方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
GAO ZHENXING等: "Air Data Estimation Based on Adaptive Kalman Filter" *
岑飞等: "民机极限飞行状态非定常气动力建模" *
边德勇: "一种共轴双旋翼直升机仿真动力学建模及系统开发" *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114896830A (zh) * 2022-07-14 2022-08-12 中国空气动力研究与发展中心计算空气动力研究所 导弹非线性非定常气动力微分方程模型辨识方法
CN117951922A (zh) * 2024-03-26 2024-04-30 西安现代控制技术研究所 一种远程制导火箭在线气动系数辨识方法

Also Published As

Publication number Publication date
CN113919194B (zh) 2023-05-02

Similar Documents

Publication Publication Date Title
CN113919194B (zh) 一种基于滤波误差法的非线性飞行动力学系统辨识方法
Wenz et al. Moving horizon estimation of air data parameters for UAVs
Lai et al. Adaptive learning-based observer with dynamic inversion for the autonomous flight of an unmanned helicopter
CN113670314B (zh) 基于pi自适应两级卡尔曼滤波的无人机姿态估计方法
Kokunko et al. Synthesis of a tracking system with restrictions on UAV state variables
Roh et al. Dynamic accuracy improvement of a MEMS AHRS for small UAVs
Wu et al. Simultaneous state and parameter estimation based actuator fault detection and diagnosis for an unmanned helicopter
Guo et al. Sins/gnss-integrated navigation of surface vessels based on various nonlinear kalman filters and large ship dynamics
CN115033844A (zh) 一种无人机状态估计方法、系统、设备及可读存储介质
Vanek et al. Geometric LPV fault detection filter design for commercial aircrafts
Cao et al. Discrete-time incremental backstepping controller for unmanned aircrafts subject to actuator constraints
Guisser et al. A high gain observer and sliding mode controller for an autonomous quadrotor helicopter
CN111412887B (zh) 一种基于卡尔曼滤波的攻角、侧滑角辨识方法
Sharifi et al. Multiple model filters applied to wind model estimation for a fixed wing UAV
Avanzini Frenet-based algorithm for trajectory prediction
Hough Autonomous aerobatic flight of a fixed wing unmanned aerial vehicle
Li et al. Air data estimation algorithm under unknown wind based on information fusion
Rasheed Grey box identification approach for longitudinal and lateral dynamics of UAV
D’Antuono et al. Estimation of aerodynamic angles and wind components for a launch vehicle
Hua et al. Introduction to nonlinear attitude estimation for aerial robotic systems
Guven et al. Two-Stage Kalman Filter Based Estimation of Boeing 747 Actuator/Control Surface Stuck Faults
Gao et al. Adaptive air-data estimation in wind disturbance based on flight data
Vaiopoulos et al. Online aerodynamic model identification on small fixed-wing UAVs with uncertain flight data
Mohammadkarimi et al. A model aided inertial navigation system for automatic landing of unmanned aerial vehicles
Garcia et al. Adaptive and resilient flight control system for a small unmanned aerial system

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