CN108490788B - 一种基于双干扰观测的飞行器俯仰通道反演控制方法 - Google Patents
一种基于双干扰观测的飞行器俯仰通道反演控制方法 Download PDFInfo
- Publication number
- CN108490788B CN108490788B CN201810431148.9A CN201810431148A CN108490788B CN 108490788 B CN108490788 B CN 108490788B CN 201810431148 A CN201810431148 A CN 201810431148A CN 108490788 B CN108490788 B CN 108490788B
- Authority
- CN
- China
- Prior art keywords
- aircraft
- angle
- attack
- rate
- alpha
- 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.)
- Expired - Fee Related
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
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于双干扰观测的飞行器俯仰通道反演控制方法,测量飞行器攻角与俯仰角速率,并构造内回路的力干扰观测器;构造攻角误差,设计俯仰角速率期望值的反演控制律;定义俯仰角速率误差,构建外回路干扰观测器;构建飞行器攻角反演跟踪控制律,实现飞行器俯仰通道攻角跟踪攻角指令。本发明的有益效果是具有很好的稳定性与鲁棒性,具有很高的工程实用价值。
Description
技术领域
本发明属于飞行器控制技术领域,涉及一种采样干扰观测器来解决飞行器俯仰通道的不确定性问题并控制飞行器攻角的方法。
背景技术
一般非倾斜转弯的常规飞行器控制可以分为俯仰通道控制、偏航通道控制与滚转通道控制,其中滚转通道一般采用PID控制,而俯仰通道与偏航通道是对称的,故两者可以采用相似的控制律,因此飞行器俯仰通道控制律在三通道可分离设计类型的飞行器控制中占主要地位。目前传统的经典方法是针对特征点简化模型进行控制器设计,当然也有部分研究者直接针对飞行器的俯仰通道非线性模型直接进行设计,两者在工程实际中均取得了较好的效果。由于飞行器高速运动过程中,受到的力与力矩是很难以准确进行建模的,因此很多学者对模型的不确定性部分引入了各种各样的自适应控制方法、变结构控制方法等非线性控制方法,以适应模型的不确定性,使得所设计的飞行器控制***具有良好的鲁棒性。本发明提出一种在飞行器力与力矩两个层面引入两个干扰观测器的方法来补偿未知力与力矩对控制***设计的影响,从而得到一类基于反演的攻角跟踪控制方法,最后仿真实验结果也表明了本方法不仅在理论上是新颖的,而且在工程实际中也是可行并有效的,从而能对各种高空或低空飞行器的控制能提高理论指导与借鉴。
发明内容
本发明的目的在于提供一种基于双干扰观测的飞行器俯仰通道反演控制方法,本发明的有益效果是具有很好的稳定性与鲁棒性,具有很高的工程实用价值。
本发明所采用的技术方案是按照以下步骤进行:
步骤一:测量飞行器攻角与俯仰角速率,并构造内回路的力干扰观测器;
首先采用攻角传感器,安装于飞行器纵轴上,测量飞行器的攻角,记为α;
其次采用速率陀螺仪,安装于飞行器纵轴上,测量飞行器俯仰角速率,记为ωz;
最后按照如下微分方程构造内回路的力干扰观测器,
其中与为飞行器内回路未知干扰力D的估计值,而为飞行器攻角α的估计值,为的导数,为的导数,sign为符号函数,k0与k1为力干扰观测器的增益,可以设计为正值,一般可选为大于2的正数。a34为飞行器俯仰通道简化模型的实验参数,根据飞行器风洞实验数据确定。
步骤二:构造攻角误差,设计俯仰角速率期望值的反演控制律
首先根据上述攻角传感器测量的攻角α,并与期望的攻角指令αd进行比较,得到攻角误差信号eα如下
eα=α-αd;
其中αd是控制***为了实现飞行器给定飞行任务而设计的攻角指令。
步骤三:定义俯仰角速率误差,构建外回路干扰观测器
其次,按照如下微分方程构建外回路干扰观测器
其中与为飞行器外回路未知干扰力矩与其它未知干扰W的估计值,而为飞行器俯仰角速率误差eω的估计值。为eω的导数,为的导数。sign为符号函数,kw0与kw1为力干扰观测器的增益,可以设计为正值,一般可选为大于2的正数。a24、a22、a25为飞行器俯仰通道简化模型的实验参数,根据飞行器风洞实验数据确定。
步骤四:构建飞行器攻角反演跟踪控制律
按照上述规律设计飞行器俯仰通道的舵偏角控制律δz即可实现飞行器俯仰通道攻角α跟踪攻角指令αd。
附图说明
图1是基于双干扰观测器实现飞行器俯仰通道反演控制方法的原理框图;
图2是本发明实施例提供的攻角期望值为3度情况下的飞行器攻角跟踪曲线;
图3是本发明实施例提供的攻角期望值为3度情况下的飞行器角速度响应曲线;
图4是本发明实施例提供的攻角期望值为3度情况下的飞行器舵偏响应曲线,最大舵偏角不超过2度;
图5是本发明实施例提供的攻角期望值为3度情况下的第一个力干扰观测器的真实值与估计值对比曲线;
图6是本发明实施例提供的攻角期望值为3度情况下的第二个力矩干扰观测器的真实值与估计值对比曲线;
图7是本发明实施例提供的攻角期望值为-2度情况下的飞行器攻角跟踪曲线;
图8是本发明实施例提供的攻角期望值为-2度情况下的飞行器角速度响应曲线;
图9是本发明实施例提供的攻角期望值为-2度情况下的飞行器舵偏响应曲线,最大舵偏角不超过2度;
图10是本发明实施例提供的攻角期望值为-2度情况下的第一个力干扰观测器的真实值与估计值对比曲线;
图11是本发明实施例提供的攻角期望值为-2度情况下的第二个力矩干扰观测器的真实值与估计值对比曲线。
具体实施方式
下面结合具体实施方式对本发明进行详细说明。
如图1所示为基于双干扰观测器实现飞行器俯仰通道反演控制方法的原理框图。
步骤一中sign为符号函数的定义为:
步骤三中与为飞行器外回路未知干扰力矩与其它未知干扰W的估计值,其初始值选取为0即可。a24=-193、a22=-2.8、a25=-168,kw0与kw1为力干扰观测器的增益,设计为kw0=5,kw1=5。
最终得到的攻角跟踪曲线分别见图2与图7,图2的期望攻角设置为3度,而图7为期望攻角为-2度时飞行器的响应曲线。由两图可以看出,不论期望攻角为正还是为负,本发明所设计的舵偏角控制律都能较好地控制飞行器攻角跟踪期望指令。而图3与图8给出了期望攻角分别为3度与-2度情况下的飞行器角速度响应曲线,图4与图9分别给出了期望攻角分别为3度与-2度情况下的飞行器舵偏角曲线,可见最大舵偏角均不超过2度,能够很好地满足工程需要。图6与图11分别给出了期望攻角分别为3度与-2度情况下第二个力矩观测器的输出,而图5与图10分别给出了期望攻角分别为3度与-2度情况下第一个力观测器的输出,由图形可以看出,其观测器的输出是稳定的,而且都能够完成预定设计的观测功能。综述所述:本发明所提出的一种双干扰观测的飞行器俯仰通道反演控制的方法是可行而有效的。
本发明采用了内外回路两个干扰观测器分别观测飞行器的未知不确定干扰力与干扰力矩,同时该方法采用了反演控制手段,故内回路测量飞行器的攻角,并根据攻角误差与内回路的未知干扰力的观测结果,设计飞行器的俯仰角速度期望值;外回路通过测量飞行器的俯仰角,并与内回路得到的俯仰角速度期望值进行比较得到俯仰角误差,然后设计外回路的干扰观测器来观测未知干扰力矩与内回路俯仰角速度期望值的导数;最后综合上述俯仰角误差与外回路干扰观测器输出,设计最终的飞行器攻角反演跟踪控制器。本发明方法由于采用了外回路的第二个干扰观测器设计,不仅可以观测飞行器俯仰通道的未知干扰力矩,同时也可以观测内回路的期望俯仰角导数,从而可以解决传统反演控制的导数求取算法复杂的问题。同时由于采用了双干扰观测器的方法,因此本方案对飞行器飞行过程中的未知力与力矩以及其它未建模不确定性具有很好的补偿作用。因此本设计方案具有很好的稳定性与鲁棒性,因此它具有很高的工程实用价值,同时其设计思想不仅能够应用于高速飞行器的稳定控制,也能推广应用于一般低速运动体稳定控制。
以上所述仅是对本发明的较佳实施方式而已,并非对本发明作任何形式上的限制,凡是依据本发明的技术实质对以上实施方式所做的任何简单修改,等同变化与修饰,均属于本发明技术方案的范围内。
Claims (1)
1.一种基于双干扰观测的飞行器俯仰通道反演控制方法,其特征在于按照以下步骤进行:
步骤一:测量飞行器攻角与俯仰角速率,并构造内回路的力干扰观测器:
首先采用攻角传感器,安装于飞行器纵轴上,测量飞行器的攻角,记为α;
其次采用速率陀螺仪,安装于飞行器纵轴上,测量飞行器俯仰角速率,记为ωz;
最后按照如下微分方程构造内回路的力干扰观测器,
其中为飞行器内回路未知干扰力D的估计值,而为飞行器攻角α的估计值,为的导数,为的导数,sign为符号函数,k0与k1为力干扰观测器的增益,a34为飞行器俯仰通道简化模型的实验参数,根据飞行器风洞实验数据确定;
步骤二:构造攻角误差,设计俯仰角速率期望值的反演控制律:
首先根据上述攻角传感器测量的攻角α,并与期望的攻角指令αd进行比较,得到攻角误差信号eα如下
eα=α-αd;
步骤三:定义俯仰角速率误差,构建外回路干扰观测器:
其次,按照如下微分方程构建外回路干扰观测器
其中与为飞行器外回路未知干扰力矩与其它未知干扰W的估计值,而为飞行器俯仰角速率误差eω的估计值,为eω的导数,为的导数,sign为符号函数,kw0与kw1为力干扰观测器的增益,a24、a22、a25为飞行器俯仰通道简化模型的实验参数,根据飞行器风洞实验数据确定;
步骤四:构建飞行器攻角反演跟踪控制律,
实现飞行器俯仰通道攻角跟踪攻角指令:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810431148.9A CN108490788B (zh) | 2018-05-08 | 2018-05-08 | 一种基于双干扰观测的飞行器俯仰通道反演控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810431148.9A CN108490788B (zh) | 2018-05-08 | 2018-05-08 | 一种基于双干扰观测的飞行器俯仰通道反演控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108490788A CN108490788A (zh) | 2018-09-04 |
CN108490788B true CN108490788B (zh) | 2021-06-01 |
Family
ID=63353094
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810431148.9A Expired - Fee Related CN108490788B (zh) | 2018-05-08 | 2018-05-08 | 一种基于双干扰观测的飞行器俯仰通道反演控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108490788B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109991991B (zh) * | 2019-02-26 | 2020-03-20 | 南京航空航天大学 | 一种无人直升机鲁棒容错跟踪方法 |
CN110764523B (zh) * | 2019-11-13 | 2022-09-13 | 中国人民解放军海军航空大学 | 基于抗饱和平滑变换的比例积分前置导引攻击目标的方法 |
CN110794864B (zh) * | 2019-11-29 | 2022-09-30 | 中国人民解放军海军工程大学 | 基于姿态角速率与攻角测量的飞行器稳定控制方法 |
CN110889170B (zh) * | 2019-11-29 | 2022-09-30 | 中国人民解放军海军工程大学 | 飞行器大角度攻击目标的落角与攻角的估计方法 |
CN111290415B (zh) * | 2019-12-04 | 2023-04-07 | 中国人民解放军海军航空大学 | 一种基于近似差分的飞行器综合前置导引方法 |
CN111290423B (zh) * | 2020-03-25 | 2023-04-07 | 中国人民解放军海军工程大学 | 一种基于自适应反演的飞行器俯仰角跟踪方法 |
CN111427267B (zh) * | 2020-04-01 | 2022-08-30 | 山东创惠电子科技有限责任公司 | 一种采用力与力矩自适应估计的高速飞行器攻角跟踪方法 |
CN111650838B (zh) * | 2020-07-02 | 2022-09-06 | 中国人民解放军海军航空大学 | 一种采用自适应观测器的飞行器俯仰通道稳定方法 |
CN112034885B (zh) * | 2020-09-08 | 2022-08-23 | 中国人民解放军海军航空大学 | 一种采用低成本倾角仪测量的无人飞行器滚转稳定方法 |
CN114047776B (zh) * | 2021-11-27 | 2023-10-13 | 山东创惠电子科技有限责任公司 | 一种基于双时变增益自适应的飞行器攻角跟踪控制方法 |
CN114310874B (zh) * | 2021-12-20 | 2024-06-18 | 中国科学院宁波材料技术与工程研究所 | 协作机器人关节力矩控制方法、***及计算机设备 |
CN116500908B (zh) * | 2023-02-27 | 2024-04-09 | 扬州大学 | 一种双扰动观测器的机械臂抗干扰约束控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104199286A (zh) * | 2014-07-15 | 2014-12-10 | 北京航空航天大学 | 一种基于滑模干扰观测器的飞行器递阶动态逆控制方法 |
CN106444826A (zh) * | 2016-09-07 | 2017-02-22 | 广西师范大学 | 四旋翼无人飞行器的飞行控制方法 |
CN107367941A (zh) * | 2017-08-25 | 2017-11-21 | 中国人民解放军海军航空工程学院 | 基于非线性增益的高超声速飞行器攻角观测方法 |
CN107608367A (zh) * | 2017-09-06 | 2018-01-19 | 天津大学 | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 |
-
2018
- 2018-05-08 CN CN201810431148.9A patent/CN108490788B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104199286A (zh) * | 2014-07-15 | 2014-12-10 | 北京航空航天大学 | 一种基于滑模干扰观测器的飞行器递阶动态逆控制方法 |
CN106444826A (zh) * | 2016-09-07 | 2017-02-22 | 广西师范大学 | 四旋翼无人飞行器的飞行控制方法 |
CN107367941A (zh) * | 2017-08-25 | 2017-11-21 | 中国人民解放军海军航空工程学院 | 基于非线性增益的高超声速飞行器攻角观测方法 |
CN107608367A (zh) * | 2017-09-06 | 2018-01-19 | 天津大学 | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 |
Non-Patent Citations (3)
Title |
---|
A Disturbance Observer Based Backstepping Controller Design for Missile Pitch Channel Systems;Wenguang Zhang等;《Proceedings of the 2017 4th International Conference on Machinery, Materials and Computer (MACMC 2017)》;20180131;第150卷;第695-699页 * |
含干扰观测器的高超声速飞行器新型滑模姿态控制;郭建国等;《西北工业大学学报》;20171231;第35卷(第6期);第941-947页 * |
面向高超声速飞行器的新型复合神经网络预测控制方法;马宇等;《西安交通大学学报》;20170630;第51卷(第6期);第28-34,65页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108490788A (zh) | 2018-09-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108490788B (zh) | 一种基于双干扰观测的飞行器俯仰通道反演控制方法 | |
CN106444799B (zh) | 基于模糊扩张状态观测器和自适应滑模的四旋翼无人机控制方法 | |
Ramirez-Rodriguez et al. | Robust backstepping control based on integral sliding modes for tracking of quadrotors | |
CN109976349B (zh) | 一种含约束无人船的路径跟踪制导与控制结构的设计方法 | |
Zhen et al. | Automatic carrier landing control for unmanned aerial vehicles based on preview control and particle filtering | |
CN105629734B (zh) | 一种近空间飞行器的轨迹跟踪控制方法 | |
CN109189087B (zh) | 一种垂直起降重复使用运载器的自适应容错控制方法 | |
CN109782795B (zh) | 一种利用耦合的面对称高超声速飞行器横侧向控制方法及控制*** | |
CN106406325B (zh) | 基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法 | |
CN104950901B (zh) | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 | |
CN106773713A (zh) | 针对欠驱动海洋航行器的高精度非线性路径跟踪控制方法 | |
CN107390531B (zh) | 参数学习有限时间收敛的高超声速飞行器控制方法 | |
CN110119089A (zh) | 一种基于积分滑模的浸入不变流型自适应四旋翼控制方法 | |
CN111367182A (zh) | 考虑输入受限的高超声速飞行器抗干扰反步控制方法 | |
CN109828467B (zh) | 一种数据驱动的无人船强化学习控制器结构及设计方法 | |
CN109507890A (zh) | 一种基于eso的无人机动态逆广义预测控制器 | |
CN106054884A (zh) | 基于神经网络的l1自适应船舶动力定位双环控制*** | |
CN106527122A (zh) | 平流层飞艇定高飞行非线性pid控制方法 | |
CN108646557A (zh) | 一种基于跟踪微分与柔化函数的飞行器攻角跟踪控制方法 | |
CN113867352A (zh) | 一种全垫升气垫船路径跟踪方法 | |
Hervas et al. | Sliding mode control of fixed-wing uavs in windy environments | |
CN113759718A (zh) | 一种飞机机翼损伤自适应控制方法 | |
Lungu et al. | Inverse optimal control for autonomous carrier landing with disturbances | |
CN106681337B (zh) | 基于奇次滑模的平流层飞艇定高飞行控制方法 | |
CN117289709A (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210601 |
|
CF01 | Termination of patent right due to non-payment of annual fee |