CN113126496A - 基于改进ekf状态观测器的飞行器自适应跟踪控制方法 - Google Patents
基于改进ekf状态观测器的飞行器自适应跟踪控制方法 Download PDFInfo
- Publication number
- CN113126496A CN113126496A CN202110402668.9A CN202110402668A CN113126496A CN 113126496 A CN113126496 A CN 113126496A CN 202110402668 A CN202110402668 A CN 202110402668A CN 113126496 A CN113126496 A CN 113126496A
- Authority
- CN
- China
- Prior art keywords
- representing
- aircraft
- neural network
- parameter
- designed
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
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
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Abstract
本发明涉及一种基于改进EKF状态观测器的飞行器自适应跟踪控制方法,属于飞行控制方法领域,用于解决飞行器存在随机测量噪声以及模型不确定性下的飞行器跟踪控制问题。考虑系统状态含有随机测量噪声,基于飞行器动力学模型和测量信号构建系统状态方程和量测方程,利用改进的EKF滤波器实现系统估计值的快速收敛;基于状态估计值,针对系统模型不确定设计自适应律,并通过最小参数估计方法估计神经网络权值向量的最大范数,基于Nussbaum函数设计实际控制输入,最终实现速度和高度的跟踪。本发明在考虑系统含有测量噪声的情况下实现了状态估计的快速收敛,并同时保证了飞行器在模型不确定下实现速度和高度的跟踪控制,具有工程应用参考价值。
Description
技术领域
本发明涉及一种飞行控制方法,特别是涉及基于改进EKF状态观测器的飞行器自适应跟踪控制方法,属于飞行控制方法领域。
背景技术
飞行控制系统设计是保证飞机安全飞行的重要基础。反步法常用于高阶飞行控制系统的设计,它通过设计中间虚拟控制量以递推的方式得到实际控制量,结构简单,但存在“复杂度爆炸”问题。为解决这个问题,动态面以及指令滤波被提出。此外,考虑实际系统存在模型不确定性,神经网络和模糊逻辑可以对任意非线性函数进行有效近似,因此常用于控制系统的设计。目前,大部分飞行控制方法都是基于系统状态可获得的假设条件,在实际工程中,由于传感器对环境变化敏感以及其固件自身磨损和老化,系统状态存在测量噪声。扩展卡尔曼滤波器(Extended Kalman Filter,EKF)可以基于已有测量信息实现系统真实状态估计,但收敛速度受到模型舍入误差和噪声大小的影响,较慢的收敛速度会降低系统控制性能。
《Unscented Kalman filter state estimation for manipulating unmannedaerial vehicles》(H.Bonyan Khamseh,S.Ghorbani,F.Janabi-Sharifi,《AerospaceScience and Technology》,2019年)分别设计了EKF和UKF实现系统状态估计,并基于状态估计值设计性能指标最优控制器实现稳定跟踪,仿真结果表明采用UKF和EKF都可以实现状态有效估计,并保证系统稳定跟踪。但是,EKF和UKF状态观测器的收敛速度受到初值和模型误差的影响,当考虑模型不确定时,系统的鲁棒性降低,达不到期望的控制效果。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种基于改进EKF状态观测器的飞行器自适应跟踪控制方法,以解决飞行器状态存在随机噪声以及模型不确定性时的跟踪控制问题。
技术方案
一种基于改进EKF状态观测器的飞行器自适应跟踪控制方法,其特征在于步骤如下:
步骤1:考虑飞行器纵向动力学模型为
其中,状态变量[V,h,γ,α,q]T分别表示速度、高度、航迹角、迎角和俯仰角速度;D、L和MA分别表示阻力、升力和俯仰力矩;m、Iy和g分别表示飞行器质量、y轴的转动惯量和重力加速度;T表示发动机推力;(1)-(5)中相关气动力和力矩的定义如下
其中,ρh表示空气密度;S表示机翼面积;表示平均气动弦长;表示动压;CL,CD和CM分别表示总的气动升力系数、阻力系数和俯仰力矩系数; 表示气动导数;li,i=1,…,8表示推力系数;zT表示推力力臂;输入变量[Φ,δe]T分别表示燃料当量比和升降舵偏角;
考虑测量噪声,系统测量信号为
其中,ni,i=1,…,5表示测量噪声,hm,γm,αm,qm,Vm表示测量信号;
步骤2:选择X=[V h γ α q]T为状态量,根据动力学模型(1)-(5)建立系统状态方程:
其中,w(t)=[dV(t) dh(t) dγ(t) dα(t) dq(t)]T表示过程噪声;f0(X,u,t)∈R5表示(1)-(5)的标称模型;u=[Φ,δe]T表示输入;
选择ym=[Vm hm γm αm qm]T为量测量,根据(6)建立量测方程
ym=CX+v(t) (8)
其中,C=I5表示量测阵;v(t)=[n1 n2 n3 n4 n5]T∈R5×1表示量测噪声;
信号w(t)和v(t)被建模为高斯白噪声,并满足
根据方程(7)-(9)构建连续扩展卡尔曼滤波器
步骤3:根据动力学模型(1),速度子系统转换成以下形式
定义x1=h,x2=γ,x3=θp,x4=q,飞行器高度子系统(2)-(5)转换成以下形式
其中,σV>0,μV>0,aV>0是待设计参数;
定义θh=||Wi||2,i=1,2,3,4,设计自适应律为
其中,σh>0,μh>0,ah>0是待设计参数;
步骤4:根据得到的控制输入[Φ,δe]返回到飞行动力学模型(1)-(5)中,实现高度和速度的稳定跟踪控制。
一种计算机系统,其特征在于包括:一个或多个处理器,计算机可读存储介质,用于存储一个或多个程序,其中,当所述一个或多个程序被所述一个或多个处理器执行时,使得所述一个或多个处理器实现上述的方法。
一种计算机可读存储介质,其特征在于存储有计算机可执行指令,所述指令在被执行时用于实现上述的方法。
一种计算机程序,其特征在于包括计算机可执行指令,所述指令在被执行时用于实现上述的方法。
有益效果
本发明提出的一种基于改进EKF状态观测器的飞行器自适应跟踪控制方法,如上述步骤2所示,该方法考虑飞行器全部状态含有随机测量噪声,通过设计改进的EKF滤波器估计系统真实状态,使状态估计值更快地收敛到真实值;如上述步骤3所示,基于状态估计值,在反步法框架下设计自适应控制器,利用神经网络实时估计飞行器的未知动力学,通过最小参数估计方法估计神经网络权值向量的最大范数,基于Nussbaum函数设计实际控制输入,最终实现速度和高度的跟踪。
本发明与现有技术相比有益效果为:
(1)本发明考虑了测量信号含有随机噪声,通过构建状态方程和量测方程设计一种改进的扩展卡尔曼滤波器,使得系统状态估计值能够更快地收敛到系统真实值。
(2)本发明考虑了飞行器存在模型不确定性,利用神经网络估计系统不确定部分,并通过最小参数估计方法估计理想权值向量的最大范数。此外,设计过程中不用再考虑设计一阶滤波器求虚拟控制量的导数,从而使得系统计算量大大减少。
(3)本发明考虑速度和高度的稳定跟踪,通过Nussbaum函数设计控制输入,并保证系统所有信号最终有界。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。
图1本发明一种基于改进EKF状态观测器的飞行器自适应跟踪控制方法流程图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图和实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本发明的一种基于改进EKF状态观测器的飞行器自适应跟踪控制方法流程图如图1所示,所发明内容用于实现考虑测量噪声以及模型不确定下飞行器的跟踪控制问题,其具体实施步骤如下:
步骤1:考虑飞行器纵向动力学模型为
其中,状态变量[V,h,γ,α,q]T分别表示速度、高度、航迹角、迎角和俯仰角速度;D、L和MA分别表示阻力、升力和俯仰力矩;m、Iy和g分别表示飞行器质量、y轴的转动惯量和重力加速度;T表示发动机推力。(1)-(5)中相关气动力和力矩的定义如下
其中,ρh表示空气密度;S表示机翼面积;表示平均气动弦长;表示动压;CL,CD和CM分别表示总的气动升力系数、阻力系数和俯仰力矩系数; 表示气动导数;li,i=1,…,8表示推力系数;zT表示推力力臂;输入变量[Φ,δe]T分别表示燃料当量比和升降舵偏角。
考虑测量噪声,系统测量信号为
其中,ni,i=1,…,5表示测量噪声,hm,γm,αm,qm,Vm表示测量信号。
步骤2:选择X=[V h γ α q]T为状态量,根据动力学模型(1)-(5)建立系统状态方程
其中,w(t)=[dV(t) dh(t) dγ(t) dα(t) dq(t)]T表示过程噪声;f0(X,u,t)∈R5表示(1)-(5)的标称模型;u=[Φ,δe]T表示输入。
选择ym=[Vm hm γm αm qm]T为量测量,根据(6)建立量测方程
ym=CX+v(t) (8)
其中,C=I5表示量测阵;v(t)=[n1 n2 n3 n4 n5]T∈R5×1表示量测噪声。
信号w(t)和v(t)被建模为高斯白噪声,并满足
根据方程(7)-(9)构建连续扩展卡尔曼滤波器
步骤3:根据动力学模型(1),速度子系统转换成以下形式
定义x1=h,x2=γ,x3=θp,x4=q,飞行器高度子系统(2)-(5)转换成以下形式
定义速度跟踪误差eV=V-Vd,其中,Vd表示速度指令。设计控制器为
其中,σV=0.01,μV=0.1,aV=1。
定义e2=x2-α1,设计虚拟控制器为
定义e3=x3-α2,设计虚拟控制器为
定义e4=x4-α3,设计实际控制输入为
定义θh=||Wi||2,i=1,2,3,4,设计自适应律为
其中,σh=0.01,μh=0.1,ah=105。
步骤4:根据得到的控制输入[Φ,δe]返回到飞行动力学模型(1)-(5)中,实现高度和速度的稳定跟踪控制。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明公开的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本发明的保护范围之内。
Claims (4)
1.一种基于改进EKF状态观测器的飞行器自适应跟踪控制方法,其特征在于步骤如下:
步骤1:考虑飞行器纵向动力学模型为
其中,状态变量[V,h,γ,α,q]T分别表示速度、高度、航迹角、迎角和俯仰角速度;D、L和MA分别表示阻力、升力和俯仰力矩;m、Iy和g分别表示飞行器质量、y轴的转动惯量和重力加速度;T表示发动机推力;(1)-(5)中相关气动力和力矩的定义如下
其中,ρh表示空气密度;S表示机翼面积;表示平均气动弦长;表示动压;CL,CD和CM分别表示总的气动升力系数、阻力系数和俯仰力矩系数; 表示气动导数;li,i=1,…,8表示推力系数;zT表示推力力臂;输入变量[Φ,δe]T分别表示燃料当量比和升降舵偏角;
考虑测量噪声,系统测量信号为
其中,ni,i=1,…,5表示测量噪声,hm,γm,αm,qm,Vm表示测量信号;
步骤2:选择X=[V h γ α q]T为状态量,根据动力学模型(1)-(5)建立系统状态方程:
其中,w(t)=[dV(t) dh(t) dγ(t) dα(t) dq(t)]T表示过程噪声;f0(X,u,t)∈R5表示(1)-(5)的标称模型;u=[Φ,δe]T表示输入;
选择ym=[Vm hm γm αm qm]T为量测量,根据(6)建立量测方程
ym=CX+v(t) (8)
其中,C=I5表示量测阵;v(t)=[n1 n2 n3 n4 n5]T∈R5×1表示量测噪声;
信号w(t)和v(t)被建模为高斯白噪声,并满足
根据方程(7)-(9)构建连续扩展卡尔曼滤波器
步骤3:根据动力学模型(1),速度子系统转换成以下形式
定义x1=h,x2=γ,x3=θp,x4=q,飞行器高度子系统(2)-(5)转换成以下形式
其中,σV>0,μV>0,aV>0是待设计参数;
其中,k1>0是控制增益参数,λ1>0是待设计参数;是Nussbaum函数; 是θh的估计值;θh和κh在后面设计中给出;F1=W1 TP1+ε1,W1表示神经网络权值,P1表示基函数向量,ε1表示神经网络近似误差;
其中,σh>0,μh>0,ah>0是待设计参数;
步骤4:根据得到的控制输入[Φ,δe]返回到飞行动力学模型(1)-(5)中,实现高度和速度的稳定跟踪控制。
2.一种计算机系统,其特征在于包括:一个或多个处理器,计算机可读存储介质,用于存储一个或多个程序,其中,当所述一个或多个程序被所述一个或多个处理器执行时,使得所述一个或多个处理器实现权利要求1所述的方法。
3.一种计算机可读存储介质,其特征在于存储有计算机可执行指令,所述指令在被执行时用于实现权利要求1所述的方法。
4.一种计算机程序,其特征在于包括计算机可执行指令,所述指令在被执行时用于实现权利要求1所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110402668.9A CN113126496B (zh) | 2021-04-14 | 2021-04-14 | 基于改进ekf状态观测器的飞行器自适应跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110402668.9A CN113126496B (zh) | 2021-04-14 | 2021-04-14 | 基于改进ekf状态观测器的飞行器自适应跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113126496A true CN113126496A (zh) | 2021-07-16 |
CN113126496B CN113126496B (zh) | 2022-10-28 |
Family
ID=76776562
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110402668.9A Active CN113126496B (zh) | 2021-04-14 | 2021-04-14 | 基于改进ekf状态观测器的飞行器自适应跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113126496B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2008051240A2 (en) * | 2005-11-18 | 2008-05-02 | Georgia Tech Research Corporation | System, apparatus and methods for augmenting filter with adaptive element |
CN109143859A (zh) * | 2018-08-29 | 2019-01-04 | 首都师范大学 | 一种基于非线性输出反馈系统的自适应一致性控制方法 |
CN111580540A (zh) * | 2020-06-21 | 2020-08-25 | 西北工业大学 | 基于Kalman滤波的变体飞行器T-S模糊控制方法 |
CN111736468A (zh) * | 2020-06-21 | 2020-10-02 | 西北工业大学 | 一种信息融合下的飞行器抗干扰控制方法 |
-
2021
- 2021-04-14 CN CN202110402668.9A patent/CN113126496B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2008051240A2 (en) * | 2005-11-18 | 2008-05-02 | Georgia Tech Research Corporation | System, apparatus and methods for augmenting filter with adaptive element |
CN109143859A (zh) * | 2018-08-29 | 2019-01-04 | 首都师范大学 | 一种基于非线性输出反馈系统的自适应一致性控制方法 |
CN111580540A (zh) * | 2020-06-21 | 2020-08-25 | 西北工业大学 | 基于Kalman滤波的变体飞行器T-S模糊控制方法 |
CN111736468A (zh) * | 2020-06-21 | 2020-10-02 | 西北工业大学 | 一种信息融合下的飞行器抗干扰控制方法 |
Non-Patent Citations (3)
Title |
---|
SHUAI LIANG,ET AL.: "Kalman-filter-based robust control for hypersonic flight vehicle with", 《AEROSPACE SCIENCE AND TECHNOLOGY》 * |
Y. LI,ET AL.: "Predefined-Time Asymptotic Tracking Control for Hypersonic Flight Vehicles With Input Quantization and Faults", 《IEEE TRANSACTIONS ON AEROSPACE AND ELECTRONIC SYSTEMS》 * |
李安平等: "一类非线性系统的自组织模糊神经网络控制", 《电机与控制学报》 * |
Also Published As
Publication number | Publication date |
---|---|
CN113126496B (zh) | 2022-10-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111665857A (zh) | 基于复合智能学习的变体飞行器控制方法 | |
CN111679583B (zh) | 基于气动参数估计的变体飞行器自适应控制方法 | |
CN111273681B (zh) | 一种考虑攻角受限的高超声速飞行器高安全抗干扰控制方法 | |
CN109164708B (zh) | 一种高超声速飞行器神经网络自适应容错控制方法 | |
CN111367182A (zh) | 考虑输入受限的高超声速飞行器抗干扰反步控制方法 | |
CN111736468B (zh) | 一种信息融合下的飞行器抗干扰控制方法 | |
CN108170127A (zh) | 一种无人机飞行控制系统的故障检测方法 | |
CN108873923B (zh) | 应急指挥控制固定翼无人机舰面紧急起飞控制方法 | |
CN114564045A (zh) | 一种考虑降雨和阵风条件的无人机飞行控制律设计方法 | |
CN113126497B (zh) | 考虑输入饱和的飞行器鲁棒跟踪控制方法 | |
CN116382071B (zh) | 深度学习网络修正补偿的气动参数智能辨识方法 | |
CN113126495B (zh) | 基于地效干扰补偿的低空飞行鲁棒智能控制方法 | |
CN113987894A (zh) | 一种基于降雨天气条件的无人机动力学建模方法 | |
Kumar et al. | Identification of helicopter dynamics using recurrent neural networks and flight data | |
CN111580540A (zh) | 基于Kalman滤波的变体飞行器T-S模糊控制方法 | |
CN114637312A (zh) | 一种基于智能变形决策的无人机节能飞行控制方法及系统 | |
CN113568423B (zh) | 一种考虑电机故障的四旋翼无人机智能容错控制方法 | |
CN108958278B (zh) | 一种空天飞行器巡航段快速抗干扰制导方法 | |
CN114115276A (zh) | 一种基于在线分组优化模型预测的船舶动力定位控制方法 | |
CN113625732A (zh) | 基于角加速度估计的增量反馈逆角速度控制律设计方法 | |
CN113126496B (zh) | 基于改进ekf状态观测器的飞行器自适应跟踪控制方法 | |
CN115685764B (zh) | 变翼展飞行器任务自适应的抗干扰跟踪控制方法及系统 | |
CN113110538A (zh) | 一种基于反步法控制的舰载机着舰固定时间容错控制方法 | |
Zhu et al. | Fault-tolerant control of hypersonic vehicles based on fast fault observer under actuator gain loss fault or stuck fault | |
CN116360255A (zh) | 一种非线性参数化高超声速飞行器的自适应调节控制方法 |
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 |