CN112000127B - 一种基于反步法的飞行器横侧向联合控制方法 - Google Patents
一种基于反步法的飞行器横侧向联合控制方法 Download PDFInfo
- Publication number
- CN112000127B CN112000127B CN202010812186.6A CN202010812186A CN112000127B CN 112000127 B CN112000127 B CN 112000127B CN 202010812186 A CN202010812186 A CN 202010812186A CN 112000127 B CN112000127 B CN 112000127B
- Authority
- CN
- China
- Prior art keywords
- lateral
- channel
- yaw
- rudder
- command
- 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 32
- 238000005096 rolling process Methods 0.000 claims abstract description 25
- 230000008878 coupling Effects 0.000 claims abstract description 16
- 238000010168 coupling process Methods 0.000 claims abstract description 16
- 238000005859 coupling reaction Methods 0.000 claims abstract description 16
- 238000013178 mathematical model Methods 0.000 claims abstract description 10
- 238000005259 measurement Methods 0.000 claims abstract description 5
- 230000014509 gene expression Effects 0.000 claims description 3
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 abstract description 5
- 238000013461 design Methods 0.000 description 5
- 230000006641 stabilisation Effects 0.000 description 3
- 238000011105 stabilization Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 239000002131 composite material Substances 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000000452 restraining effect Effects 0.000 description 1
- 230000003068 static effect Effects 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/10—Simultaneous control of position or course in three dimensions
- G05D1/107—Simultaneous control of position or course in three dimensions specially adapted for missiles
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
本发明公开了一种基于反步法的飞行器横侧向联合控制方法,其步骤包括:步骤一、建立横侧向通道耦合数学模型,并根据飞行器飞行状态和气动特性计算数学模型中的动力系数;步骤二、根据制导控制要求给出侧向侧滑角姿态指令βd和横向滚转角姿态指令γd;步骤三、根据惯测捷联解算得到滚转角γ、侧滑角β、滚转角速度偏航角速度ωy、弹道偏角角速度步骤四、根据快速性要求给出正常数k1、k2、k3、k4;步骤五、综合步骤一、步骤二、步骤三、步骤四的输入,根据反步法原理输出偏航舵指令δy和滚动舵指令δx,得到横侧向联合控制器。本发明提供的基于反步法的飞行器横侧向联合控制器能实现偏航通道和滚动通道的解耦控制,有效提高偏航通道和滚动通道飞行控制品质。
Description
技术领域
本发明涉及飞行器飞行控制领域,特别涉及一种基于反步法的飞行器横侧向联合控制方法。
背景技术
飞行器横侧向通道存在明显的耦合,由钱杏森等编著的《导弹飞行力学》中六自由度模型可知有运动学耦合、气动耦合、惯性耦合,其中运动学耦合和气动耦合,为横侧向通道的主要耦合量,横侧向通道耦合一方面会影响***稳定裕度、另一方面影响姿态控制精度,比如BTT控制飞行器机动过程中会耦合出侧滑角,这对于对侧滑角有严格限制要求的飞行器,比如基于吸气式发动机的飞行器,侧滑角增大时会显著提高发动机熄火的风险。工程上BTT控制侧滑角抑制方法一般是通过先滚后拐或协调滚转角指令和过载指令的方式避免同时出现攻角和滚转角速度的方法,从而减小耦合出来的侧滑角,但是这种方式明显降低了BTT控制过载响应快速性,本专利提出的一种基于反步法的飞行器横侧向联合控制器,以横侧向小扰动耦合模型为基础,利用反步法多变量控制器设计方法,设计出偏航通道和滚动通道的联合控制器,实现偏航通道和滚动通道的解耦控制,有效提高飞行器偏航通道和滚动通道姿态控制精度和***稳定性。
反步法是一种针对具有严格参数反馈***、通过引入静态补偿的思想和逐步递推的方式实现***镇定稳定的控制方法,在飞行器控制领域国内外学者主要研究了在稳定控制***三通道设计[1]、高度控制[2]、质量矩导弹控制[3]、直气复合制导[4]、制导控制一体化设计[5]等方面的应用,目前国内飞行器控制方法领域中均无涉及基于反步法的飞行器横侧向联合控制,实现偏航通道和滚动通道的解耦控制,提高飞行控制品质。背景技术参考文献:
[1]董长虹,周国杰,徐世杰.反演法在导弹非线性控制***设计中的应用[J].航天控制,2010,28(1):3-6.
[2]吴博文,李小兵,姚春明,曹艳.一种基于反步法的导弹高度控制器设计[J].火力与指挥控制,2015,40(11):153-155.
[3]高长生,荆武兴,李君.基于自适应反演法的质量矩导弹控制律设计[J].兵工学报,2011.6,32(6):686-690.
[4]张天宇,董长虹.基于自适应反演法的导弹直/气复合制导[J].北京航空航天大学学报,201307,39(7):902-906.
[5]王志凯,马建伟,宋晓娜.基于干扰观测的制导控制一体化反演滑模研究[J].火力与指挥控制,2018,43(7):76-81.
发明内容
本发明解决的问题是在横侧向通道耦合明显,影响***稳定性和姿态控制精度的问题,提供一种基于反步法的飞行器横侧向联合控制方法,实现偏航通道和滚动通道的解耦控制,提高飞行控制品质。
本发明提供的一种基于反步法的飞行器横侧向联合控制方法,其步骤包括:
步骤一、建立横侧向通道耦合数学模型,并计算数学模型中的动力系数;
步骤二、根据制导控制要求给出侧向侧滑角姿态指令βd和横向滚转角姿态指令γd;
步骤四、根据快速性要求给出正常数k1、k2、k3、k4;
步骤五、综合步骤一、步骤二、步骤三、步骤四的输入,根据反步法原理输出偏航通道和滚动通道舵指令,得到横侧向通道联合控制器。
进一步,步骤一中建立横侧向通道耦合数学模型为:
式中 其中β表示侧滑角、γ表示滚转角、α表示攻角、ωy表示偏航角速度、ψv表示弹道偏角、δy表示偏航通道舵指令、δx表示滚动通道舵指令、b2~b5为根据飞行状态和气动包计算出的偏航通道动力系数,c2~c3为根据飞行状态和气动包计算出的滚动通道动力系数。
进一步,步骤四中正常数的选取k1、k2、k3、k4应满足k1<k2,k1<k3,k2<k4。
进一步,步骤五中偏航通道和滚动通道舵指令输出表达式为
本发明的优点包括:通过本发明所提供的一种基于反步法的飞行器横侧向联合控制器,能实现偏航通道和滚动通道的解耦控制,有效提高偏航通道和滚动通道飞行控制品质。
附图说明
图1为本发明的一种基于反步法的飞行器横侧向联合控制方法流程图。
具体实施方式
下文中,结合附图和实施例对本发明作进一步阐述。
结合参考图1,根据飞行器气动特性建立如式1所示的横侧向通道耦合数学模型,根据制导控制要求给出侧向侧滑角姿态指令βd和横向滚转角姿态指令γd,根据惯测捷联解算得到滚转角γ、侧滑角β、滚转角速度偏航角速度ωy、弹道偏角角速度再根据制导控制快速性要求给出正常数k1、k2、k3、k4,综合以上输入根据反步法原理输出偏航通道和滚动通道联合控制偏航舵指令δy和滚动舵指令,将舵指令送给舵机,驱动飞行器舵面偏转,实现对侧滑角指令、滚转角指令的有效跟踪。
在本发明的一种基于反步法的飞行器横侧向联合控制方法的一个实施例中,预先根据飞行状态和气动特性给出偏航通道动力系数b2~b5(本实施案例中b2=-18.9、b3=22、b4=0.0855、b5=0.0137),滚动通道动力系数c2~c3(本实施案例中c2=50、c3=270),预先根据制导控制需求给出侧滑角姿态指令βd=0°,和滚转角姿态指令γd=50°。
该实施例中,具体工作流程描述如下:
1、建立横侧向通道耦合数学模型,如下式所示。
上式中 其中β表示侧滑角、γ表示滚转角、α表示攻角、ωy表示偏航角速度、表示弹道偏角角速度、δy表示偏航通道舵指令、δx表示滚动通道舵指令、b2~b5为偏航通道动力系数,已预先给出,c2~c3为滚动通道动力系数,已预先给出。
2、根据制导控制要求给出侧向侧滑角姿态指令βd和横向滚转角姿态指令γd,已预先给出。
3、根据快速性要求给出正常数k1、k2、k3、k4,本案例中给定k1=3、k2=5、k3=8、k4=10。
4、计算基于反步法横侧向联合控制偏航通道舵指令δy、滚动通道舵指令δx,偏航舵指令和滚动舵指令的计算表达式如下式。
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
Claims (2)
1.一种基于反步法的飞行器横侧向联合控制方法,其特征在于,步骤包括:
步骤一、建立横侧向通道耦合数学模型,并计算数学模型中的动力系数;
步骤二、根据制导控制要求给出侧向侧滑角姿态指令βd和横向滚转角姿态指令γd;
步骤四、根据快速性要求给出正常数k1、k2、k3、k4;
步骤五、综合步骤一、步骤二、步骤三、步骤四的输入,根据反步法原理输出偏航舵指令δy和滚动舵指令δx,得到横侧向联合控制器;
所述步骤一中,建立横侧向通道耦合数学模型为:
式1中 其中β表示侧滑角、γ表示滚转角、α表示攻角、ωy表示偏航角速度、ψv表示弹道偏角、δy表示偏航通道舵指令、δx表示滚动通道舵指令、b2~b5为根据飞行状态和气动包计算出的偏航通道动力系数,c2~c3为根据飞行状态和气动包计算出的滚动通道动力系数;
所述步骤五中偏航通道和滚动通道舵指令输出表达式为:
2.根据权利要求1所述的一种基于反步法的飞行器横侧向联合控制方法,其特征在于,所述步骤四中,正常数的选取k1、k2、k3、k4应满足k1<k2,k1<k3,k2<k4。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010812186.6A CN112000127B (zh) | 2020-08-13 | 2020-08-13 | 一种基于反步法的飞行器横侧向联合控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010812186.6A CN112000127B (zh) | 2020-08-13 | 2020-08-13 | 一种基于反步法的飞行器横侧向联合控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112000127A CN112000127A (zh) | 2020-11-27 |
CN112000127B true CN112000127B (zh) | 2022-01-14 |
Family
ID=73463207
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010812186.6A Active CN112000127B (zh) | 2020-08-13 | 2020-08-13 | 一种基于反步法的飞行器横侧向联合控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112000127B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112744367B (zh) * | 2020-12-29 | 2022-06-10 | 广东空天科技研究院 | 一种临近空间垂直投放发射点火阶段制导控制方法及*** |
CN114942649B (zh) * | 2022-06-06 | 2022-12-06 | 北京石油化工学院 | 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法 |
CN116414152B (zh) * | 2023-06-12 | 2023-08-15 | 中国空气动力研究与发展中心空天技术研究所 | 再入飞行器横侧向快速机动控制方法、***、终端及介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6246929B1 (en) * | 1999-06-16 | 2001-06-12 | Lockheed Martin Corporation | Enhanced stall and recovery control system |
CN102830622A (zh) * | 2012-09-05 | 2012-12-19 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
CN104793498A (zh) * | 2015-05-04 | 2015-07-22 | 中国人民解放军国防科学技术大学 | 一种自主飞艇定点驻留控制方法 |
CN106997208A (zh) * | 2017-05-10 | 2017-08-01 | 南京航空航天大学 | 一种面向不确定条件下的高超声速飞行器的控制方法 |
CN109828602A (zh) * | 2018-01-19 | 2019-05-31 | 北京航空航天大学 | 一种基于观测补偿技术的航迹回路非线性模型变换方法 |
-
2020
- 2020-08-13 CN CN202010812186.6A patent/CN112000127B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6246929B1 (en) * | 1999-06-16 | 2001-06-12 | Lockheed Martin Corporation | Enhanced stall and recovery control system |
CN102830622A (zh) * | 2012-09-05 | 2012-12-19 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
CN104793498A (zh) * | 2015-05-04 | 2015-07-22 | 中国人民解放军国防科学技术大学 | 一种自主飞艇定点驻留控制方法 |
CN106997208A (zh) * | 2017-05-10 | 2017-08-01 | 南京航空航天大学 | 一种面向不确定条件下的高超声速飞行器的控制方法 |
CN109828602A (zh) * | 2018-01-19 | 2019-05-31 | 北京航空航天大学 | 一种基于观测补偿技术的航迹回路非线性模型变换方法 |
Non-Patent Citations (1)
Title |
---|
基于反演滑模的机动飞行器横向回路控制设计;范金锁 等;《中国惯性技术学报》;20101231;第18卷(第6期);第670-674 * |
Also Published As
Publication number | Publication date |
---|---|
CN112000127A (zh) | 2020-11-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112000127B (zh) | 一种基于反步法的飞行器横侧向联合控制方法 | |
CN110008502B (zh) | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 | |
CN106681348B (zh) | 考虑全捷联导引头视场约束的制导控制一体化设计方法 | |
CN109782795B (zh) | 一种利用耦合的面对称高超声速飞行器横侧向控制方法及控制*** | |
CN106707759B (zh) | 一种飞机Herbst机动控制方法 | |
CN104881035B (zh) | 飞行器操纵耦合补偿方法、姿态运动控制方法及*** | |
CN111506099B (zh) | 一种无人机高度智能控制***及方法 | |
CN109460055B (zh) | 一种飞行器控制能力确定方法、装置及电子设备 | |
CN111591470A (zh) | 一种适应推力可调模式的飞行器精确软着陆闭环制导方法 | |
CN113758380B (zh) | 考虑舵机动态性能和攻击角约束的制导控制一体化方法 | |
CN112180965A (zh) | 一种高精度过载控制方法 | |
CN113778129A (zh) | 一种干扰补偿的高超声速变后掠翼飞行器跟踪控制方法 | |
CN115406312B (zh) | 考虑视场角和舵机延时约束的导弹制导控制一体化方法 | |
CN114509946A (zh) | 一种基于预设时间滑模的飞行器制导控制一体化设计方法 | |
CN110209192A (zh) | 战斗机航向增稳控制***设计方法 | |
CN114815888B (zh) | 一种仿射形式的制导控制一体化控制方法 | |
CN117289598B (zh) | 一种飞行器的反步滑模控制方法及*** | |
CN113419431A (zh) | 一种基于事件触发的平流层飞艇轨迹跟踪控制方法及*** | |
Lorenz et al. | A decoupled approach for trajectory generation for an unmanned rotorcraft | |
CN117471952A (zh) | 一种飞行器反步超螺旋滑模制导控制一体化方法 | |
CN107703967B (zh) | 一种控制受限飞艇航迹控制方法 | |
CN116203981A (zh) | 一种基于扰动观测的四旋翼无人机的轨迹跟踪控制方法 | |
CN110426955B (zh) | 一种基于利用耦合的高超声速舵面操纵效能预测方法 | |
Mohamed et al. | Design and comparison of two-loop with PI and three-loop autopilot for static unstable missile | |
CN117806341A (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 | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20230704 Address after: 1555 Zhongchun Road, Minhang District, Shanghai, 201109 Patentee after: SHANGHAI AEROSPACE CONTROL TECHNOLOGY INSTITUTE Patentee after: SHANGHAI ACADEMY OF SPACEFLIGHT TECHNOLOGY Address before: 1555 Zhongchun Road, Minhang District, Shanghai, 201109 Patentee before: SHANGHAI AEROSPACE CONTROL TECHNOLOGY INSTITUTE |