CN111198570B - 一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法 - Google Patents
一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法 Download PDFInfo
- Publication number
- CN111198570B CN111198570B CN202010080580.5A CN202010080580A CN111198570B CN 111198570 B CN111198570 B CN 111198570B CN 202010080580 A CN202010080580 A CN 202010080580A CN 111198570 B CN111198570 B CN 111198570B
- Authority
- CN
- China
- Prior art keywords
- attitude
- time
- channel
- pitch
- aircraft
- 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 41
- 206010034719 Personality change Diseases 0.000 claims abstract description 19
- 230000008859 change Effects 0.000 claims description 14
- 239000011159 matrix material Substances 0.000 claims description 12
- 230000008569 process Effects 0.000 claims description 12
- 239000013598 vector Substances 0.000 claims description 12
- 238000005070 sampling Methods 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 6
- 238000005096 rolling process Methods 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 230000000737 periodic effect Effects 0.000 claims description 3
- 238000006467 substitution reaction Methods 0.000 claims description 3
- 230000036544 posture Effects 0.000 claims description 2
- 238000010276 construction Methods 0.000 claims 2
- 238000004519 manufacturing process Methods 0.000 abstract description 4
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 2
- 230000003111 delayed effect Effects 0.000 description 2
- 230000010355 oscillation Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 239000006185 dispersion Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000007935 neutral 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/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
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Algebra (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法,属于制导与控制技术领域,具体方案如下:一种基于固定时间微分器的抗时延高精度自抗扰姿态控制方法,包括以下步骤:步骤一:设计固定时间收敛微分器并获取姿态变化速率观测值;步骤二:基于固定时间收敛微分器预测实时飞行状态;步骤三:构建飞行器三通道姿态误差跟踪模型;步骤四:构建自抗扰控制***,利用飞行器实时飞行状态,通过自抗扰控制***生成实时气动舵的摆动指令。本发明将能够有效降低我国飞行器的研制和生产成本,为提升我国航空实力提供技术支持。
Description
技术领域
本发明属于制导与控制技术领域,涉及一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法。
背景技术
高性能元器件的使用是实现飞行器高品质飞行的重要保障。然而高性能元器件带来的高成本也为国家财政带来了沉重负担。在保证飞行器飞行品质的同时,降低飞行器的生产成本,提高飞行器任务执行的效费比,是提升我国航空实力的有效途径。
然而,降低飞行器的生产成本意味着需要使用低成本但性能较差的元器件,这就对机载软件***设计提出了更高要求,如何利用高品质的导航、制导、控制等算法,实现对硬件***性能损失的有效补偿,是实现低成本飞行器的关键技术。以控制算法设计为例,低成本器件的使用可能引起实时姿态反馈信号的较大延时,传统飞行控制***设计方法在大延时条件下可能会引起飞行器飞行过程中的姿态往复振荡,陷入迟滞环状态,甚至会姿态发散失稳。因此,针对延时条件进行针对性的控制***设计,对提高低成本飞行器飞行品质,保证飞行器的任务执行效能,具有重要意义。
发明内容
本发明目的是为了解决低成本飞行器高延时条件下姿态稳定控制问题,提供了一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法,利用该算法有效弥补由于低成本器件带来的硬件性能损失,所采取的技术方案如下:
一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法,包括以下步骤:
步骤一:设计固定时间收敛微分器并获取姿态变化速率观测值;
步骤二:基于预测器预测实时飞行状态;
步骤三:构建飞行器三通道姿态误差跟踪模型;
步骤四:构建包含扰动状态观测器和非线性反馈律的自抗扰控制***,利用飞行器实时飞行状态,通过自抗扰控制***生成实时气动舵的摆动指令。
进一步地,步骤一所述设计固定时间收敛微分器并获取姿态变化速率观测值的过程为:
第二步:分别针对俯仰、偏航和滚转三个通道构建如下所示的三阶固定时间收敛微分器:
其中下标分别表示对应参数为俯仰、偏航和滚转通道的参数;yi(t)表示不同通道的测量值(即);t表示时间,z1i表示不同通道姿态角的观测值;z2i表示不同通道姿态变化速率的观测值;z3i表示不同通道姿态变化加速度观测值,,分别表示z1i、z2i和z3i关于时间t的导数,α1i,α2i,α3i表示大于1的高幂次项幂指数;β1i,β2i,β3i表示小于等于1的低幂次项幂指数,k1i和κ1i分别对应于固定时间收敛微分器大于1的高幂次项和小于等于1的低幂次项的增益系数。
第三步:设定俯仰、偏航、滚转通道的微分器初值为z1i(0)=y1i(0),z2i=0,z3i=0。y1i(0)表示的是俯仰角、偏航角和滚转角的初始状态。
进一步地,步骤二所述预测器预测实时飞行状态的过程为:
进一步的,步骤三中所述三通道姿态误差跟踪模型的构建过程为:
第一步:基于绕质心转动动力学和姿态运动学可构建飞行器姿态变化模型为:
其中ω=[ωx,ωy,ωz]为飞行器体轴的滚转、偏航、俯仰姿态角速率矢量,是俯仰、偏航和滚转角,δ表示飞行器的副翼、方向舵和升降舵,d表示飞行器的姿态通道扰动量,B1表示三通道的输入矩阵,J表示飞行器的转动惯量矩阵,表示Ω关于时间的导数,表示ω关于时间的导数,R表示转换矩阵,
其中Jx、Jy、Jz分别为体轴转动惯量,Jxy、Jxz、Jyz分别为不同惯性积。
第二步:基于输入输出线性化方法对公式(3)进行线性化,可得到相对阶为2的精确线性化模型为:
进一步的,步骤四中所述飞行器自抗扰控制***的构建过程为:
第二步:以俯仰通道为例,采用如下形式的非线性反馈律:
其中x1、x2即为和中俯仰通道对应状态量,r、d为待设计量,h即为采样步长,为俯仰通道控制量,即矢量RJ-1B1δ中与俯仰通道的对应分量。偏航通道和滚转通道可采用相同形式的反馈控制律,最后三通道解算出的控制量矢量形式设定为
第三步:以俯仰通道为例,采用如下形式的扰动状态观测器:
其中x2即为中俯仰通道对应状态量,z1为对x2的观测值,U1为上一控制解算周期俯仰通道的总控制量,z2即为对扰动D在俯仰通道的分量的估计值。偏航通道和滚转通道可采用相同形式的扰动观测器,最后三通道扰动观测器输出的扰动量设定为 分别为z1和z2关于时间的导数;β02,β03表示扰动状态观测器的增益系数;
第四步:综合公式(8)和公式(9),推导可得三通道的最终控制量为:
其中δ即为三通道的副翼、方向舵和升降舵。
本发明有益效果:
本发明提出了一种固定时间微分器预测的抗时延高精度自抗扰姿态控制方法。该方法以飞行器的副翼、方向舵和升降舵为执行机构,通过固定时间收敛微分器快速精确获取飞行器姿态角变化速率并基于此进行预测,以补偿速率陀螺的导航数据延时;进而基于预测后的姿态角信息和姿态指令信息进行自抗扰控制***构建,从而实时生成俯仰、偏航和滚转通道的气动舵摆角。相较于飞行器传统的控制方法,本发明所述基于固定时间预测的抗时延高精度自抗扰姿态控制方法能够有效应对由低成本器件带来的导航信息时滞现象,避免由于信息延迟带来的姿态振荡甚至失稳发散的情况,实现高延时条件下飞行器高品质姿态控制,保障飞行器的高战场打击效能,在低成本飞行器控制领域具有广阔的应用背景。
同时,通过本发明,将能够有效降低我国飞行器的研制和生产成本,为提升我国航空实力提供技术支持。
附图说明
图1是本发明所述基于固定时间收敛微分器预测的抗时延高精度自抗扰姿态控制方法结构框图。
具体实施方式
下面结合具体实施例对本发明做进一步说明,但本发明不受实施例的限制。
实施例1:
一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法,所述抗时延高精度姿态控制方法包括以下步骤:
步骤一:设计固定时间收敛微分器并获取姿态变化速率观测值。详细过程为:
第二步:分别针对俯仰、偏航和滚转三个通道构建如下所示的三阶固定时间收敛微分器:
其中下标分别表示对应参数为俯仰、偏航和滚转通道的参数;yi(t)表示不同通道的测量值(即);t表示时间,z1i表示不同通道姿态角的观测值;z2i表示不同通道姿态变化速率的观测值;z3i表示不同通道姿态变化加速度观测值,分别表示z1i、z2i和z3i关于时间t的导数,α1i,α2i,α3i表示大于1的高幂次项幂指数;β1i,β2i,β3i表示小于等于1的低幂次项幂指数,k1i和κ1i分别对应于固定时间收敛微分器大于1的高幂次项和小于等于1的低幂次项的增益系数。
第三步:设定俯仰、偏航、滚转通道的微分器初值为z1i(0)=y1i(0),z2i=0,z3i=0。y1i(0)表示的是俯仰角、偏航角和滚转角的初始状态。
步骤二:基于预测器预测实时飞行状态。详细过程为:
步骤三:构建飞行器的三通道姿态误差跟踪模型,详细过程为:
第一步:基于绕质心转动动力学和姿态运动学可构建飞行器姿态变化模型为:
其中ω=[ωx,ωy,ωz]为飞行器体轴的滚转、偏航、俯仰姿态角速率矢量,是俯仰、偏航和滚转角,δ表示飞行器的副翼、方向舵和升降舵,d表示飞行器的姿态通道扰动量,B1表示三通道的输入矩阵,J表示飞行器的转动惯量矩阵,,表示Ω关于时间的导数,表示ω关于时间的导数,R表示转换矩阵,
其中Jx、Jy、Jz分别为体轴转动惯量,Jxy、Jxz、Jyz分别为不同惯性积。
第二步:基于输入输出线性化方法对公式(3)进行线性化,可得到相对阶为2的精确线性化模型为:
步骤四:构建包含扰动状态观测器和非线性反馈律的飞行器自抗扰控制***,利用飞行器实时飞行状态,通过自抗扰控制***生成实时气动舵的摆动指令。详细步骤为:
第二步:以俯仰通道为例,采用如下形式的非线性反馈律:
其中x1、x2即为和中俯仰通道对应状态量,r、d为待设计量,h即为采样步长,为俯仰通道控制量,即矢量RJ-1B1δ中与俯仰通道的对应分量,a0,y,z,a,sy,sz均为非线性反馈律中过程量,无实际含义。偏航通道和滚转通道可采用相同形式的反馈控制律,最后三通道解算出的控制量矢量形式设定为
第三步:以俯仰通道为例,采用如下形式的扰动状态观测器:
其中x2即为中俯仰通道对应状态量,z1为对x2的观测值,U1为上一控制解算周期俯仰通道的总控制量,z2即为对扰动D在俯仰通道的分量的估计值。偏航通道和滚转通道可采用相同形式的扰动观测器,最后三通道扰动观测器输出的扰动量设定为 分别为z1和z2关于时间的导数;β02,β03表示扰动状态观测器的增益系数;
第四步:综合公式(8)和公式(9),推导可得三通道的最终控制量为:
其中δ即为三通道的副翼、方向舵和升降舵。
本发明针对低成本飞行器飞行控制中存在的速率陀螺导航信息延时高的现象而提出,在自抗扰姿态控制***的基础上,引入固定时间收敛微分器以进行抗时延实时飞行状态的高精度预测,并将预测后的姿态信息与姿态指令相综合从而生成实时气动舵摆角指令。该方法将有效提高高延时条件下姿态控制***的控制性能,有效保障低成本飞行器的高飞行品质和打击效能。
虽然本发明已以较佳的实施例公开如上,但其并非用以限定本发明,任何熟悉此技术的人,在不脱离本发明的精神和范围内,都可以做各种改动和修饰,因此本发明的保护范围应该以权利要求书所界定的为准。
Claims (1)
1.一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法,其特征在于,包括以下步骤:
步骤一:设计固定时间收敛微分器并获取姿态变化速率观测值;所述设计固定时间收敛微分器并获取姿态变化速率观测值的过程为:
第二步:分别针对俯仰、偏航和滚转三个通道构建如下所示的三阶固定时间收敛微分器:
其中下标分别表示对应参数为俯仰、偏航和滚转通道的参数;yi(t)表示不同通道的测量值,即t表示时间,z1i表示不同通道姿态角的观测值;z2i表示不同通道姿态变化速率的观测值;z3i表示不同通道姿态变化加速度观测值,分别表示z1i、z2i和z3i关于时间t的导数,α1i,α2i,α3i表示大于1的高幂次项幂指数;β1i,β2i,β3i表示小于等于1的低幂次项幂指数,k1i和κ1i分别对应于固定时间收敛微分器高幂次项和低幂次项的增益系数;
第三步:设定俯仰、偏航、滚转通道的微分器初值为z1i(0)=y1i(0),z2i=0,z3i=0,y1i(0)表示的是俯仰角、偏航角和滚转角的初始状态;
步骤二:基于预测器预测实时飞行状态;所述预测器预测实时飞行状态的过程为:
步骤三:构建飞行器三通道姿态误差跟踪模型;所述三通道姿态误差跟踪模型的构建过程为:
第一步:基于绕质心转动动力学和姿态运动学构建飞行器姿态变化模型为:
其中ω=[ωx,ωy,ωz]为飞行器体轴的滚转、偏航、俯仰姿态角速率矢量,是俯仰、偏航和滚转角,δ表示飞行器的副翼、方向舵和升降舵,d表示飞行器的姿态通道扰动量,B1表示三通道的输入矩阵,J表示飞行器的转动惯量矩阵,表示Ω关于时间的导数,表示ω关于时间的导数,R表示转换矩阵,
其中Jx、Jy、Jz分别为体轴转动惯量,Jxy、Jxz、Jyz分别为不同惯性积;
第二步:基于输入输出线性化方法对公式(3)进行线性化,得到相对阶为2的精确线性化模型为:
步骤四:构建包含扰动状态观测器和非线性反馈律的自抗扰控制***,利用飞行器实时飞行状态,通过自抗扰控制***生成实时气动舵的摆动指令;飞行器自抗扰控制***的构建过程为:
第二步:以俯仰通道为例,采用如下形式的非线性反馈律:
其中x1、x2即为和中俯仰通道对应状态量,r、d为待设计量,h即为采样步长,为俯仰通道控制量,即矢量RJ-1B1δ中与俯仰通道的对应分量;偏航通道和滚转通道采用相同形式的反馈控制律,最后三通道解算出的控制量矢量形式设定为
第三步:以俯仰通道为例,采用如下形式的扰动状态观测器:
其中x2即为中俯仰通道对应状态量,z1为对x2的观测值,U1为上一控制解算周期俯仰通道的总控制量,z2即为对扰动D在俯仰通道的分量的估计值;偏航通道和滚转通道采用相同形式的扰动观测器,最后三通道扰动观测器输出的扰动量设定为 分别为z1和z2关于时间的导数;β02,β03表示扰动状态观测器的增益系数;
第四步:综合公式(8)和公式(9),推导可得三通道的最终控制量为:
其中δ即为三通道的副翼、方向舵和升降舵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010080580.5A CN111198570B (zh) | 2020-02-05 | 2020-02-05 | 一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010080580.5A CN111198570B (zh) | 2020-02-05 | 2020-02-05 | 一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111198570A CN111198570A (zh) | 2020-05-26 |
CN111198570B true CN111198570B (zh) | 2021-06-01 |
Family
ID=70745308
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010080580.5A Active CN111198570B (zh) | 2020-02-05 | 2020-02-05 | 一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111198570B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112180727B (zh) * | 2020-10-01 | 2023-03-14 | 天水师范学院 | 一种大时滞非线性***的多率采样控制方法、***及应用 |
CN112965510B (zh) * | 2021-02-08 | 2022-02-18 | 中国科学院数学与***科学研究院 | 飞行器高速机动的全通道自抗扰控制方法 |
CN113009828B (zh) * | 2021-02-23 | 2022-07-22 | 桂林电子科技大学 | 一种复杂力学***动力学参数的抗干扰标定方法 |
CN114852376B (zh) * | 2022-04-01 | 2024-05-21 | 南京航空航天大学 | 一种基于解析预测的航天器变轨控制方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3425221B2 (ja) * | 1994-05-30 | 2003-07-14 | 株式会社東芝 | 電力系統安定化装置 |
CN101995822A (zh) * | 2010-09-26 | 2011-03-30 | 上海电力学院 | 一种大时滞***的灰色自抗扰控制方法 |
CN106842916B (zh) * | 2016-12-23 | 2018-12-21 | 中国科学院数学与***科学研究院 | 一种三维位置伺服***的预测自抗扰控制方法 |
CN108227485B (zh) * | 2017-12-01 | 2020-11-24 | 西北工业大学 | 一种带有执行器饱和的空间机器人自抗扰控制方法 |
CN108536020B (zh) * | 2018-07-17 | 2019-06-21 | 哈尔滨工业大学 | 一种针对垂直起降重复使用运载器的模型参考自适应滑模控制方法 |
CN108873704B (zh) * | 2018-07-19 | 2021-07-20 | 北京空间技术研制试验中心 | 基于预测跟踪微分器的线性自抗扰控制器的设计方法 |
-
2020
- 2020-02-05 CN CN202010080580.5A patent/CN111198570B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN111198570A (zh) | 2020-05-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111198570B (zh) | 一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法 | |
CN110531777B (zh) | 基于自抗扰控制技术的四旋翼飞行器姿态控制方法和*** | |
CN109189085B (zh) | 基于事件触发的航天器网络化***姿态控制方法 | |
CN108445748B (zh) | 一种基于事件触发机制的自适应航天器姿态跟踪控制方法 | |
CN109062042B (zh) | 一种旋翼飞行器的有限时间航迹跟踪控制方法 | |
CN110531776B (zh) | 基于自抗扰控制技术的四旋翼飞行器位置控制方法和*** | |
CN109062043B (zh) | 考虑网络传输以及执行器饱和的航天器自抗扰控制方法 | |
CN105607473B (zh) | 小型无人直升机的姿态误差快速收敛自适应控制方法 | |
CN112346470A (zh) | 一种基于改进自抗扰控制的四旋翼姿态控制方法 | |
CN107807657B (zh) | 一种基于路径规划的挠性航天器姿态自适应控制方法 | |
CN111522352B (zh) | 多旋翼飞行器单参数自抗扰姿态控制器设计方法 | |
CN111831002B (zh) | 一种基于预设性能的超高声速飞行器姿态控制方法 | |
CN109507890A (zh) | 一种基于eso的无人机动态逆广义预测控制器 | |
CN111026160A (zh) | 一种四旋翼无人机轨迹跟踪控制方法 | |
Mechali et al. | Robust Finite‐Time Trajectory Tracking Control of Quadrotor Aircraft via Terminal Sliding Mode‐Based Active Antidisturbance Approach: A PIL Experiment | |
CN112286053A (zh) | 一种高机动微型无人机的制导控制一体化方法 | |
CN115576341A (zh) | 基于函数微分和自适应变增益的无人机轨迹跟踪控制方法 | |
CN109976364B (zh) | 一种六旋翼飞行器姿态解耦控制方法 | |
CN113619814A (zh) | 一种交会对接最后逼近段相对姿轨耦合控制方法 | |
CN115202213A (zh) | 一种基于自抗扰控制的四旋翼飞行器控制方法 | |
CN110888447A (zh) | 基于非线性pd双闭环控制的四旋翼3d路径跟踪方法 | |
CN111413996B (zh) | 一种基于事件触发eso的四旋翼保性能轨迹跟踪控制方法 | |
CN116643576A (zh) | 一种基于事件触发的无人飞艇轨迹跟踪控制方法及*** | |
CN116880535A (zh) | 一种改进二阶自抗扰控制四旋翼无人机的姿态控制方法 | |
El Ferik et al. | Robust FOSMC of quadrotor in the presence of slung load |
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 |