CN116414152B - 再入飞行器横侧向快速机动控制方法、***、终端及介质 - Google Patents
再入飞行器横侧向快速机动控制方法、***、终端及介质 Download PDFInfo
- Publication number
- CN116414152B CN116414152B CN202310686557.4A CN202310686557A CN116414152B CN 116414152 B CN116414152 B CN 116414152B CN 202310686557 A CN202310686557 A CN 202310686557A CN 116414152 B CN116414152 B CN 116414152B
- Authority
- CN
- China
- Prior art keywords
- angle
- representing
- control
- roll
- rate
- 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 38
- 238000005096 rolling process Methods 0.000 claims abstract description 30
- 230000004044 response Effects 0.000 claims abstract description 14
- 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 abstract description 11
- 230000008569 process Effects 0.000 claims abstract description 8
- 238000004364 calculation method Methods 0.000 claims description 20
- 230000036961 partial effect Effects 0.000 claims description 6
- 238000004590 computer program Methods 0.000 claims description 5
- 238000010276 construction Methods 0.000 claims description 5
- 230000001808 coupling effect Effects 0.000 abstract description 3
- 230000002349 favourable effect Effects 0.000 abstract description 3
- 238000013461 design Methods 0.000 description 17
- 230000008878 coupling Effects 0.000 description 10
- 238000010168 coupling process Methods 0.000 description 10
- 238000005859 coupling reaction Methods 0.000 description 10
- 230000000694 effects Effects 0.000 description 5
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000037237 body shape Effects 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 238000004132 cross linking Methods 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 230000000670 limiting effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 230000002829 reductive effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
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/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
- G05D1/106—Change initiated in response to external conditions, e.g. avoidance of elevated terrain or of no-fly zones
-
- 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
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
技术领域
本发明涉及飞行器控制领域,更具体地说,它涉及再入飞行器横侧向快速机动控制方法、***、终端及介质。
背景技术
高超声速再入飞行器为提高滑翔距离,往往采用具有高升阻比特性的升力体外形,因为其飞行速度高、机动能力强、飞行包线跨度大、飞行环境恶劣,使得高超声速再入飞行器模型呈现强非线性、强耦合性、不确定性的特点。由于高超声速滑翔飞行器独特的制导飞行方式,其倾侧角需在某个数值上反复切换符号,即进行频繁的机动滚转,这造成横侧向通道在大攻角滑行状态下产生多种耦合,对再入飞行器控制***设计提出了挑战。
针对升力体外形的再入飞行器横侧向控制问题,传统横侧向解耦控制方法着重抑制滚转机动耦合产生的侧滑角,以减小侧滑角对滚转控制的影响。由于实际飞行中控制能力受限和解耦的滞后因素,该方法在滚转机动过程中侧滑角并不能够被完全消除,且耦合侧滑角的符号总是与滚转机动方向相同,这导致侧滑角带来的附加滚转力矩总是与滚转方向相反,阻碍滚转通道的操纵,导致滚转机动的效率降低。
因此,如何研究设计一种能够克服上述缺陷的再入飞行器横侧向快速机动控制方法、***、终端及介质是我们目前急需解决的问题。
发明内容
为解决现有技术中的不足,本发明的目的是提供再入飞行器横侧向快速机动控制方法、***、终端及介质,利用偏航超前的原则,在再入飞行器大攻角再入过程中,利用横侧向耦合效应诱导有利于滚转快速机动的侧滑角,以较小控制力矩实现再入飞行器横侧向快速机动控制。
本发明的上述技术目的是通过以下技术方案得以实现的:
第一方面,提供了再入飞行器横侧向快速机动控制方法,包括以下步骤:
构建再入飞行器姿态控制的动力学模型;
基于动力学模型,将期望的侧滑角状态输入侧滑角控制回路进行虚拟控制分析,得到第一偏航角速率;
基于动力学模型,将期望的倾侧角状态输入倾侧角控制回路进行控制分析,得到滚转角速率;
将倾侧角响应的偏差引入到偏航角速率的控制后得到附加的偏航角速率,并叠加附加的偏航角速率和第一偏航角速率后得到第二偏航角速率;
将第二偏航角速率输入到偏航角速率回路进行反步滑模控制分析,得到偏航舵偏角;
将滚转角速率输入到滚转角速率回路进行反步滑模控制分析,得到滚转舵偏角;
将偏航舵偏角和滚转舵偏角输入到舵机模块实现再入飞行器的飞行控制。
进一步的,所述再入飞行器姿态控制的动力学模型构建过程具体为:
不考虑长周期运动的状态影响,将长周期运动的状态在某个特征点上视为常值,长周期运动的状态包括速度、高度、弹道倾角;
基于对期望攻角、倾侧角的需求,并在飞行过程中侧滑角姿态保持在零度的预设范围内波动,建立再入飞行器姿态控制的动力学模型。
进一步的,所述第一偏航角速率的计算公式具体为:
;
其中,表示第一偏航角速率;/>表示侧滑角回路控制增益;/>表示侧滑角的滑模面;/>表示侧滑角回路滑模项增益;/>表示侧滑动态不确定性边界;/>表示期望的侧滑角状态/>的导数;/>表示动力学模型的侧滑角控制部分中与控制量/>无关的部分;/>表示动力学模型的侧滑角控制部分中与控制量/>相关的部分,/>为输入的偏航角速率。
进一步的,所述滚转角速率的计算公式具体为:
;
其中,表示滚转角速率;/>表示倾侧角回路控制增益;/>表示倾侧角的滑模面;表示倾侧角回路滑模项增益;/>表示倾侧角动态不确定性边界;/>表示期望的倾侧角状态/>的导数;/>表示动力学模型的倾侧角控制部分中与控制量/>无关的部分;/>表示动力学模型的倾侧角控制部分中与控制量/>相关的部分;/>为输入的滚转角速率。
进一步的,所述第二偏航角速率的计算公式具体为:
;
其中,表示第二偏航角速率;/>表示输入的倾侧角;/>表示期望的倾侧角状态;表示协调项增益,取值大于0。
进一步的,所述偏航舵偏角的计算公式具体为:
;
其中,表示偏航舵偏角;/>表示偏航角速率控制回路增益;/>表示偏航角速率通道滑模面;/>表示偏航角速率回路滑模项增益;/>表示偏航角速率动态不确定边界;/>表示第二偏航角速率/>的导数;/>表示动力学模型的偏航角速率控制部分中与控制量无关的部分;/>表示动力学模型的偏航角速率控制部分中与控制量/>相关的部分;/>表示输入的偏航通道舵偏角。
进一步的,所述滚转舵偏角的计算公式具体为:
;
其中,表示滚转舵偏角;/>表示滚转角速率控制回路增益;/>表示滚转角速率通道滑模面;/>表示滚转角速率回路滑模项增益;/>表示滚转角速率动态不确定边界;/>表示侧滑角回路滑模项增益;/>表示飞行器绕机体/>轴转动时的惯量;/>表示滚转力矩对侧滑角的偏导数;/>表示输入的侧滑角;/>表示滚转角速率的导数;/>表示动力学模型的滚转角速率控制部分中与控制量/>无关的部分所对应的一介导;/>表示动力学模型的滚转角速率控制部分中与控制量/>无关的部分,/>为输入的滚转通道舵偏角。
第二方面,提供了再入飞行器横侧向快速机动控制***,包括:
模型构建模块,用于构建再入飞行器姿态控制的动力学模型;
侧滑控制模块,基于动力学模型,将期望的侧滑角状态输入侧滑角控制回路进行虚拟控制分析,得到第一偏航角速率;
倾侧控制模块,基于动力学模型,将期望的倾侧角状态输入倾侧角控制回路进行控制分析,得到滚转角速率;
协调控制模块,用于将倾侧角响应的偏差引入到偏航角速率的控制后得到附加的偏航角速率,并叠加附加的偏航角速率和第一偏航角速率后得到第二偏航角速率;
偏航控制模块,用于将第二偏航角速率输入到偏航角速率回路进行反步滑模控制分析,得到偏航舵偏角;
滚转控制模块,用于将滚转角速率输入到滚转角速率回路进行反步滑模控制分析,得到滚转舵偏角;
飞行控制模块,用于将偏航舵偏角和滚转舵偏角输入到舵机模块实现再入飞行器的飞行控制。
第三方面,提供了一种计算机终端,包含存储器、处理器及存储在存储器并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现如第一方面中任意一项所述的再入飞行器横侧向快速机动控制方法。
第四方面,提供了一种计算机可读介质,其上存储有计算机程序,所述计算机程序被处理器执行可实现如第一方面中任意一项所述的再入飞行器横侧向快速机动控制方法。
与现有技术相比,本发明具有以下有益效果:
本发明提供的再入飞行器横侧向快速机动控制方法,在分析升力体再入飞行器耦合机理的基础上,在再入飞行器横侧向滚转和偏航通道控制设计中,通过求解当前状态下的偏航超前准则,基于该准则对偏航和滚转指令进行协调分配,保证滚转机动过程中侧滑角的符号总是有利于滚转指令的执行,进而达到提升整个横侧向快速响应能力、节省控制能量的目的。
附图说明
此处所说明的附图用来提供对本发明实施例的进一步理解,构成本申请的一部分,并不构成对本发明实施例的限定。在附图中:
图1是本发明实施例1中的控制原理图;
图2是本发明实施例1中倾侧角响应曲线的效果对比图;
图3是本发明实施例1中侧滑角响应曲线的效果对比图;
图4是本发明实施例1中滚转舵偏曲线的效果对比图;
图5是本发明实施例1中偏航舵偏曲线的效果对比图;
图6是本发明实施例2中的***框图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明白,下面结合实施例和附图,对本发明作进一步的详细说明,本发明的示意性实施方式及其说明仅用于解释本发明,并不作为对本发明的限定。
实施例1:再入飞行器横侧向快速机动控制方法,如图1所示,具体由以下步骤实现。
步骤一:构建再入飞行器姿态控制的动力学模型。
在飞行器姿态控制***的设计中,可不考虑速度、高度、弹道倾角等长周期运动的状态影响,而将其在某个特征点上视为常值。再入飞行器制导***产生的控制指令为对期望攻角、倾侧角的需求,同时要求飞行过程中侧滑角姿态尽量保持在零度附近,以减小耦合带来的影响。因此,建立如下形式再入飞行器姿态控制的动力学模型:
(1)
(2)
(3)
(4)
(5)
(6);
其中,状态量分别表示攻角、侧滑角、倾侧角、滚转角速率、偏航角速率和俯仰角速率;/>分别表示对应状态的导数;,/>表示攻角指令;/>表示飞行器质量;/>表示重力加速度;/>分别表示瞬时飞行速度和轨迹倾角;/>表示升力;/>分别表示侧向力、滚转和偏航力矩对侧滑角的偏导数;/>分别为滚转、偏航、俯仰通道舵偏角;/>分别表示飞行器绕机体x轴、y轴、z轴转动时的惯量;/>为惯***联项。
步骤二:基于动力学模型,将期望的侧滑角状态输入侧滑角控制回路进行虚拟控制分析,得到第一偏航角速率。
建立再入飞行器姿态控制的动力学模型后,采用反步滑模控制方法,根据由外向内的原则,对偏航和滚转通道进行控制设计。
外回路控制器设计中,设计侧滑角控制回路时,滚转角速率为控制量。
将侧滑角状态方程,即公式(2)写为如下形式:
(7)
式中,为侧滑角回路不确定性,且/>,/>为侧滑动态不确定性边界。设期望的侧滑角状态为/>。
定义滑模面:
(8)。
对求导:
(9)。
则得到第一偏航角速率的计算公式为:
(10);
其中,表示第一偏航角速率;/>表示侧滑角回路控制增益;/>表示侧滑角的滑模面;/>表示侧滑角回路滑模项增益;/>表示侧滑动态不确定性边界;/>表示期望的侧滑角状态/>的导数;/>表示动力学模型的侧滑角控制部分中与控制量/>无关的部分;/>表示动力学模型的侧滑角控制部分中与控制量/>相关的部分,/>为输入的偏航角速率。
步骤三:基于动力学模型,将期望的倾侧角状态输入倾侧角控制回路进行控制分析,得到滚转角速率。
外回路控制器设计中,设计倾侧角控制回路时,滚转角速率为控制量。
侧滑角状态方程,即公式(3)写为如下形式:
(11)。
定义滑模面:
(12)。
与侧滑角回路同样的方法,对上式求导并引入变结构项,得到的指令,即滚转角速率的计算公式为:
(13);
将侧滑角状态方程,即公式(2)写为如下形式:
(7)
式中,为侧滑角回路不确定性,且/>,/>为侧滑动态不确定性边界。设期望的侧滑角状态为/>。
定义滑模面:
(8)。
对求导:
(9)。
则得到第一偏航角速率的计算公式为:
(10);
其中,表示第一偏航角速率;/>表示侧滑角回路控制增益;/>表示侧滑角的滑模面;/>表示侧滑角回路滑模项增益;/>表示侧滑动态不确定性边界;/>表示期望的侧滑角状态/>的导数;/>表示动力学模型的侧滑角控制部分中与控制量/>无关的部分;/>表示动力学模型的侧滑角控制部分中与控制量/>相关的部分,/>为输入的偏航角速率。
步骤三:基于动力学模型,将期望的倾侧角状态输入倾侧角控制回路进行控制分析,得到滚转角速率。
外回路控制器设计中,设计倾侧角控制回路时,滚转角速率为控制量。
侧滑角状态方程,即公式(3)写为如下形式:
(11)。
定义滑模面:
(12)。
与侧滑角回路同样的方法,对上式求导并引入变结构项,得到的指令,即滚转角速率的计算公式为:
(13);
其中,表示滚转角速率;/>表示倾侧角回路控制增益;/>表示倾侧角的滑模面;表示倾侧角回路滑模项增益;/>表示倾侧角动态不确定性边界;/>表示期望的倾侧角状态/>的导数;/>表示动力学模型的倾侧角控制部分中与控制量/>无关的部分;/>表示动力学模型的倾侧角控制部分中与控制量/>相关的部分;/>为输入的滚转角速率。
步骤四:将倾侧角响应的偏差引入到偏航角速率的控制后得到附加的偏航角速率,并叠加附加的偏航角速率和第一偏航角速率后得到第二偏航角速率。
为提高倾侧角跟踪的快速特性,设计协调项以借助偏航通道对滚转的耦合效应,加速滚转通道响应。
考虑到应让再入飞行器在转动中产生与滚动方向相反的侧滑角,使得侧滑角耦合产生的滚转力矩方向与指令滚转角速率相一致,根据该原则对滚转、偏航角速率控制指令进行协调分配。忽略公式(2)中慢变量的作用,得到侧滑角动态近似满足如下关系式:
(14)。
根据上述原则,需使与/>异号,即:
(15)。
则角速率控制指令、/>应满足如下协调关系:
(16)。
为满足上式关系,将倾侧角响应的偏差引入偏航角速率的控制中,形成附加偏航角速率指令,以驱动偏航通道提前产生侧滑,且产生的侧滑角极性为有利于滚转机动的方向。此时,引入协调项的偏航角速率指令,即第二偏航角速率的计算公式为:
(17);
其中,表示第二偏航角速率;/>表示输入的倾侧角;/>表示期望的倾侧角状态;表示协调项增益,取值大于0。
步骤五:将第二偏航角速率输入到偏航角速率回路进行反步滑模控制分析,得到偏航舵偏角。
角速率控制器设计中,设计控制回路时,偏航舵偏/>为控制量。
同外回路相似,基于反步滑模的设计方法,可以得出偏航舵偏的指令输出,即偏航舵偏角的计算公式为:
(18);
其中,表示偏航舵偏角;/>表示偏航角速率控制回路增益;/>表示偏航角速率通道滑模面;/>表示偏航角速率回路滑模项增益;/>表示偏航角速率动态不确定边界;/>表示第二偏航角速率/>的导数;/>表示动力学模型的偏航角速率控制部分中与控制量无关的部分;/>表示动力学模型的偏航角速率控制部分中与控制量/>相关的部分;/>表示输入的偏航通道舵偏角。
步骤六:将滚转角速率输入到滚转角速率回路进行反步滑模控制分析,得到滚转舵偏角。
角速率控制器设计中,设计控制回路时,滚转舵偏/>为控制量。
滚转通道的设计中,侧滑角的存在对滚转通道形成较强耦合,这里采用部分解耦的方式,具体设计方法如下:
将滚转角速率方程写为如下形式:
(19)
式中,为滚转角速率动态不确定性。引入侧滑解耦系数/>,该系数表示对侧滑角耦合的解耦程度,0为不解耦,1为完全解耦,设计中可根据耦合量级进行选取,将该系数引入后,滚转角速率方程可表示为:
(20)
根据反步滑模的设计方法,得出引入解耦系数的滚转角速率控制律,即滚转舵偏角的计算公式为:
;
其中,表示滚转舵偏角;/>表示滚转角速率控制回路增益;/>表示滚转角速率通道滑模面;/>表示滚转角速率回路滑模项增益;/>表示滚转角速率动态不确定边界;/>表示侧滑角回路滑模项增益;/>表示飞行器绕机体/>轴转动时的惯量;/>表示滚转力矩对侧滑角的偏导数;/>表示输入的侧滑角;/>表示滚转角速率的导数;/>表示动力学模型的滚转角速率控制部分中与控制量/>无关的部分所对应的一介导;/>表示动力学模型的滚转角速率控制部分中与控制量/>无关的部分,/>为输入的滚转通道舵偏角。
步骤七:将偏航舵偏角和滚转舵偏角输入到舵机模块实现再入飞行器的飞行控制。
为验证本发明的有效性,基于上述方法进行了仿真试验验证,并与传统解耦控制方法(下标norm)进行了对比,其结果如图2-图5所示。可以看出在相同的倾侧角指令下,基于本发明所记载的方法和传统方法产生的侧滑角相反。从滚转、偏航舵曲线可以看出,在相同的倾侧角响应速度前提下,本发明所记载的方法中滚转舵和偏航舵输出角度更小,说明了本发明所记载的方法具有更高的控制效率。
实施例2:再入飞行器横侧向快速机动控制***,如图6所示,包括模型构建模块、侧滑控制模块、倾侧控制模块、协调控制模块、偏航控制模块、滚转控制模块和飞行控制模块。
其中,模型构建模块,用于构建再入飞行器姿态控制的动力学模型;侧滑控制模块,基于动力学模型,将期望的侧滑角状态输入侧滑角控制回路进行虚拟控制分析,得到第一偏航角速率;倾侧控制模块,基于动力学模型,将期望的倾侧角状态输入倾侧角控制回路进行控制分析,得到滚转角速率;协调控制模块,用于将倾侧角响应的偏差引入到偏航角速率的控制后得到附加的偏航角速率,并叠加附加的偏航角速率和第一偏航角速率后得到第二偏航角速率;偏航控制模块,用于将第二偏航角速率输入到偏航角速率回路进行反步滑模控制分析,得到偏航舵偏角;滚转控制模块,用于将滚转角速率输入到滚转角速率回路进行反步滑模控制分析,得到滚转舵偏角;飞行控制模块,用于将偏航舵偏角和滚转舵偏角输入到舵机模块实现再入飞行器的飞行控制。
工作原理:本发明在分析升力体再入飞行器耦合机理的基础上,在再入飞行器横侧向滚转和偏航通道控制设计中,通过求解当前状态下的偏航超前准则,基于该准则对偏航和滚转指令进行协调分配,保证滚转机动过程中侧滑角的符号总是有利于滚转指令的执行,进而达到提升整个横侧向快速响应能力、节省控制能量的目的。
以上所述的具体实施方式,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施方式而已,并不用于限定本发明的保护范围,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.再入飞行器横侧向快速机动控制方法,其特征是,包括以下步骤:
构建再入飞行器姿态控制的动力学模型;
基于动力学模型,将期望的侧滑角状态输入侧滑角控制回路进行虚拟控制分析,得到第一偏航角速率;
基于动力学模型,将期望的倾侧角状态输入倾侧角控制回路进行控制分析,得到滚转角速率;
将倾侧角响应的偏差引入到偏航角速率的控制后得到附加的偏航角速率,并叠加附加的偏航角速率和第一偏航角速率后得到第二偏航角速率;
将第二偏航角速率输入到偏航角速率回路进行反步滑模控制分析,得到偏航舵偏角;
将滚转角速率输入到滚转角速率回路进行反步滑模控制分析,得到滚转舵偏角;
将偏航舵偏角和滚转舵偏角输入到舵机模块实现再入飞行器的飞行控制;
所述第一偏航角速率的计算公式具体为:
;
其中,表示第一偏航角速率;/>表示侧滑角回路控制增益;/>表示侧滑角的滑模面;表示侧滑角回路滑模项增益;/>表示侧滑动态不确定性边界;/>表示期望的侧滑角状态的导数;/>表示动力学模型的侧滑角控制部分中与控制量/>无关的部分;/>表示动力学模型的侧滑角控制部分中与控制量/>相关的部分,/>为输入的偏航角速率;
所述滚转角速率的计算公式具体为:
;
其中,表示滚转角速率;/>表示倾侧角回路控制增益;/>表示倾侧角的滑模面;/>表示倾侧角回路滑模项增益;/>表示倾侧角动态不确定性边界;/>表示期望的倾侧角状态/>的导数;/>表示动力学模型的倾侧角控制部分中与控制量/>无关的部分;/>表示动力学模型的倾侧角控制部分中与控制量/>相关的部分;/>为输入的滚转角速率;
所述第二偏航角速率的计算公式具体为:
;
其中,表示第二偏航角速率;/>表示输入的倾侧角;/>表示期望的倾侧角状态;/>表示协调项增益,取值大于0;
所述偏航舵偏角的计算公式具体为:
;
其中,表示偏航舵偏角;/>表示偏航角速率控制回路增益;/>表示偏航角速率通道滑模面;/>表示偏航角速率回路滑模项增益;/>表示偏航角速率动态不确定边界;/>表示第二偏航角速率/>的导数;/>表示动力学模型的偏航角速率控制部分中与控制量/>无关的部分;/>表示动力学模型的偏航角速率控制部分中与控制量/>相关的部分;/>表示输入的偏航通道舵偏角;
所述滚转舵偏角的计算公式具体为:
;
其中,表示滚转舵偏角;/>表示滚转角速率控制回路增益;/>表示滚转角速率通道滑模面;/>表示滚转角速率回路滑模项增益;/>表示滚转角速率动态不确定边界;/>表示侧滑角回路滑模项增益;/>表示飞行器绕机体/>轴转动时的惯量;/>表示滚转力矩对侧滑角的偏导数;/>表示输入的侧滑角;/>表示滚转角速率的导数;/>表示动力学模型的滚转角速率控制部分中与控制量/>无关的部分所对应的一介导;/>表示动力学模型的滚转角速率控制部分中与控制量/>无关的部分,/>为输入的滚转通道舵偏角。
2.根据权利要求1所述的再入飞行器横侧向快速机动控制方法,其特征是,所述再入飞行器姿态控制的动力学模型构建过程具体为:
不考虑长周期运动的状态影响,将长周期运动的状态在某个特征点上视为常值,长周期运动的状态包括速度、高度、弹道倾角;
基于对期望攻角、倾侧角的需求,并在飞行过程中侧滑角姿态保持在零度的预设范围内波动,建立再入飞行器姿态控制的动力学模型。
3.再入飞行器横侧向快速机动控制***,其特征是,包括:
模型构建模块,用于构建再入飞行器姿态控制的动力学模型;
侧滑控制模块,基于动力学模型,将期望的侧滑角状态输入侧滑角控制回路进行虚拟控制分析,得到第一偏航角速率;
倾侧控制模块,基于动力学模型,将期望的倾侧角状态输入倾侧角控制回路进行控制分析,得到滚转角速率;
协调控制模块,用于将倾侧角响应的偏差引入到偏航角速率的控制后得到附加的偏航角速率,并叠加附加的偏航角速率和第一偏航角速率后得到第二偏航角速率;
偏航控制模块,用于将第二偏航角速率输入到偏航角速率回路进行反步滑模控制分析,得到偏航舵偏角;
滚转控制模块,用于将滚转角速率输入到滚转角速率回路进行反步滑模控制分析,得到滚转舵偏角;
飞行控制模块,用于将偏航舵偏角和滚转舵偏角输入到舵机模块实现再入飞行器的飞行控制;
所述第一偏航角速率的计算公式具体为:
;
其中,表示第一偏航角速率;/>表示侧滑角回路控制增益;/>表示侧滑角的滑模面;表示侧滑角回路滑模项增益;/>表示侧滑动态不确定性边界;/>表示期望的侧滑角状态的导数;/>表示动力学模型的侧滑角控制部分中与控制量/>无关的部分;/>表示动力学模型的侧滑角控制部分中与控制量/>相关的部分,/>为输入的偏航角速率;
所述滚转角速率的计算公式具体为:
;
其中,表示滚转角速率;/>表示倾侧角回路控制增益;/>表示倾侧角的滑模面;/>表示倾侧角回路滑模项增益;/>表示倾侧角动态不确定性边界;/>表示期望的倾侧角状态/>的导数;/>表示动力学模型的倾侧角控制部分中与控制量/>无关的部分;/>表示动力学模型的倾侧角控制部分中与控制量/>相关的部分;/>为输入的滚转角速率;
所述第二偏航角速率的计算公式具体为:
;
其中,表示第二偏航角速率;/>表示输入的倾侧角;/>表示期望的倾侧角状态;/>表示协调项增益,取值大于0;
所述偏航舵偏角的计算公式具体为:
;
其中,表示偏航舵偏角;/>表示偏航角速率控制回路增益;/>表示偏航角速率通道滑模面;/>表示偏航角速率回路滑模项增益;/>表示偏航角速率动态不确定边界;/>表示第二偏航角速率/>的导数;/>表示动力学模型的偏航角速率控制部分中与控制量/>无关的部分;/>表示动力学模型的偏航角速率控制部分中与控制量/>相关的部分;/>表示输入的偏航通道舵偏角;
所述滚转舵偏角的计算公式具体为:
;
其中,表示滚转舵偏角;/>表示滚转角速率控制回路增益;/>表示滚转角速率通道滑模面;/>表示滚转角速率回路滑模项增益;/>表示滚转角速率动态不确定边界;/>表示侧滑角回路滑模项增益;/>表示飞行器绕机体/>轴转动时的惯量;/>表示滚转力矩对侧滑角的偏导数;/>表示输入的侧滑角;/>表示滚转角速率的导数;/>表示动力学模型的滚转角速率控制部分中与控制量/>无关的部分所对应的一介导;/>表示动力学模型的滚转角速率控制部分中与控制量/>无关的部分,/>为输入的滚转通道舵偏角。
4.一种计算机终端,包含存储器、处理器及存储在存储器并可在处理器上运行的计算机程序,其特征是,所述处理器执行所述程序时实现如权利要求1-2中任意一项所述的再入飞行器横侧向快速机动控制方法。
5.一种计算机可读介质,其上存储有计算机程序,其特征是,所述计算机程序被处理器执行可实现如权利要求1-2中任意一项所述的再入飞行器横侧向快速机动控制方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310686557.4A CN116414152B (zh) | 2023-06-12 | 2023-06-12 | 再入飞行器横侧向快速机动控制方法、***、终端及介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310686557.4A CN116414152B (zh) | 2023-06-12 | 2023-06-12 | 再入飞行器横侧向快速机动控制方法、***、终端及介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116414152A CN116414152A (zh) | 2023-07-11 |
CN116414152B true CN116414152B (zh) | 2023-08-15 |
Family
ID=87059706
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310686557.4A Active CN116414152B (zh) | 2023-06-12 | 2023-06-12 | 再入飞行器横侧向快速机动控制方法、***、终端及介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116414152B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102707624A (zh) * | 2012-05-31 | 2012-10-03 | 西北工业大学 | 基于飞行器常规模型的纵向控制器区域设计方法 |
CN104881035A (zh) * | 2015-06-17 | 2015-09-02 | 中国人民解放军国防科学技术大学 | 飞行器操纵耦合补偿方法、姿态运动控制方法及*** |
CN105676641A (zh) * | 2016-01-25 | 2016-06-15 | 南京航空航天大学 | 针对四旋翼无人机非线性模型的基于反步和滑模控制技术的非线性鲁棒控制器的设计方法 |
CN111290421A (zh) * | 2020-03-20 | 2020-06-16 | 湖南云顶智能科技有限公司 | 一种考虑输入饱和的高超声速飞行器姿态控制方法 |
CN111930141A (zh) * | 2020-07-21 | 2020-11-13 | 哈尔滨工程大学 | 一种水下机器人三维路径可视化跟踪方法 |
CN112000127A (zh) * | 2020-08-13 | 2020-11-27 | 上海航天控制技术研究所 | 一种基于反步法的飞行器横侧向联合控制方法 |
CN113985920A (zh) * | 2021-11-05 | 2022-01-28 | 中国空气动力研究与发展中心空天技术研究所 | 一种便携式异构无人机编队飞行飞机模拟器 |
CN114281092A (zh) * | 2021-12-23 | 2022-04-05 | 北京航空航天大学 | 一种基于滑模干扰观测器的高超声速飞行器协调姿态控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030151302A1 (en) * | 2002-02-08 | 2003-08-14 | Sohel Anwar | Slip regulation algorithm for an automotive vehicle using a normal force estimate and a predetermined peak wheel slip |
JP4205030B2 (ja) * | 2003-10-06 | 2009-01-07 | 本田技研工業株式会社 | 内燃機関の空燃比制御装置 |
-
2023
- 2023-06-12 CN CN202310686557.4A patent/CN116414152B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102707624A (zh) * | 2012-05-31 | 2012-10-03 | 西北工业大学 | 基于飞行器常规模型的纵向控制器区域设计方法 |
CN104881035A (zh) * | 2015-06-17 | 2015-09-02 | 中国人民解放军国防科学技术大学 | 飞行器操纵耦合补偿方法、姿态运动控制方法及*** |
CN105676641A (zh) * | 2016-01-25 | 2016-06-15 | 南京航空航天大学 | 针对四旋翼无人机非线性模型的基于反步和滑模控制技术的非线性鲁棒控制器的设计方法 |
CN111290421A (zh) * | 2020-03-20 | 2020-06-16 | 湖南云顶智能科技有限公司 | 一种考虑输入饱和的高超声速飞行器姿态控制方法 |
CN111930141A (zh) * | 2020-07-21 | 2020-11-13 | 哈尔滨工程大学 | 一种水下机器人三维路径可视化跟踪方法 |
CN112000127A (zh) * | 2020-08-13 | 2020-11-27 | 上海航天控制技术研究所 | 一种基于反步法的飞行器横侧向联合控制方法 |
CN113985920A (zh) * | 2021-11-05 | 2022-01-28 | 中国空气动力研究与发展中心空天技术研究所 | 一种便携式异构无人机编队飞行飞机模拟器 |
CN114281092A (zh) * | 2021-12-23 | 2022-04-05 | 北京航空航天大学 | 一种基于滑模干扰观测器的高超声速飞行器协调姿态控制方法 |
Non-Patent Citations (1)
Title |
---|
高超声速飞行器滑翔段制导姿控一体化设计方法研究;王鹏,等;《战术导弹技术》(第5期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN116414152A (zh) | 2023-07-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102163059B (zh) | 推力变向无人机的姿态控制***及控制方法 | |
US6246929B1 (en) | Enhanced stall and recovery control system | |
CN106707759B (zh) | 一种飞机Herbst机动控制方法 | |
CN109189087B (zh) | 一种垂直起降重复使用运载器的自适应容错控制方法 | |
US5259569A (en) | Roll damper for thrust vector controlled missile | |
CN104881553B (zh) | 单滑块滚喷模式变质心飞行器模型及其结构布局参数的设计方法 | |
CN106774375B (zh) | 一种临近空间高超声速飞行器btt制导控制方法 | |
CN103913991A (zh) | 高速轴对称飞行器复合控制方法 | |
CN106843272A (zh) | 一种具有终端速度、弹道倾角和过载约束的显式制导律 | |
CN104331084B (zh) | 一种基于方向舵控滚转策略的气动舵偏范围计算方法 | |
CN111045440B (zh) | 一种高超声速飞行器俯冲段快速滚转控制方法 | |
CN114967716B (zh) | 一种基于四元数球面线性插值的固定翼飞机姿态控制方法 | |
CN106272380A (zh) | 一种抓捕高速旋转目标后机械臂组合体的姿态稳定方法 | |
CN113741188A (zh) | 执行器故障下固定翼无人机反步自适应容错控制方法 | |
CN114089780B (zh) | 一种面向城市空间的多旋翼无人机路径规划方法 | |
CN104656659B (zh) | 舰载机滑跃起飞自动飞行控制方法 | |
CN114995480A (zh) | 一种三轴静不稳定飞翼无人机姿态角控制方法 | |
CN114326770A (zh) | 姿态角速度控制方法、装置、计算机设备和存储介质 | |
CN116414152B (zh) | 再入飞行器横侧向快速机动控制方法、***、终端及介质 | |
CN110134135B (zh) | 基于改进mpc-pid的四旋翼飞行器控制方法 | |
CN106354021A (zh) | 基于pso的飞机纵向运动俯仰角控制***pid优化方法 | |
CN107703967B (zh) | 一种控制受限飞艇航迹控制方法 | |
CN115344056A (zh) | 一种复杂操纵面飞机的智能飞行控制方法及应用 | |
CN116203840A (zh) | 可重复使用运载器自适应增益调度控制方法 | |
Lin et al. | Transition Controller Design of Tilt-Rotor UAV Based on Incremental Nonlinear Dynamic Inversion |
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 |