CN112947522B - 一种基于有限时间观测器的硬式空中加油姿态控制方法 - Google Patents
一种基于有限时间观测器的硬式空中加油姿态控制方法 Download PDFInfo
- Publication number
- CN112947522B CN112947522B CN202110184536.3A CN202110184536A CN112947522B CN 112947522 B CN112947522 B CN 112947522B CN 202110184536 A CN202110184536 A CN 202110184536A CN 112947522 B CN112947522 B CN 112947522B
- Authority
- CN
- China
- Prior art keywords
- oil filling
- filling pipe
- pipe
- observer
- oil
- 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 42
- 238000013178 mathematical model Methods 0.000 claims abstract description 12
- 238000005312 nonlinear dynamic Methods 0.000 claims abstract description 12
- 239000000945 filler Substances 0.000 claims description 32
- 230000001133 acceleration Effects 0.000 claims description 9
- 238000004458 analytical method Methods 0.000 claims description 9
- 238000009795 derivation Methods 0.000 claims description 9
- 238000005096 rolling process Methods 0.000 claims description 6
- 238000012938 design process Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000002860 competitive effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000005259 measurement Methods 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/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D39/00—Refuelling during flight
-
- 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)
- 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)
Abstract
本发明涉及一种基于有限时间观测器的硬式空中加油姿态控制方法,属于空中加油技术控制领域。所述方法包括:建立加油管的非线性动力学数学模型,并转换为状态空间模型;根据加油管的状态空间模型,设计状态观测器,将不确定干扰环境下加油管的姿态信息在有限时间内估计出来并反馈给加油管控制系统;基于有限时间状态观测器,设计加油管的反步终端滑模控制器,使加油管的姿态到达期望状态。该方法提出加油管的有限时间状态观测器思想,在存在扰动及不确定项的情况下,所设计的滑模观测器能够对加油管的状态变量进行实时估计,具有强鲁棒性,同时基于该状态观测器设计的控制器提高了加油管姿态控制的精度及性能。
Description
技术领域
本发明涉及硬式空中加油控制技术领域,具体涉及一种用于加油管姿态运动系统的滑模控制器设计方法。
背景技术
硬式空中加油技术由于加油速度快,可操控性强以及对受油机飞行员的要求低等,近年来成为世界各国竞相研究的热门技术。在硬式空中加油过程中,会受到风场等外部干扰的影响,对加油管的控制精度产生很大的影响。现有加油管姿态控制方法的研究中,多是针对加油管的线性模型进行某一确定状态点的控制器设计,这种控制方法在加油管的姿态在包线范围内容易产生较大偏差。为了解决线性控制器的不足,引入了非线性控制方法,目前采用较多的是滑模控制方法,然而,传统滑模控制方法由于滑模面的快速切换,会带来抖振现象,导致加油管姿态控制精度降低。
滑模观测器具有强鲁棒性以及设计简单等优势,被广泛应用。超螺旋滑模是一种典型的二阶滑模控制方法,能够在有限时间内达到稳定状态。基于超螺旋滑模设计的观测器能够在有限时间内,以及存在干扰和不确定项的情况下准确的估计出状态信息,并反馈给控制系统,消除了外部扰动及不确定项的影响。而且,对于扰动的上界是不需要知道的。基于状态观测器估计的状态信息,设计加油管的姿态控制器。采用反步终端滑模控制方法,使加油管的姿态控制器能够实现全局稳定以及在有限时间内达到期望姿态。
发明内容
要解决的技术问题
针对风场干扰以及加油管存在不确定项的情况下的姿态控制问题,本发明提出一种基于有限时间观测器的硬式空中加油姿态控制方法,设计出的滑模控制器能够在干扰环境下以及存在不确定项的情况下对加油管的姿态进行控制。
技术方案
在本发明中,引入高阶滑模方法对加油管进行姿态控制器的设计,显著提高了加油管的姿态控制效果。同时为了解决加油管姿态传感器测量过程中的噪声因素以及加油管建模的不确定项等,设计有限时间状态观测器对加油管的姿态信息进行观测,采用滑模观测器结构。
一种基于有限时间观测器的硬式空中加油姿态控制方法,其特征在于步骤如下:
步骤1:建立加油管的非线性动力学数学模型,并转换为状态空间模型
步骤1.1:根据能量法以及气动分析方法,建立加油管的非线性动力学数学模型
能量法建模:根据拉格朗日方程以及虚功原理,得到加油管俯仰力矩My以及滚转力矩Mx表达式如下式:
式中,M为加油管的质量,θ为加油管的俯仰角,为加油管的俯仰角速度,为加油管的俯仰角加速度,φ为加油管的滚转角,为加油管的滚转角速度,为加油管的滚转角加速度,l为加油管万向节到加油管质心的距离,I为加油管的惯性张量矩阵,具体为:Ix、Iy、Iz分别为绕x轴、y轴、z轴的转动惯量,Ixy、Ixz、Iyx、Iyz、Izx、Izy分别为绕xy、xz、yx、yz、zx、zy对应平面的转动惯量;
气动分析法建模:通过对加油管进行风速分解以及对加油管上方向舵以及升降舵产生的力进行分析,获得加油管俯仰力矩My以及滚转力矩Mx表达式如下式:
式中,V为加油管的飞行速度,ρ为空气密度,g为重力加速度,w为加油管的管径,δr为加油管方向舵的偏转角度,δe为加油管升降舵的偏转角度,Sr为加油管方向舵的面积,Se为加油管升降舵的面积,Cr为加油管方向舵的气动系数,Ce为加油管升降舵的气动系数;
将能量法与气动分析法获得的加油管力矩表达式进行联立,便可得到加油管完整的动力学数学表达式;
步骤1.2:将加油管的非线性动力学数学模型转换为状态空间模型
其中,
步骤2:根据加油管的状态空间模型,设计硬式空中加油对准过程中的有限时间状态观测器;
加油管俯仰通道的状态观测器为:
则:
对于加油管状态观测器采用超螺旋滑模结构设计,使得观测误差方程(7)能够在有限时间内收敛到零;
加油管滚转通道的观测器与俯仰通道观测器采用相同的结构;
步骤3:根据加油管的有限时间状态观测器,设计加油管的反步终端滑模控制器,使加油管的姿态在存在扰动机不确定项的情况下,按照期望的指令信号进行运动;
在加油管俯仰通道观测器的基础上,令加油管俯仰角的跟踪误差为:
跟踪误差的一阶导数及二阶导数分别为:
为了使加油管的俯仰角在有限时间内获得一个快速的响应,引入终端滑模方法,选择的滑模面为:
其中,k1θ>0,pθ,qθ均为正奇数,且1<pθ/qθ<2;
所选滑模面的一阶导数及二阶导数分别为:
将加油管俯仰通道的二阶状态方程改写为关于滑模面的三阶状态空间方程,为:
对关于滑模面的状态空间方程进行转换,得:
σ1θ=sθ (15)
σ2θ=s1θ-υ1θ (16)
σ3θ=s2θ-υ2θ (17)
式中,υ1θ,υ2θ为虚拟控制变量;
加油管的俯仰通道进行反步控制律的设计过程为:
首先,定义系统的Lyapunov函数为:
对V1θ进行求导可得:
取虚拟控制变量υ1θ=-ξ1θσ1θ,其中ξ1θ>0,则:
然后,定义新的Lyapunov函数为:
对V2θ进行求导可得:
取虚拟控制变量υ2θ=-ξ2θσ2θ-σ1θ-ξ1θs1θ,其中ξ2θ>0,则
最后,选取新的Lyapunov函数为:
对V3θ进行求导可得:
其中:
将控制律u1带入到式(25)中,得:
综上,σ1θ,σ2θ和σ3θ在控制律(26)的作用下,均能够在有限时间收敛到零,加油管的俯仰角能够快速的跟踪上期望指令;
滚转通道的控制律设计方法与上述俯仰通道的设计步骤相同。
有益效果
本发明提供的一种基于有限时间观测器的硬式空中加油姿态控制方法,所述方法包括:建立加油管的非线性动力学数学模型,并转换为状态空间模型;根据加油管的状态空间模型,设计状态观测器,将不确定干扰环境下加油管的姿态信息在有限时间内估计出来并反馈给加油管控制系统;基于有限时间状态观测器,设计加油管的反步终端滑模控制器,使加油管的姿态到达期望状态。该方法提出加油管的有限时间状态观测器思想,在存在扰动及不确定项的情况下,所设计的滑模观测器能够对加油管的状态变量进行实时估计,具有强鲁棒性,同时基于该状态观测器设计的控制器提高了加油管姿态控制的精度及性能。
本发明设计了基于超螺旋滑模结构的状态观测器,能够在有限时间内将加油管的姿态信息观测出来并反馈给加油系统,并基于所述观测器,设计了反步终端滑模控制器,使加油管控制系统全局稳定且能够在有限时间到达期望状态,提高了加油管的姿态控制精度以及鲁棒性。
附图说明
图1是基于有限时间状态观测器的硬式空中加油自动对准控制方法的流程图;
图2是基于有限时间状态观测器的硬式空中加油自动对准控制方法的基本原理图;
图3为基于状态观测器的反步终端滑模控制律仿真示意图。
具体实施方式
现结合实施例、附图对本发明作进一步描述:
本发明公开了一种用于干扰环境下硬式空中加油的自动对准控制器设计方法,参照图1所示,设计方法具体包括以下步骤:
步骤1:根据能量法以及气动分析方法,建立加油管的非线性动力学数学模型,并转换为状态空间模型。
能量法建模:根据拉格朗日方程以及虚功原理,得到加油管俯仰力矩My以及滚转力矩Mx表达式如下式:
式中,M为加油管的质量,θ为加油管的俯仰角,为加油管的俯仰角速度,为加油管的俯仰角加速度,φ为加油管的滚转角,为加油管的滚转角速度,为加油管的滚转角加速度,l为加油管万向节到加油管质心的距离,I为加油管的惯性张量矩阵,具体为:
气动分析法建模:通过对加油管进行风速分解以及对加油管上方向舵以及升降舵产生的力进行分析,获得加油管俯仰力矩My以及滚转力矩Mx表达式如下式:
式中,V为加油管的飞行速度,ρ为空气密度,g为重力加速度,w为加油管的管径,δr为加油管方向舵的偏转角度,δe为加油管升降舵的偏转角度,Sr为加油管方向舵的面积,Se为加油管升降舵的面积,Cr为加油管方向舵的气动系数,Ce为加油管升降舵的气动系数;
将能量法与气动分析法获得的加油管力矩表达式进行联立,便可得到加油管完整的动力学数学表达式;
加油管的非线性动力学数学模型转换为状态空间模型;
根据上述式(1)-(4),得到加油管的状态空间模型如下式:
其中,
步骤2:根据加油管的状态空间模型,设计硬式空中加油对准过程中的有限时间状态观测器。
加油管俯仰通道的状态观测器为:
则:
由加油管状态观测器采用超螺旋滑模结构设计可知,观测误差方程(7)有限时间内收敛到零;
此外,加油管滚转通道的观测器与俯仰通道观测器采用相同的结构。
步骤3:根据加油管的有限时间状态观测器,设计加油管的反步终端滑模控制器,使加油管的姿态在存在扰动机不确定项的情况下,按照期望的指令信号进行运动。在加油管俯仰通道观测器的基础上,令加油管俯仰角的跟踪误差为:
跟踪误差的一阶导数及二阶导数分别为:
为了使加油管的俯仰角在有限时间内获得一个快速的响应,引入终端滑模方法,选择的滑模面为:
其中,k1θ>0,pθ,qθ均为正奇数,且1<pθ/qθ<2;
所选滑模面的一阶导数及二阶导数分别为:
将加油管俯仰通道的二阶状态方程改写为关于滑模面的三阶状态空间方程,为:
对关于滑模面的状态空间方程进行转换,得:
σ1θ=sθ (15)
σ2θ=s1θ-υ1θ (16)
σ3θ=s2θ-υ2θ (17)
式中,υ1θ,υ2θ为虚拟控制变量;
加油管的俯仰通道进行反步控制律的设计过程为:
首先,定义系统的Lyapunov函数为:
对V1θ进行求导可得:
取虚拟控制变量υ1θ=-ξ1θσ1θ,其中ξ1θ>0,则:
然后,定义新的Lyapunov函数为:
对V2θ进行求导可得:
取虚拟控制变量υ2θ=-ξ2θσ2θ-σ1θ-ξ1θs1θ,其中ξ2θ>0,则
最后,选取新的Lyapunov函数为:
对V3θ进行求导可得:
其中:
将控制律u1带入到式(25)中,得:
综上,σ1θ,σ2θ和σ3θ在控制律(26)的作用下,均能够在有限时间收敛到零,加油管的俯仰角能够快速的跟踪上期望指令。
滚转通道的控制律设计方法与上述俯仰通道的设计步骤相同。
本发明设计的基于有限时间状态观测器的加油管滑模控制律如图2所示。
仿真结果图3表明,所设计的基于有限时间观测器的加油管滑模控制器能够在有限时间内将加油管的状态信息估计出来并使加油管的姿态运动到达期望状态,具有较好的鲁棒性及控制精度。
Claims (1)
1.一种基于有限时间观测器的硬式空中加油姿态控制方法,其特征在于步骤如下:
步骤1:建立加油管的非线性动力学数学模型,并转换为状态空间模型
步骤1.1:根据能量法以及气动分析方法,建立加油管的非线性动力学数学模型;
能量法建模:根据拉格朗日方程以及虚功原理,得到加油管俯仰力矩My以及滚转力矩Mx表达式如下式:
式中,M为加油管的质量,θ为加油管的俯仰角,为加油管的俯仰角速度,为加油管的俯仰角加速度,φ为加油管的滚转角,为加油管的滚转角速度,为加油管的滚转角加速度,l为加油管万向节到加油管质心的距离,I为加油管的惯性张量矩阵,具体为:Ix、Iy、Iz分别为绕x轴、y轴、z轴的转动惯量,Ixy、Ixz、Iyx、Iyz、Izx、Izy分别为绕xy、xz、yx、yz、zx、zy对应平面的转动惯量;
气动分析法建模:通过对加油管进行风速分解以及对加油管上方向舵以及升降舵产生的力进行分析,获得加油管俯仰力矩My以及滚转力矩Mx表达式如下式:
式中,V为加油管的飞行速度,ρ为空气密度,g为重力加速度,w为加油管的管径,δr为加油管方向舵的偏转角度,δe为加油管升降舵的偏转角度,Sr为加油管方向舵的面积,Se为加油管升降舵的面积,Cr为加油管方向舵的气动系数,Ce为加油管升降舵的气动系数;
将能量法与气动分析法获得的加油管力矩表达式进行联立,便可得到加油管完整的非线性动力学数学模型;
步骤1.2:将加油管的非线性动力学数学模型转换为状态空间模型
根据上述式(1)-(4),得到加油管的状态空间模型如下式:
其中,
步骤2:根据加油管的状态空间模型,设计硬式空中加油对准过程中的有限时间状态观测器;
加油管俯仰通道的状态观测器为:
则:
对加油管状态观测器采用超螺旋滑模结构设计,使得观测误差方程(7)能够在有限时间内收敛到零;
加油管滚转通道的观测器与俯仰通道观测器采用相同的结构;
步骤3:根据加油管的有限时间状态观测器,设计加油管的反步终端滑模控制器,使加油管的姿态在存在扰动及不确定项的情况下,按照期望的指令信号进行运动;
在加油管俯仰通道观测器的基础上,令加油管俯仰角的跟踪误差为:
跟踪误差的一阶导数及二阶导数分别为:
为了使加油管的俯仰角在有限时间内获得一个快速的响应,引入终端滑模方法,选择的滑模面为:
其中,k1θ>0,pθ,qθ均为正奇数,且1<pθ/qθ<2;
所选滑模面的一阶导数及二阶导数分别为:
将加油管俯仰通道的二阶导数改写为关于滑模面的三阶状态空间方程,为:
对关于滑模面的状态空间方程进行转换,得:
σ1θ=sθ (15)
σ2θ=s1θ-υ1θ (16)
σ3θ=s2θ-υ2θ (17)
式中,υ1θ,υ2θ为虚拟控制变量;
加油管的俯仰通道进行反步控制律的设计过程为:
首先,定义系统的Lyapunov函数为:
对V1θ进行求导可得:
取虚拟控制变量υ1θ=-ξ1θσ1θ,其中ξ1θ>0,则:
然后,定义新的Lyapunov函数为:
对V2θ进行求导可得:
取虚拟控制变量υ2θ=-ξ2θσ2θ-σ1θ-ξ1θs1θ,其中ξ2θ>0,则
最后,选取新的Lyapunov函数为:
对V3θ进行求导可得:
其中:
将控制律u1带入到式(25)中,得:
综上,σ1θ、σ2θ和σ3θ在控制律(26)的作用下,均能够在有限时间收敛到零,加油管的俯仰角能够快速的跟踪上期望指令;
滚转通道的控制律设计方法与上述俯仰通道的设计步骤相同。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110184536.3A CN112947522B (zh) | 2021-02-10 | 2021-02-10 | 一种基于有限时间观测器的硬式空中加油姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110184536.3A CN112947522B (zh) | 2021-02-10 | 2021-02-10 | 一种基于有限时间观测器的硬式空中加油姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112947522A CN112947522A (zh) | 2021-06-11 |
CN112947522B true CN112947522B (zh) | 2022-08-02 |
Family
ID=76245534
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110184536.3A Active CN112947522B (zh) | 2021-02-10 | 2021-02-10 | 一种基于有限时间观测器的硬式空中加油姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112947522B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114415705B (zh) * | 2021-12-17 | 2023-09-22 | 蓝箭航天空间科技股份有限公司 | 液体火箭姿态控制实现方法、实现系统及存储介质 |
CN114476123B (zh) * | 2022-03-21 | 2023-04-14 | 中国空气动力研究与发展中心高速空气动力研究所 | 一种用于软管式空中加油对接模拟试验装置的设计方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102011102279A1 (de) * | 2011-05-23 | 2013-08-29 | Airbus Operations Gmbh | Flugzeug mit einer Betankungseinrichtung sowie Verfahren zur Bahnführung eines Flugzeugs bei der Betankung desselben |
CN107065593B (zh) * | 2016-12-28 | 2020-05-19 | 中国航空工业集团公司西安飞机设计研究所 | 一种飞机加油杆装置的姿态控制系统 |
CN109703768B (zh) * | 2018-01-19 | 2020-07-03 | 北京航空航天大学 | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 |
-
2021
- 2021-02-10 CN CN202110184536.3A patent/CN112947522B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN112947522A (zh) | 2021-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110377045B (zh) | 一种基于抗干扰技术的飞行器全剖面控制方法 | |
CN106643737B (zh) | 风力干扰环境下四旋翼飞行器姿态解算方法 | |
CN109144084B (zh) | 一种基于固定时间收敛观测器的垂直起降重复使用运载器姿态跟踪控制方法 | |
CN102073755B (zh) | 近空间高超声速飞行器运动控制仿真方法 | |
CN111665857B (zh) | 基于复合智能学习的变体飞行器控制方法 | |
CN102520726B (zh) | 大攻角飞行状态下的大气攻角及侧滑角估计方法 | |
CN109828602B (zh) | 一种基于观测补偿技术的航迹回路非线性模型变换方法 | |
CN107390531B (zh) | 参数学习有限时间收敛的高超声速飞行器控制方法 | |
CN109460050B (zh) | 一种针对变体无人机的复合分层抗干扰控制方法 | |
CN112947522B (zh) | 一种基于有限时间观测器的硬式空中加油姿态控制方法 | |
CN103926931B (zh) | 轴对称高速飞行器运动特征综合识别方法 | |
CN108153323B (zh) | 一种高空无人飞行器高精度再入制导方法 | |
CN112346470A (zh) | 一种基于改进自抗扰控制的四旋翼姿态控制方法 | |
CN109703768B (zh) | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 | |
CN107632518B (zh) | 基于高增益观测器的高超声速飞行器神经网络复合学习控制方法 | |
CN112558621A (zh) | 一种基于解耦控制的飞行机械臂系统 | |
CN112578805B (zh) | 一种旋翼飞行器的姿态控制方法 | |
CN113778129B (zh) | 一种干扰补偿的高超声速变后掠翼飞行器跟踪控制方法 | |
CN105807789A (zh) | 基于t-s模糊观测器补偿的uuv控制方法 | |
CN105182990B (zh) | 具有输出受限的三自由度模型直升机的鲁棒控制方法 | |
CN106802570B (zh) | 一种无人直升机位置跟踪的方法与装置 | |
CN109703769B (zh) | 一种基于预瞄策略的空中加油对接控制方法 | |
CN108762098B (zh) | 基于复合学习的非最小相位飞行器神经网络控制方法 | |
CN111273681A (zh) | 一种考虑攻角受限的高超声速飞行器高安全抗干扰控制方法 | |
CN108181806A (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 |