CN112947058B - 一种针对飞机三轴角速率控制的自抗扰型pid调参方法 - Google Patents
一种针对飞机三轴角速率控制的自抗扰型pid调参方法 Download PDFInfo
- Publication number
- CN112947058B CN112947058B CN202110294154.6A CN202110294154A CN112947058B CN 112947058 B CN112947058 B CN 112947058B CN 202110294154 A CN202110294154 A CN 202110294154A CN 112947058 B CN112947058 B CN 112947058B
- Authority
- CN
- China
- Prior art keywords
- control
- rate
- angular velocity
- aircraft
- deflection angle
- 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 44
- 230000008859 change Effects 0.000 claims abstract description 21
- 230000008569 process Effects 0.000 claims abstract description 20
- 230000008878 coupling Effects 0.000 claims abstract description 10
- 238000010168 coupling process Methods 0.000 claims abstract description 10
- 238000005859 coupling reaction Methods 0.000 claims abstract description 10
- 239000011159 matrix material Substances 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000004422 calculation algorithm Methods 0.000 claims description 2
- 238000009499 grossing Methods 0.000 claims description 2
- 238000005096 rolling process Methods 0.000 claims description 2
- 230000004044 response Effects 0.000 abstract description 8
- 238000005516 engineering process Methods 0.000 abstract description 4
- 238000010586 diagram Methods 0.000 description 7
- 238000004088 simulation Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 1
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
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提出一种针对飞机三轴角速率控制的自抗扰型PID调参方法,该控制方法在存在模型不确定的情况下,能及时补偿非线性气动参数变化和耦合引起的总扰动影响,使飞机角速度动态响应尽可能快而平稳地达到控制目标。包括:1、设计跟踪微分器(TD)规划跟踪角速度指令的理想动态过程及其变化率;2、设计在线补偿总扰动的三轴角速度PID控制虚拟控制量;3、根据虚拟控制量求解对应的舵偏角。本发明充分考虑了各通道非线性未知动态、耦合不确定性动态及外部扰动等对飞行的影响,依然采用简单的PID控制结构,通过独特的参数调节技术,进行扰动的实时估计与补偿,可以在不确定动态及扰动等存在下实现飞机角速度快速变化要求的动态响应和控制精度的一致性。
Description
技术领域
本发明属于飞机角速率控制技术的设计领域,具体内容涉及到飞机角速率控制的自抗扰型PID调参方法,该方法可以解决带有气动参数非线性不确定性与多通道耦合不确定性的三轴角速度快速平稳高精度的解耦控制设计。
背景技术
高性能飞机对快速机动的要求越来越高,高速机动时的快速角速度变化控制常常面临气动参数具有强非线性不确定性及多通道的耦合性。因此,如何实现飞机的快速角速度变化精确控制,并且在多通道耦合下保证各通道稳定性,具有很大挑战性。已有的方法主要为PID(比例-积分-微分)控制、基于模型信息的动态逆方法以及自抗扰控制等,这些方法的主要特点是:
PID(比例-积分-微分)控制是迄今为止应用最广泛的一种控制方法,目前90%以上航空航天控制迴路还都是基于PID控制,其特点是不依赖具体模型,控制器结构简单,但是如何调节PID参数是设计的难点,虽然至今PID参数调参方法已有上千种,但都是经验公式,而且主要针对单输入单输出的线性***,对于具有非线性不确定性的多输入多输出***如何调整PID参数才能实现满意的效果,一直是控制设计的难点。
动态逆设计需要气动参数模型才能进行,控制器结构复杂,并且当模型存在不确定性时,控制精度降低。
自抗扰控制通过设计三个并行的扩张状态观测器对三轴非线性和耦合不确定动态及外部扰动进行在线估计和补偿,从而实现对多输入多输出非线性不确定***的有效控制。
本发明针对飞机三轴角速度控制问题,提出一种自抗扰型PID调参方法,该调参方法可以通过PID的简单控制结构实现具有和自抗扰控制技术类似的在线估计和补偿三轴非线性和耦合不确定动态及外部扰动的功能,从而实现对多输入多输出非线性不确定***的有效控制。
发明内容
本发明解决的技术问题是:提出一种适用于飞机三轴角速度控制的自抗扰型PID调参方法,该控制方法在存在模型不确定的情况下,能及时补偿非线性气动参数变化和耦合引起的总扰动影响,使飞机角速度动态响应尽可能快而平稳地达到控制目标。
考虑如下机体系下的飞机角速度动力学模型:
其中,p,q,r分别为飞机的滚转角速率、俯仰角速率和偏航角速率,I∈R3×3为飞机的转动惯量,ω为飞行器的三维角速率矢量,ω=[p,q,r]T,hE为飞机发动机角动量,[L(ω,α,β,V,h)M(ω,α,β,V,h)N(ω,α,β,V,h)]∈R3为气动力矩中与控制输入无关的部分,α为飞行器迎角,β为飞行器侧滑角,V为飞行器速率,h为飞行器高度,B1∈R3×3为舵偏角控制输入增益矩阵,δe为飞行器的升降舵偏角,δa为飞行器的副翼舵偏角,δr为飞行器的方向舵偏角。
角速度控制目标为设计舵偏角(δe,δa,δr)使得飞机的角速率(p,q,r)能快速平稳地跟上角速度指令(p*,q*,r*),其中,p*∈R为滚转角速率指令,q*∈R为俯仰角速率指令,r*∈R为偏航角速率指令。
本发明的技术解决方案包括如下三个步骤:
步骤(1):设计跟踪微分器(TD)规划跟踪角速度指令的理想动态过程及其变化率;
设计如下3个跟踪微分器(TD)来规划跟踪角速度指令(p*,q*,r*)的理想动态过程:
其中,公式(2)-(4)中(xp1,xq1,xr1)是跟踪微分器根据角速度指令(p*,q*,r*)规划的理想动态过程,(xp2,xq2,xr2)为(xp1,xq1,xr1)的变化率,(cp,cq,cr)为跟踪微分器中调节三轴角速度理想动态过程快慢的参数;ht为跟踪微分器的平滑参数,公式(2)-(4)中非线性函数f(xi1-i*,xi2,ci,ht)(i=p,q,r)的具体算法为:
其中,η为计算过程的中间值,具体由下式计算:
注:将f(xi1-i*,xi2,ci,ht)中的i分别用p,q,r就是式(2)、(3)、(4)中的f(·)函数的具体表达式。
步骤(2):设计在线补偿总扰动的三轴角速度PID控制虚拟控制量;
公式(1)可以表示为如下被控***:
其中,(u1,u2,u3)为待设计的虚拟控制量,与实际舵偏角控制输入的关系为:
Fp(ω,α,β,V,h),Fq(ω,α,β,V,h)和Fr(ω,α,β,V,h)可视为三轴角速度通道中反映非线性气动参数变化和耦合影响的总扰动,下面简记为Fp(·),Fq(·)和Fr(·),具体表示为:
根据步骤(1)中由角速度指令(p*,q*,r*)规划的理想动态过程(xp1,xq1,xr1)和其变化率(xp2,xq2,xr2),设计如下在线补偿总扰动的三轴角速度自抗扰型PID控制的虚拟控制量:
虚拟控制量包括三部分,其中,第一部分:
为对角速度三轴通道总扰动的估计值来实时补偿总扰动Fp(·),Fq(·)和Fr(·),将被控***(6)还原为标准的积分串联型,提高***的鲁棒性、快速性和控制精度,其中,(ωp,ωq,ωr为PID控制器中调节三轴角速度通道总扰动估计精度的带宽参数;第二部分:
为角速度偏差的比例反馈,其中(kp,kq,kr)为PID控制器中三轴角速度偏差反馈系数;第三部分:
为根据理想动态过程变化率的前馈。
步骤(3):根据虚拟控制量求解对应的舵偏角
本发明与现有技术相比的优点在于:
1.以PID简单控制结构实现自抗扰的功能:本发明充分考虑了各通道非线性未知动态、耦合不确定性动态及外部扰动等对飞行的影响,依然采用简单的PID控制结构,通过独特的参数调节技术,进行扰动的实时估计与补偿,可以在不确定动态及扰动等存在下实现飞机角速度快速变化要求的动态响应和控制精度的一致性。
附图说明(图1为摘要附图)
图1为本发明提出的飞机三轴角速率控制的自抗扰型PID控制框图。
图2为本发明提出的飞机三轴角速率控制的自抗扰型PID控制设计流程图。
图3为飞机三轴角速率的响应曲线。其中,上图表示飞机滚转角速率、中图表示俯仰角速率、下图表示偏航角速率。
图4为飞行器舵偏角输入变化曲线。其中,上图表示飞机升降舵偏角响应、中图表示副翼舵偏角响应、下图表示方向舵偏角响应。
图5为三轴角速度通道的自抗扰型PID控制器对“总扰动”的估计情况。其中,上图表示对Fp(·)的估计、中图表示对Fq(·)的估计、下图表示对Fr(·)的估计。
具体实施方式
控制框图见图1,控制器设计流程图见图2。
为了检验本发明方法的实用性,以一个典型飞机快速角速度变化控制为例进行仿真实验。
仿真条件:
飞机的飞行高度为1500米,飞行速度为170米/秒,角速度变化指令如下表所示:
表-1:飞机的角速度变化指令
具体实施步骤:
1.将TD(2)-(4)初始值设为:
并将TD(2)-(4)中规划理想动态过程的参数设计为:
cp=cq=cr=100,ht=0.1.
从而计算TD(2)-(4)的输出:根据角速度指令(p*,q*,r*)规划的理想角速度动态过程(xp1,xq1,xr1)及其变化率(xp2,xq2,xr2)。
2.将TD(2)-(4)的输出和角速度实际值代入(9)式计算带有扰动补偿反馈PID控制的虚拟控制量,即
其中,参数取为
ωp=6,ωq=2,ωr=6,kp=15,kq=5,kr=5,
3.将第2步得到的(u1,u2,u3)带入(10)得到需要的舵偏角(δe1,δa1,δr1)为:
再进一步通过下式得到满足限幅条件的舵偏角输入:
图3-图5为仿真结果。从图3中可看出,本发明提出的控制律可以在存在模型不确定的情况下,使飞机角速度快速稳定地跟踪其指令.图5为三轴角速率控制的自抗扰型PID控制中扰动估计部分,即
Claims (3)
1.一种针对飞机三轴角速率控制的自抗扰型PID调参方法,针对飞机角速度动力学模型:
其中,p,q,r分别为飞机的滚转角速率、俯仰角速率和偏航角速率,I∈R3×3为飞机的转动惯量,ω为飞行器的三维角速率矢量,ω=[p,q,r]T,hE为飞机发动机角动量,[L(ω,α,β,V,h)M(ω,α,β,V,h)N(ω,α,β,V,h)]∈R3为气动力矩中与控制输入无关的部分,α为飞行器迎角,β为飞行器侧滑角,V为飞行器速率,h为飞行器高度,B1∈R3×3为舵偏角控制输入增益矩阵,δe为飞行器的升降舵偏角,δa为飞行器的副翼舵偏角,δr为飞行器的方向舵偏角;
角速度控制目标为设计舵偏角(δe,δa,δr)使得飞机的角速率(p,q,r)能快速平稳地跟上角速度指令(p*,q*,r*),其中,p*∈R为滚转角速率指令,q*∈R为俯仰角速率指令,r*∈R为偏航角速率指令;
其特征在于,包括如下三个步骤:
步骤(1):设计跟踪微分器TD规划跟踪角速度指令的理想动态过程及其变化率;
设计如下3个跟踪微分器TD来规划跟踪角速度指令(p*,q*,r*)的理想动态过程:
其中,公式(2)-(4)中(xp1,xq1,xr1)是跟踪微分器根据角速度指令(p*,q*,r*)规划的理想动态过程,(xp2,xq2,xr2)为(xp1,xq1,xr1)的变化率,(cp,cq,cr)为跟踪微分器中调节三轴角速度理想动态过程快慢的参数;ht为跟踪微分器的平滑参数,公式(2)-(4)中非线性函数f(xi1-i*,xi2,ci,ht),i=p,q,r;的具体算法为:
步骤(2):设计在线补偿总扰动的三轴角速度PID控制虚拟控制量;
公式(1)表示为如下被控***:
其中,(u1,u2,u3)为待设计的虚拟控制量,与实际舵偏角控制输入的关系为:
Fp(ω,α,β,V,h),Fq(ω,α,β,V,h)和Fr(ω,α,β,V,h)可视为三轴角速度通道中反映非线性气动参数变化和耦合影响的总扰动,下面简记为Fp(·),Fq(·)和Fr(·),具体表示为:
根据步骤(1)中由角速度指令(p*,q*,r*)规划的理想动态过程(xp1,xq1,xr1)和其变化率(xp2,xq2,xr2),设计如下在线补偿总扰动的三轴角速度自抗扰型PID控制的虚拟控制量:
步骤(3):根据虚拟控制量求解对应的舵偏角
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110294154.6A CN112947058B (zh) | 2021-03-19 | 2021-03-19 | 一种针对飞机三轴角速率控制的自抗扰型pid调参方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110294154.6A CN112947058B (zh) | 2021-03-19 | 2021-03-19 | 一种针对飞机三轴角速率控制的自抗扰型pid调参方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112947058A CN112947058A (zh) | 2021-06-11 |
CN112947058B true CN112947058B (zh) | 2022-07-22 |
Family
ID=76226621
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110294154.6A Active CN112947058B (zh) | 2021-03-19 | 2021-03-19 | 一种针对飞机三轴角速率控制的自抗扰型pid调参方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112947058B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117270578B (zh) * | 2023-11-23 | 2024-02-20 | 辰极智航(北京)科技有限公司 | 双垂尾无人机的偏航校正控制方法、装置及存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4046341A (en) * | 1976-03-30 | 1977-09-06 | General Electric Company | Aircraft angle-of-attack and sideslip estimator |
CN103777641A (zh) * | 2014-02-19 | 2014-05-07 | 北京理工大学 | 飞行器跟踪控制的复合自抗扰控制方法 |
CN109062237A (zh) * | 2018-09-17 | 2018-12-21 | 南京航空航天大学 | 一种无人倾转旋翼机自抗扰姿态控制方法 |
CN110377045A (zh) * | 2019-08-22 | 2019-10-25 | 北京航空航天大学 | 一种基于抗干扰技术的飞行器全剖面控制方法 |
CN110531777A (zh) * | 2019-08-13 | 2019-12-03 | 北京理工大学 | 基于自抗扰控制技术的四旋翼飞行器姿态控制方法和*** |
CN111610794A (zh) * | 2019-11-26 | 2020-09-01 | 南京航空航天大学 | 基于滑模干扰观测器的战斗机大迎角动态逆控制方法 |
CN112486193A (zh) * | 2020-11-19 | 2021-03-12 | 南京航空航天大学 | 一种基于自适应增广控制理论的飞翼无人机三轴全权限控制方法 |
-
2021
- 2021-03-19 CN CN202110294154.6A patent/CN112947058B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4046341A (en) * | 1976-03-30 | 1977-09-06 | General Electric Company | Aircraft angle-of-attack and sideslip estimator |
CN103777641A (zh) * | 2014-02-19 | 2014-05-07 | 北京理工大学 | 飞行器跟踪控制的复合自抗扰控制方法 |
CN109062237A (zh) * | 2018-09-17 | 2018-12-21 | 南京航空航天大学 | 一种无人倾转旋翼机自抗扰姿态控制方法 |
CN110531777A (zh) * | 2019-08-13 | 2019-12-03 | 北京理工大学 | 基于自抗扰控制技术的四旋翼飞行器姿态控制方法和*** |
CN110377045A (zh) * | 2019-08-22 | 2019-10-25 | 北京航空航天大学 | 一种基于抗干扰技术的飞行器全剖面控制方法 |
CN111610794A (zh) * | 2019-11-26 | 2020-09-01 | 南京航空航天大学 | 基于滑模干扰观测器的战斗机大迎角动态逆控制方法 |
CN112486193A (zh) * | 2020-11-19 | 2021-03-12 | 南京航空航天大学 | 一种基于自适应增广控制理论的飞翼无人机三轴全权限控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112947058A (zh) | 2021-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109062237B (zh) | 一种无人倾转旋翼机自抗扰姿态控制方法 | |
CN107807663B (zh) | 基于自适应控制的无人机编队保持控制方法 | |
Smith et al. | Disturbance observer based control with anti-windup applied to a small fixed wing UAV for disturbance rejection | |
CN104865968B (zh) | 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法 | |
CN110531776B (zh) | 基于自抗扰控制技术的四旋翼飞行器位置控制方法和*** | |
CN112965510B (zh) | 飞行器高速机动的全通道自抗扰控制方法 | |
CN110162071B (zh) | 一种高超声速飞行器再入末段姿态控制方法及*** | |
CN110244751B (zh) | 一种高超声速飞行器姿态自适应递推控制方法及*** | |
Su et al. | Barrier Lyapunov function-based robust flight control for the ultra-low altitude airdrop under airflow disturbances | |
Su et al. | Probe motion compound control for autonomous aerial refueling docking | |
CN109507890A (zh) | 一种基于eso的无人机动态逆广义预测控制器 | |
CN110316400B (zh) | 一种鸭翼布局固定翼无人机直接升力控制方法 | |
CN116339140B (zh) | 一种基于瞬时自抗扰和自适应动态逆的复合容错控制方法 | |
CN113778129A (zh) | 一种干扰补偿的高超声速变后掠翼飞行器跟踪控制方法 | |
CN114942649B (zh) | 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法 | |
CN112947058B (zh) | 一种针对飞机三轴角速率控制的自抗扰型pid调参方法 | |
CN114721266B (zh) | 飞机舵面结构性缺失故障情况下的自适应重构控制方法 | |
Steffensen et al. | Longitudinal incremental reference model for fly-by-wire control law using incremental non-linear dynamic inversion | |
Liang et al. | Active disturbance rejection attitude control for a bird-like flapping wing micro air vehicle during automatic landing | |
CN117250867B (zh) | 一种多模式垂直起降飞行器自愈控制方法 | |
CN109656262B (zh) | 一种提高小型飞机着陆过程乘客舒适度的控制方法 | |
CN116088549B (zh) | 一种尾座式垂直起降无人机姿态控制方法 | |
Jiang et al. | Dynamic inversion PID based control law design for a flying wing aircraft | |
Song et al. | Nonlinear attitude control using extended state observer for tilt-rotor aircraft | |
CN110426955B (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 |