CN106483967B - 一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法 - Google Patents
一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法 Download PDFInfo
- Publication number
- CN106483967B CN106483967B CN201611103815.8A CN201611103815A CN106483967B CN 106483967 B CN106483967 B CN 106483967B CN 201611103815 A CN201611103815 A CN 201611103815A CN 106483967 B CN106483967 B CN 106483967B
- Authority
- CN
- China
- Prior art keywords
- dirigible
- angle
- pitch
- sliding
- attitude
- 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
- 238000005259 measurement Methods 0.000 title claims abstract description 20
- 238000009415 formwork Methods 0.000 title claims abstract description 9
- 230000003044 adaptive effect Effects 0.000 claims abstract description 11
- 238000011105 stabilization Methods 0.000 claims abstract description 8
- 230000006641 stabilisation Effects 0.000 claims abstract description 7
- 238000013461 design Methods 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 claims description 9
- 239000011159 matrix material Substances 0.000 claims description 9
- 238000004088 simulation Methods 0.000 claims description 7
- 238000000034 method Methods 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 4
- 238000010276 construction Methods 0.000 claims description 2
- 230000009286 beneficial effect Effects 0.000 abstract description 2
- 230000036632 reaction speed Effects 0.000 abstract description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 239000005437 stratosphere Substances 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 238000005094 computer simulation Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000005336 cracking Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000012360 testing method 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/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)
Abstract
本发明公开了一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法,采用测角陀螺与速率陀螺完成飞艇俯仰通道姿态角与姿态角速率的测量,形成俯仰角误差变量,采用角度与角速率信息构造滑模面,综合滑模面与前向速度控制量,采用自适应策略构造俯仰通道姿态角稳定控制律,并输出给飞艇的执行机构,从而实现飞艇俯仰通道的姿态跟踪与稳定;本发明的有益效果是能够提供比传统PID控制更好的姿态角操纵与反应速度。
Description
技术领域
本发明属于低速大延迟飞行器控制技术领域,涉及一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法。
背景技术
平流层,又称同温层,距离地球表面10km~50km,气流以水平为主,基本没有上下对流,气候条件比较合适,湿度小,具有良好的电磁特性。平流层基本气候条件相对平稳,非常利于飞艇悬停。平流层飞艇因其工作的环境具有良好的气候条件,非常适合作为空中平台进行通讯和观测。从20世纪90年代以来,国际上掀起了研究发展平流层飞艇的高潮。但由于飞艇作为一种低速高空飞行器,具有体积大,难以精确建模;控制操纵不灵活,尤其是其大延迟的特点,使得传统的PID控制难以得到较好的动态特性。
发明内容
本发明的目的在于提供一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法,解决了飞艇作为一种低速高空飞行器,具有体积大,难以精确建模;控制操纵不灵活和大延迟的特点,使得传统的PID控制难以得到较好的动态特性的问题。
本发明所采用的技术方案按照以下步骤进行:
步骤1、采用测角陀螺与速率陀螺完成飞艇俯仰通道姿态角与姿态角速率的测量,形成俯仰角误差变量eq=θ-θd,飞艇俯仰角θ、俯仰角速度q、姿态角θd;步骤2、采用角度与角速率信息构造滑模面:
在飞艇上控制计算机中进行乘法与加法运算,形成滑模面s1,其满足如下形式:
s1=c1eq+q
其中c1为正的常数;
步骤3、综合滑模面与前向速度控制量,采用自适应策略构造俯仰通道姿态角稳定控制律,并输出给飞艇的执行机构,从而实现飞艇俯仰通道的姿态跟踪与稳定;
设计飞艇俯仰通道姿态角自适应滑模控制律u1a:
其中u2为飞艇前向速度控制量;
项用于补偿前向速度控制量的变化,或飞艇速度变化对姿态角控制通道的干扰;
其初始值选取为Γ4为正常数,k0为正常数;
其初始值选取为Γ1为正常数;
其初始值选取为Γ2为正常数;
其初始值选取为Γ3为正常数;
最终姿态角稳定控制律u1如下:
进一步,建立飞艇俯仰通道的微分方程数学模型,近似模拟飞艇俯仰通道的特性,通过不断调整控制参数,并观察飞艇各状态的数据,并画图,以获到满意的***性能,从而最终确定飞艇控制参数;
飞艇俯仰通道的微分方程数学模型如下:
其中
而a11,a13,a22,a31,a33由计算M矩阵的逆阵而获得,即满足
而M矩阵有飞艇的质量与转动惯量所决定,求取方法如下:
I3为3阶单位矩阵;
其中m为飞艇的质量,az为常量,m11、m33、m55由飞艇质量分布与转动惯量所决定:m11=km1Mr,m33=km2Mr,m55=km3Iy,其中km1=0.1053;km2=0.8260;km3=0.1256,Mr=ρV,其中ρ为大气密度,V为飞艇的体积;
Q为动压头,其计算方法为Q=0.5ρVf 2;Vf为飞艇的运动速度;
为飞艇的前向飞行加速度;为艇体坐标系中飞艇的前向飞行速度;
为飞艇的垂向飞行加速度;为艇体坐标系中飞艇的垂向飞行速度;
为飞艇的俯仰角加速度;q为飞艇的俯仰角速度;
为飞艇的俯仰角速度,θ为飞艇的俯仰角;
为发射坐标系中飞艇的前向飞行速度;x为飞艇的前向飞行距离;
为发射坐标系中飞艇的垂向飞行速度;z为飞艇的飞行高度;
kg1与kg2为舵效常数,为空气动力学系数;
CX1、CX2、Cz1、Cz2与Cz3为飞艇受力相关的空气动力系数,CM1、CM2、 CM3为飞艇受力矩相关的空气动力系数。
进一步,所述步骤2中c1的值为10。
进一步,所述步骤3中Γ4=0.01,k0=8.5,Γ1=0.001,Γ2=0.003,Γ3=0.001。
本发明的有益效果是能够提供比传统PID控制更好的姿态角操纵与反应速度。
附图说明
图1是本发明提供的一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法原理框图;
图2是本发明实施例提供的飞艇的前向运动速度曲线;
图3是本发明实施例提供的飞艇的垂向运动速度曲线;
图4是本发明实施例提供的给定-10度情况下的飞艇俯仰角跟踪曲线;
图5是本发明实施例提供的飞艇的俯仰角速率曲线;
图6是本发明实施例提供的飞艇的水平飞行距离曲线;
图7为本发明实施例提供的飞艇的飞行高度曲线;
图8为本发明实施例提供的飞艇的俯仰舵偏角曲线;
图9为本发明实施例提供的给定-10度情况下的飞艇俯仰角跟踪曲线。
具体实施方式
下面结合具体实施方式对本发明进行详细说明。
本发明技术方案包括如下五步:
步骤一:采用测角陀螺与速率陀螺完成飞艇俯仰通道姿态角与姿态角速率的测量,形成俯仰角误差信号。
如图1所示,采用由测角陀螺与速率陀螺形成的陀螺组合,安装于飞艇俯仰轴位置,分别测量飞艇俯仰角θ与俯仰角速度q,将上述测量信号进行A/D转换,输入给飞艇上的计算机控制***。同时假设姿态角指令为θd,利用飞艇上控制计算机进行相减,得到俯仰角误差变量eq,那么其满足eq=θ-θd。
步骤二:采用角度与角速率信息构造滑模面。
在飞艇上控制计算机中进行乘法与加法运算,形成滑模面,其满足如下形式:
s1=c1eq+q
其中c1为正的常数,可优选设计为10。
步骤三:综合滑模面与前向速度控制量,采用自适应策略构造俯仰通道姿态角稳定控制律,并输出给飞艇的执行机构,从而实现飞艇俯仰通道的姿态跟踪与稳定
设计飞艇俯仰通道姿态角自适应滑模控制律u1a设计如下:
其中u2为飞艇前向速度控制量,用于稳定飞艇的前向运动速度,可采用简单的常值规律,或者PID控制规律。
项用于补偿前向速度控制量的变化,或飞艇速度变化对姿态角控制通道的干扰。
设计如下:其初始值选取为Γ4为正常数,选取为Γ4=0.01。
k0为正常数,可选取为k0=8.5。s1为滑模面,q为飞艇俯仰角速度。
与设计如下:
其初始值选取为Γ1为正常数,例如可选取为Γ1=0.001。
其初始值选取为Γ2为正常数,例如可选取为Γ2=0.003。
其初始值选取为Γ3为正常数,例如可选取为Γ3=0.001。
其最终姿态角稳定控制律u1设计如下:
其主要思路是将u1a通过饱和限幅,使得其不超过飞艇最大可用舵偏角30度的物理限制,57.3为度到弧的转换。
步骤四:建立如下飞艇俯仰通道的微分方程数学模型,近似模拟飞艇俯仰通道的特性。
其中
而a11,a13,a22,a31,a33由计算M矩阵的逆阵而获得,即满足
而M矩阵有飞艇的质量与转动惯量所决定,其求取方法如下:
I3为3阶单位矩阵。
其中m为飞艇的质量,az为常量,如某型飞艇可选为m=53345;az=16.8, m11、m33、m55由飞艇质量分布与转动惯量所决定:m11=km1Mr,m33=km2Mr, m55=km3Iy,其中km1=0.1053;km2=0.8260;km3=0.1256。如某型飞艇参数设计为Iy=5.9*109,以上单位均为国际标准单位。Mr=ρV,其中ρ为大气密度,V为飞艇的体积。
Q为动压头,其计算方法为Q=0.5ρVf 2;Vf为飞艇的运动速度。
为飞艇的前向飞行加速度;为艇体坐标系中飞艇的前向飞行速度;
为飞艇的垂向飞行加速度;为艇体坐标系中飞艇的垂向飞行速度;
为飞艇的俯仰角加速度;q为飞艇的俯仰角速度;
为飞艇的俯仰角速度,θ为飞艇的俯仰角;
为发射坐标系中飞艇的前向飞行速度;x为飞艇的前向飞行距离;
为发射坐标系中飞艇的垂向飞行速度;z为飞艇的飞行高度;
kg1与kg2为舵效常数,为空气动力学系数,其数据来自于飞艇风洞试验。
CX1、CX2、Cz1、Cz2与Cz3为飞艇受力相关的空气动力系数,CM1、CM2、CM3为飞艇受力矩相关的空气动力系数,各型飞艇的计算方式略有不同,其数据来自于飞艇的风洞实验数据。
将步骤三所得的控制量代入所建立的飞艇俯仰通道的微分方程数学模型,通过不断调整控制参数,并观察飞艇各状态的数据,并画图,以获到满意的***性能,从而最终确定飞艇控制参数。
案例实施与计算机仿真模拟结果分析
采用常值规律使得飞艇前向速度基本稳定,如设定u2=5000时,飞艇前进速度大约保持在20m/s左右,如果设定u2=10000,则飞艇前进速度大约保持在 30m/s左右。在前向速度稳定的基础上,进行俯仰通道给定俯仰角的跟踪控制器设计。选取参数c1=10,k0=0.3,Γ1=0.001,Γ2=0.005,Γ3=0.002,θd=2/57.3,分别针对给定俯仰角θd=2/57.3以及θd=-10/57.3给出控制参数的设计与仿真结果,得到仿真结果如图2至图9所示。
通过以上仿真结果与曲线可以看出,由于本发明采用了自适应方法,因此仅需测量飞艇的姿态角与姿态角速率信号,从而控制方案实施容易,而且经济上节省,控制方案不依赖飞艇气动参数,具有较好的鲁棒性,仿真结果表明该控制策略在飞艇大速度速与低速运行时均能稳定跟踪大的姿态角信号与小的姿态角信号,因此其具有较高的经济价值与实用价值。本发明通过测角陀螺测量飞艇俯仰角,通过角速率陀螺来测量飞艇俯仰角速率,在采用常值或PID控制规律来稳定飞艇的前向运动速率的情况下,采用上述测量的角度信息与角速度信息构造滑模面并采用自适应策略形成飞艇俯仰通道的俯仰角稳定跟踪方法。由于飞艇这样的被控对象具有大延迟的特点,因此传统的PID控制会使得飞艇俯仰角跟踪响应慢。而本发明所提出的控制方案中由于采用了滑模控制方法,能够大大加快飞艇俯仰通道的姿态响应速度,同时在控制方案中多处引入了自适应的思想,用于解决飞艇***的不确定性。比如在设计中引入了前向速度控制量的自适应补偿项,来消除飞艇速度变化对俯仰通道控制带来的扰动。因此本发明所提供的设计方法,具有较强的抗干扰与抗模型不确定性特性,同时该设计又使得飞艇俯仰通道对姿态角指令具有很快的响应速度,从而具有很高的工程应用价值。
以上所述仅是对本发明的较佳实施方式而已,并非对本发明作任何形式上的限制,凡是依据本发明的技术实质对以上实施方式所做的任何简单修改,等同变化与修饰,均属于本发明技术方案的范围内。
Claims (4)
1.一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法,其特征在于按照以下步骤进行:
步骤1、采用测角陀螺与速率陀螺完成飞艇俯仰通道姿态角与姿态角速率的测量,形成俯仰角误差变量eq=θ-θd,飞艇俯仰角θ、俯仰角速度q、姿态角θd;步骤2、采用角度与角速率信息构造滑模面:
在飞艇上控制计算机中进行乘法与加法运算,形成滑模面s1,其满足如下形式:
s1=c1eq+q
其中c1为正的常数;
步骤3、综合滑模面与前向速度控制量,采用自适应策略构造俯仰通道姿态角稳定控制律,并输出给飞艇的执行机构,从而实现飞艇俯仰通道的姿态跟踪与稳定;
设计飞艇俯仰通道姿态角自适应滑模控制律u1a:
其中u2为飞艇前向速度控制量;
项用于补偿前向速度控制量的变化,或飞艇速度变化对姿态角控制通道的干扰;
其初始值选取为Γ4为正常数,k0为正常数;
其初始值选取为Γ1为正常数;
其初始值选取为Γ2为正常数;
其初始值选取为Γ3为正常数;
最终姿态角稳定控制律u1如下:
2.按照权利要求1所述一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法,其特征在于:建立飞艇俯仰通道的微分方程数学模型,近似模拟飞艇俯仰通道的特性,通过不断调整控制参数,并观察飞艇各状态的数据,并画图,以获到满意的***性能,从而最终确定飞艇控制参数;
飞艇俯仰通道的微分方程数学模型如下:
其中
而a11,a13,a22,a31,a33由计算M矩阵的逆阵而获得,即满足
而M矩阵有飞艇的质量与转动惯量所决定,求取方法如下:
I3为3阶单位矩阵;
其中m为飞艇的质量,az为常量,m11、m33、m55由飞艇质量分布与转动惯量所决定:m11=km1Mr,m33=km2Mr,m55=km3Iy,其中km1=0.1053;km2=0.8260;km3=0.1256,Mr=ρV,其中ρ为大气密度,V为飞艇的体积;
Q为动压头,其计算方法为Q=0.5ρVf 2;Vf为飞艇的运动速度;
为飞艇的前向飞行加速度;为艇体坐标系中飞艇的前向飞行速度;
为飞艇的垂向飞行加速度;为艇体坐标系中飞艇的垂向飞行速度;
为飞艇的俯仰角加速度;q为飞艇的俯仰角速度;
为飞艇的俯仰角速度,θ为飞艇的俯仰角;
为发射坐标系中飞艇的前向飞行速度;x为飞艇的前向飞行距离;
为发射坐标系中飞艇的垂向飞行速度;z为飞艇的飞行高度;
kg1与kg2为舵效常数,为空气动力学系数;
CX1、CX2、Cz1、Cz2与Cz3为飞艇受力相关的空气动力系数,CM1、CM2、CM3为飞艇受力矩相关的空气动力系数。
3.按照权利要求1所述一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法,其特征在于:所述步骤2中c1的值为10。
4.按照权利要求1所述一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法,其特征在于:所述步骤3中Γ4=0.01,k0=8.5,Γ1=0.001,Γ2=0.003,Γ3=0.001。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611103815.8A CN106483967B (zh) | 2016-12-05 | 2016-12-05 | 一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611103815.8A CN106483967B (zh) | 2016-12-05 | 2016-12-05 | 一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106483967A CN106483967A (zh) | 2017-03-08 |
CN106483967B true CN106483967B (zh) | 2019-05-17 |
Family
ID=58274786
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611103815.8A Active CN106483967B (zh) | 2016-12-05 | 2016-12-05 | 一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106483967B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106886224B (zh) * | 2017-03-21 | 2019-09-10 | 烟台南山学院 | 采用非线性超一型奇次滑模的蝶形飞行器姿态角控制方法 |
CN112180961B (zh) * | 2020-09-30 | 2022-03-01 | 北京航空航天大学 | 一种全状态受限平流层飞艇轨迹跟踪控制方法及*** |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
ES2558732B2 (es) * | 2014-08-05 | 2016-11-14 | Universidad De Alicante | Sistema y método para la planificación de vuelo autónomo |
CN104932514B (zh) * | 2015-06-25 | 2017-09-19 | 天津大学 | 小型无人直升机的姿态非线性自适应控制方法 |
CN105607473B (zh) * | 2015-11-20 | 2018-05-01 | 天津大学 | 小型无人直升机的姿态误差快速收敛自适应控制方法 |
-
2016
- 2016-12-05 CN CN201611103815.8A patent/CN106483967B/zh active Active
Non-Patent Citations (5)
Title |
---|
A distributed cooperative guidance law for salvo attack of multiple anti-ship missiles;Zhang Youan,等;《Chinese Journal of Aeronautics》;20151231;第28卷(第5期);第1438-1450页 |
Adaptive Sliding Mode Control of Airship Pitch Channel Attitude Angle;Liang GQ,等;《AER-Advances in Engineering Research》;20151231;第26卷;第169-174页 |
Continuous higher order sliding mode control with adaptation of air breathing hypersonic missile;Polk Yu,等;《International Journal of Adaptive Control and Signal Processing》;20160105;第1-18页 |
平流层飞艇滑模姿态控制***设计;王领,等;《飞行力学》;20140430;第32卷(第2期);第137-139页 |
高超声速飞行器的干扰补偿Terminal滑模控制;曾宪法,等;《北京航空航天大学学报》;20121109;第38卷(第11期);第1454-1458页 |
Also Published As
Publication number | Publication date |
---|---|
CN106483967A (zh) | 2017-03-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106643737B (zh) | 风力干扰环境下四旋翼飞行器姿态解算方法 | |
CN106527122B (zh) | 平流层飞艇定高飞行非线性pid控制方法 | |
CN106406333B (zh) | 一种基于积分型终端滑模的平流层飞艇俯仰角跟踪方法 | |
CN105159305B (zh) | 一种基于滑模变结构的四旋翼飞行控制方法 | |
CN102393200B (zh) | 基于飞行仿真的通用惯导测试方法 | |
CN102073755B (zh) | 近空间高超声速飞行器运动控制仿真方法 | |
CN104950901B (zh) | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 | |
CN107390531B (zh) | 参数学习有限时间收敛的高超声速飞行器控制方法 | |
CN108152529A (zh) | 一种基于飞行参数计算风速及风向的方法 | |
CN109614633A (zh) | 一种复合式旋翼飞行器非线性建模方法及配平方法 | |
CN104778376B (zh) | 一种临近空间高超声速滑翔弹头跳跃弹道预测方法 | |
CN107844128B (zh) | 一种基于复合比例导引的高超声速飞行器巡航段制导方法 | |
CN106896722B (zh) | 采用状态反馈与神经网络的高超飞行器复合控制方法 | |
CN102607639A (zh) | 基于bp神经网络的大攻角飞行状态下大气数据测量方法 | |
CN105151292A (zh) | 分布式矢量推进*** | |
CN105652880B (zh) | 用于飞行器大空域飞行的非线性抗饱和高度指令生成方法 | |
CN108132604A (zh) | 基于四元数的四旋翼飞行器鲁棒姿态控制方法、装置及*** | |
CN108153323A (zh) | 一种高空无人飞行器高精度再入制导方法 | |
CN109703768B (zh) | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 | |
Gonzalez-Rocha et al. | Measuring atmospheric winds from quadrotor motion | |
CN104199303A (zh) | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 | |
CN110320927A (zh) | 智能变形飞行器的飞行控制方法及*** | |
CN109446582A (zh) | 一种考虑地球自转的高精度降阶平稳滑翔动力学建模方法 | |
CN106483967B (zh) | 一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法 | |
CN108646557A (zh) | 一种基于跟踪微分与柔化函数的飞行器攻角跟踪控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 |