CN106527122A - 平流层飞艇定高飞行非线性pid控制方法 - Google Patents

平流层飞艇定高飞行非线性pid控制方法 Download PDF

Info

Publication number
CN106527122A
CN106527122A CN201710008390.0A CN201710008390A CN106527122A CN 106527122 A CN106527122 A CN 106527122A CN 201710008390 A CN201710008390 A CN 201710008390A CN 106527122 A CN106527122 A CN 106527122A
Authority
CN
China
Prior art keywords
dirigible
height
signal
pitch
error
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.)
Granted
Application number
CN201710008390.0A
Other languages
English (en)
Other versions
CN106527122B (zh
Inventor
张友安
吴华丽
刘海峰
孙玉梅
张吉松
赵静蕾
雷军委
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yantai Nanshan University
Naval Aeronautical Engineering Institute of PLA
Original Assignee
Yantai Nanshan University
Naval Aeronautical Engineering Institute of PLA
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Yantai Nanshan University, Naval Aeronautical Engineering Institute of PLA filed Critical Yantai Nanshan University
Priority to CN201710008390.0A priority Critical patent/CN106527122B/zh
Publication of CN106527122A publication Critical patent/CN106527122A/zh
Application granted granted Critical
Publication of CN106527122B publication Critical patent/CN106527122B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B11/00Automatic controllers
    • G05B11/01Automatic controllers electric
    • G05B11/36Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
    • G05B11/42Automatic 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.

Abstract

本发明公开了平流层飞艇定高飞行非线性PID控制方法,通过测量飞艇高度与垂向速度,计算高度误差与误差积分,形成高度误差PID控制信号;采用Sigmoid函数与柔化函数分别进行调制并叠加形成最终的期望俯仰角指令信号;根据飞艇俯仰通道的微分方程所建立的数学模型,近似模拟飞艇俯仰通道的特性;将得的期望俯仰角指令信号,通过俯仰角跟踪控制器形成俯仰角舵偏控制量,通过不断调整控制参数,观测飞艇高度变化的数据曲线,分析定高飞行的动态响应,最终确定一组飞艇定高飞行的控制方案参数,使得飞艇定高飞行具有满意的动态响应与稳态响应性能。具有PID控制所不具有的抗饱和特性,又保留PID控制的优点。

Description

平流层飞艇定高飞行非线性PID控制方法
技术领域
本发明属于飞行器控制技术领域,涉及一种基于Sigmoid函数和柔化函数调制的平流层飞艇定高飞行非线性PID控制方法。
背景技术
飞行在平流层高度的自主飞艇,由于具有广阔的军事和民用应用前景,受到了国内外学者和工程技术人员的高度重视。飞艇的高度控制回路设计是基于内回路姿态角跟踪回路已设计完好的基础上进行的。
目前广泛采用的从高度误差到姿态角期望信号的转换还是PID控制,但该方法的主要问题是在大范围高度控制情况下,参数调整需要预先设定,难以做到一套参数对所有期望高度都适合。同时高度控制的快速性问题也难以保证。尤其是其难以保证生成期望俯仰角信号符合较强的物理意义,如PID控制参数选取过小,则生成的期望俯仰角信号过小是的高度控制的快速性不足,而如果PID控制参数选取过大,则得到的期望俯仰角信号过大,容易超出飞艇在短时间内所能达到的俯仰角的最大值限制,也就是会产生饱和问题。
发明内容
为实现上述目的,本发明提供一种平流层飞艇定高飞行非线性PID控制方法,采用PID信号进行Sigmoid函数调制与柔化函数调制,利用这两类函数的有界性实现指令的抗饱和特性,同时又能较好地保持PID控制的优点。
本发明所采用的技术方案是,平流层飞艇定高飞行非线性PID控制方法,按照以下步骤进行:
步骤一:飞艇高度与垂向速度的测量、高度误差与误差积分的生成,并形成高度误差PID控制信号;
步骤二:采用Sigmoid函数与柔化函数分别进行调制并叠加形成最终的期望俯仰角指令信号;
步骤三:利用计算机,根据飞艇俯仰通道的微分方程所建立的数学模型,近似模拟飞艇俯仰通道的特性;
步骤四:将得的期望俯仰角指令信号,通过俯仰角跟踪控制器形成俯仰角舵偏控制量,并将该舵偏控制量代入步骤三所建立的数学模型,通过不断调整控制参数,并观察飞艇各状态的数据并画图,观测飞艇高度变化的数据曲线,分析定高飞行的动态响应,从而最终确定一组飞艇定高飞行的控制方案参数,使得飞艇定高飞行具有满意的动态响应与稳态响应性能。
进一步的,所述步骤一具体按照以下步骤进行:
首先,由飞艇上高度表测量飞艇的实时高度,记为z,并通过A/D转换传递给艇上计算机,通过和期望高度信号的比较,生成高度误差信号,其中期望高度信号记为zd,高度误差信号记为ez,其满足ez=z-zd
其次,采用垂直速度传感器测量飞艇的垂向速度,记为w,并通过A/D转换传递给艇上计算机作为误差微分信号,该信号作为误差微分信号的原因在于误差微分信息其中定高飞行时期望高度为常值,故(为期望高度zd的导数,由于其一般为常值,因此导数为0),故有即可由测量的垂向速度信号w代替误差微分信号;
再次,由上述高度误差信号,在艇上计算机中生成误差积分信号Ω,其定义如下:
Ω=∫ezdt
其中,t的含义是飞行时间;
最终,构成高度误差的PID控制信号:
upid=czez+czsΩ+w
或记为如下形式:
其中,cz为比例系数,czs为积分系数,微分系数固定为1。
进一步的,所述步骤二具体按照以下步骤进行:
首先,将PID控制信号采用Sigmoid函数调制得到信号M1,其表达式为
其中中e为指数函数,τ为正常数,初步选取为τ=0.2,upid为PID控制信号;
其次,将PID控制信号采用如下柔化函数调制得到信号M2,其表达式为
其中ε为柔化系数,选取为正常数,初步选取为;
最后,信号M1与信号M2叠加,构造期望俯仰角信号θd如下:
θd=-kz1M1-kz2M2
kz1、kz2为控制参数,选取为正常数。
进一步的,所述步骤三具体按照以下步骤进行:
飞艇俯仰通道的数学模型如下:
其中,u1为飞艇俯仰舵偏角,用于稳定与控制飞艇的俯仰姿态角;u2为飞艇的发动机推力,用于提高飞艇向前的飞行速度;f1-f6仅为变量,无物理含义,表达数为;
而a11,a13,a22,a31,a33为飞艇质量分布与转动惯量相关的参数,其计算方法通过下面M的逆
阵获得,即满足
而M矩阵有飞艇的质量与转动惯量所决定,其求取方法如下:
I3为3阶单位矩阵;
其中,M3是为M的子矩阵,用于计算M;m为飞艇的质量,az为飞艇结构参数,az=16.8,m11、m33、m55分别飞艇在不同方向的质量分布系数决定的参数,由飞艇质量分布与转动惯量所决定:m11=km1Mr,m33=km2Mr,m55=km3Iy,其中km1=0.1053;km2=0.8260;km3=0.1256;km1、km2、km3含义是飞艇的x,y,z三个方向的质量分布系数;Iy为飞艇沿y轴方向的转动惯量,Mr是飞艇所排开气体的质量,Mr=ρV,其中ρ为大气密度,V为飞艇的体积;
Q为动压头,其计算方法为Q=0.5ρVf 2;Vf为飞艇的运动速度;
为飞艇的前向飞行加速度;u为艇体坐标系中飞艇的前向飞行速度;
为飞艇的垂向飞行加速度;w为艇体坐标系中飞艇的垂向飞行速度;
为飞艇的俯仰角加速度;q为飞艇的俯仰角速度;
为飞艇的俯仰角速度,θ为飞艇的俯仰角;
为发射坐标系中飞艇的前向飞行速度;x为飞艇的前向飞行距离;
为发射坐标系中飞艇的垂向飞行速度;z为飞艇的飞行高度;
α含义是为飞艇向前与向上速度所形成的夹角;
kg1与kg2为舵效常数,为空气动力学系数,其数据来自于飞艇风洞试验;
CX1、CX2、Cz1、Cz2与Cz3为飞艇受力相关的空气动力系数,CM1、CM2、CM1为飞艇受力矩相关的空气动力系数;
针对上述复杂模型的分析,简化为如下一阶模型:
其中飞艇俯仰通道姿态稳定控制的设计是通过设计飞艇俯仰舵偏角u1来控制飞艇的俯仰角θ跟踪期望的姿态角指令θd
本发明的有益效果:通过测量飞艇的当前高度,采用计算机解算出飞艇实时高度与期望高度的误差信号,并测量垂向速度作为误差微分信号,再由高度误差信号生成误差积分信号,得到上述误差的PID(比例-积分-微分)控制信号,最后将该PID信号通过Sigmoid函数与柔化函数的调制得到最终的非线性改进PID控制信号,把该改进PID控制信号作为飞艇俯仰角指令信号,再由飞艇俯仰角跟踪控制器实现对该指令跟踪,当俯仰角跟踪上期望俯仰角指令信号时,即实现了飞艇俯仰通道按照给定高度飞行的控制目的。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明提供的一种基于Sigmoid函数和柔化函数调制的平流层飞艇定高飞行非线性PID控制方法原理图;
图2是本发明实施例提供的500米定高飞行情况下的飞艇的前向运动速度曲线;
图3是本发明实施例提供的500米定高飞行情况下的飞艇的垂向运动速度曲线;
图4是本发明实施例提供的500米定高飞行情况下的俯仰角小幅波动曲线;
图5是本发明实施例提供的500米定高飞行情况下的飞艇的俯仰角速率曲线;
图6是本发明实施例提供的500米定高飞行情况下的飞艇的水平飞行距离曲线;
图7为本发明实施例提供的500米定高飞行情况下的飞艇的飞行高度曲线;
图8为本发明实施例提供的500米定高飞行情况下的飞艇的俯仰舵偏曲线;
图9是本发明实施例提供的500米定高飞行情况下的飞艇的俯仰角期望值图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明原理如图1所示,具体按照以下步骤进行:
步骤一:飞艇高度与垂向速度的测量、高度误差与误差积分的生成,并形成高度误差PID控制信号;
首先,由飞艇上高度表测量飞艇的实时高度,记为z,并通过A/D转换传递给艇上计算机,通过和期望高度信号的比较,生成高度误差信号,其中期望高度信号记为zd,高度误差信号记为ez,其满足ez=z-zd
其次,采用垂直速度传感器测量飞艇的垂向速度,记为w,并通过A/D转换传递给艇上计算机作为误差微分信号。该信号可作为误差微分信号的原因在于误差微分信息其中定高飞行时期望高度为常值,故故有即可由测量的垂向速度信号w代替误差微分信号。
再次,由上述高度误差信号,在艇上计算机中生成误差积分信号Ω,其定义如下:
Ω=∫ezdt
其中,t的含义是飞行时间;
最终,构成高度误差的PID控制信号:
upid=czez+czsΩ+w
也可记为如下形式:
注意,本发明不同于一般PID控制的是在此处,该PID控制信号中仅需要设计两个参数,即设计比例系数cz与积分系数czs,而微分系数固定为1。
步骤二:采用Sigmoid函数与柔化函数分别进行调制并叠加形成最终的期望俯仰角指令信号;
首先,将上述PID控制信号采用Sigmoid函数调制得到信号M1,其表达式为
其中中e为指数函数,τ为正常数,可初步选取为τ=0.2,详细参数调整见实施例。upid为步骤一中最终所得到的PID控制信号。
其次,将上述PID控制信号采用如下柔化函数调制得到信号M2,其表达式为
其中ε为柔化系数,可选取为正常数。可初步选取为ε=1,详细参数调整见实施例。
最后,通过上述两信号的叠加,构造期望俯仰角信号θd如下:
θd=-kz1M1-kz2M2
kz1、kz2为控制参数,可选取为正常数。其具体选取见实施例。
由于M1<1,M2<1,显然有θd≤kz1+kz2,故如果在飞艇定高飞行中,要求俯仰角最大不超过25度,则可选取参数kz1、kz2满足kz1+kz2≤25/57.3来实现俯仰角指令的限幅功能,其中57.3为度到弧度的转换。显然该限幅不同于采用饱和环节进行限幅,因为该限幅是采用柔化函数与Sigmoid函数实现的,故该限幅过程是渐进和柔化的。因此本发明方法具有较好的抗饱和效果。
步骤三:利用计算机,根据如下飞艇俯仰通道的微分方程所建立的数学模型,近似模拟飞艇俯仰通道的特性。
为了确保上述步骤一至步骤二中控制器的参数选取合理,可用通过计算机模拟仿真的手段进行编程,从而进行参数调整。其中飞艇俯仰通道的数学模型如下:
其中,f1-f6仅为变量,无物理含义,表达数如下文;
u1为飞艇俯仰舵偏角,用于稳定与控制飞艇的俯仰姿态角。
u2为飞艇的发动机推力,用于提高飞艇向前的飞行速度。
而a11,a13,a22,a31,a33为飞艇质量分布与转动惯量相关的参数,其计算方法通过下面M的逆阵获得,即满足
而M矩阵有飞艇的质量与转动惯量所决定,其求取方法如下:
I3为3阶单位矩阵。
其中,M3是为M的子矩阵,用于计算M,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。km1、km2、km3的含义是飞艇的x,y,z三个方向的质量分布系数;如某型飞艇参数设计为Iy=5.9*109(Iy为飞艇沿y轴方向的转动惯量),以上单位均为国际标准单位。Mr含义是飞艇所排开气体的质量,Mr=ρV,其中ρ为大气密度,V为飞艇的体积。
Q为动压头,其计算方法为Q=0.5ρVf 2;Vf为飞艇的运动速度。
为飞艇的前向飞行加速度;u为艇体坐标系中飞艇的前向飞行速度;
为飞艇的垂向飞行加速度;w为艇体坐标系中飞艇的垂向飞行速度;
为飞艇的俯仰角加速度;q为飞艇的俯仰角速度;
为飞艇的俯仰角速度,θ为飞艇的俯仰角;
为发射坐标系中飞艇的前向飞行速度;x为飞艇的前向飞行距离;
为发射坐标系中飞艇的垂向飞行速度;z为飞艇的飞行高度;
α含义是为飞艇向前与向上速度所形成的夹角;
kg1与kg2为舵效常数,为空气动力学系数,其数据来自于飞艇风洞试验。
CX1、CX2、Cz1、Cz2与Cz3为飞艇受力相关的空气动力系数,CM1、CM2、CM1为飞艇受力矩相关的空气动力系数,各型飞艇的计算方式略有不同,其数据来自于飞艇的风洞实验数据,非本发明所保护与所讨论的内容,故不详细累述。
针对上述复杂模型的分析,可以简化为如下一阶模型:
其中飞艇俯仰通道姿态稳定控制的设计是通过设计u1来控制飞艇的俯仰角θ跟踪期望的姿态角指令θd,有关姿态稳定控制器的设计在此不再详细讨论,非本专利的核心内容,本发明是在上述姿态稳定控制器设计完成的基础上进行的。
根据上述简化的一阶模型,本发明的基本思想是根据高度误差信号生成期望的姿态角指令θd
步骤四:将步骤一至步骤二所得的俯仰角期望指令,通过俯仰角跟踪控制器形成俯仰角舵偏控制量,并将该舵偏控制量代入步骤三所建立的模型,通过不断调整控制参数,并观察飞艇各状态的数据并画图,尤其是观测飞艇高度变化的数据曲线,分析定高飞行的动态响应,从而最终确定一组飞艇定高飞行的控制方案参数,使得飞艇定高飞行具有满意的动态响应与稳态响应性能。
实施例
首先采用PID控制规律,设定飞艇的俯仰角稳定控制器,也可采用其它控制规律设计俯仰角稳定控制器,实现飞艇姿态稳定的控制功能,在此不再详细阐述姿态稳定控制器的设计,主要是由于本发明的核心技术在于高度指令的生成,因此本发明的讨论是在默认姿态稳定控制器设计完好的基础上进行的,故此处仅以PID姿态稳定控制为例,以完成高度控制的示例。
在上述姿态稳定控制器设计完好的基础上,设定飞艇初始高度为0米,初始速度为0m/s,假设期望的给定高度为500米。并设置发动机推力为常值u2=8000,飞艇最终稳定的前向飞行速度为25m/s左右。
则按照上述步骤一至步骤二,最终选取方案参数为cz=0.06,czs=0.01,ξ=10,τ=0.5,kz1=5.5/57.3,kz2=5/57.3,则最终得到的期望俯仰角指令能够满足小于10.5度的要求。
最终得到的期望俯仰角信号如下:
θd=-kz1M1-kz2M2
代入俯仰角跟踪控制器并形成舵偏角信号,输入给步骤三中模型,得到的结果如图2至图8所示。
通过以上仿真结果与曲线可以看出,图9所示的期望俯仰角指令确实满足其小于10.5度的饱含限制,也就是最大高度误差情况下,生成的期望俯仰角指令也不超过设定的饱含限制,故该优点是一般PID控制所不具备的。而由图7高度曲线可以看出最终高度能稳定在500米,形成直线,故本发明方法又能保留PID控制的部分优点,具有较好的控制精度。因此本发明具有很好的实用价值,也能推广应用于飞艇之外的其它飞行器的高度控制中。
本文的特点是通过测量飞艇的当前高度,采用计算机解算出飞艇实时高度与期望高度的误差信号,并测量垂向速度作为误差微分信号,再由高度误差信号生成误差积分信号,得到上述误差的PID(比例-积分-微分)控制信号,最后将该PID信号通过Sigmoid函数与柔化函数的调制得到最终的非线性改进PID控制信号,该信号作为飞艇俯仰角指令信号,再由飞艇俯仰角跟踪控制器实现对该指令跟踪,当俯仰角跟踪上期望指令信号时,即实现了飞艇俯仰通道按照给定高度飞行。
本发明一种平流层飞艇定高飞行非线性PID控制方法,默认飞艇姿态稳定控制器已完成设计。同时本发明不同于传统的飞艇高度PID控制器的地方在于提出了一类新颖的非线性Sigmoid函数与柔化函数调制技术,使得本方法具有PID控制所不具有的抗饱和特性,同时由于本方法是由PID控制信号调制产生,因此其又能保留PID控制的优点。所以本发明不仅在方法上有较大的创新,而且还有很高的工程实用价值。
以上所述仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等,均包含在本发明的保护范围内。

Claims (4)

1.平流层飞艇定高飞行非线性PID控制方法,其特征在于,按照以下步骤进行:
步骤一:飞艇高度与垂向速度的测量、高度误差与误差积分的生成,并形成高度误差PID控制信号;
步骤二:采用Sigmoid函数与柔化函数分别进行调制并叠加形成最终的期望俯仰角指令信号;
步骤三:利用计算机,根据飞艇俯仰通道的微分方程所建立的数学模型,近似模拟飞艇俯仰通道的特性;
步骤四:将得的期望俯仰角指令信号,通过俯仰角跟踪控制器形成俯仰角舵偏控制量,并将该舵偏控制量代入步骤三所建立的数学模型,通过不断调整控制参数,并观察飞艇各状态的数据并画图,观测飞艇高度变化的数据曲线,分析定高飞行的动态响应,从而最终确定一组飞艇定高飞行的控制方案参数,使得飞艇定高飞行具有满意的动态响应与稳态响应性能。
2.根据权利要求1所述的平流层飞艇定高飞行非线性PID控制方法,其特征在于,所述步骤一具体按照以下步骤进行:
首先,由飞艇上高度表测量飞艇的实时高度,记为z,并通过A/D转换传递给艇上计算机,通过和期望高度信号的比较,生成高度误差信号,其中期望高度信号记为zd,高度误差信号记为ez,其满足ez=z-zd
其次,采用垂直速度传感器测量飞艇的垂向速度,记为w,并通过A/D转换传递给艇上计算机作为误差微分信号,该信号作为误差微分信号的原因在于误差微分信息其中定高飞行时期望高度为常值,故期望高度信号zd的导数故有即可由测量的垂向速度信号w代替误差微分信号;
再次,由上述高度误差信号,在艇上计算机中生成误差积分信号Ω,其定义如下:
Ω=∫ezdt
其中,t的含义是飞行时间;
最终,构成高度误差的PID控制信号:
upid=czez+czsΩ+w
或记为如下形式:
u p i d = c z e z + c z s ∫ 0 t e z d t + e · z
其中,cz为比例系数,czs为积分系数,微分系数固定为1。
3.根据权利要求2所述的平流层飞艇定高飞行非线性PID控制方法,其特征在于,所述步骤二具体按照以下步骤进行:
首先,将PID控制信号采用Sigmoid函数调制得到信号M1,其表达式为
M 1 = 1 - e - τu p i d 1 + e - τu p i d
其中中e为指数函数,τ为正常数,初步选取为τ=0.2,upid为PID控制信号;
其次,将PID控制信号采用如下柔化函数调制得到信号M2,其表达式为
M 2 = u p i d | u p i d | + ϵ
其中ε为柔化系数,选取为正常数,初步选取为;
最后,信号M1与信号M2叠加,构造期望俯仰角信号θd如下:
θd=-kz1M1-kz2M2
kz1、kz2为控制参数,选取为正常数。
4.根据权利要求3所述的平流层飞艇定高飞行非线性PID控制方法,其特征在于,所述步骤三具体按照以下步骤进行:
飞艇俯仰通道的数学模型如下:
u · w · q · θ · x · z · = a 11 f 1 + a 13 f 3 a 22 f 2 a 31 f 1 + a 33 f 3 f 4 f 5 f 6 + a 11 u 2 + a 13 k g 2 u 1 a 22 k g 1 u 1 a 31 u 2 + a 33 k g 2 u 1 0 0 0
其中,u1为飞艇俯仰舵偏角,用于稳定与控制飞艇的俯仰姿态角;u2为飞艇的发动机推力,用于提高飞艇向前的飞行速度;f1-f6仅为变量,无物理含义,表达数为;
f 1 f 2 f 3 f 4 f 5 f 6 = - ( m + m 33 ) w q + Q [ C X 1 cos 2 α + C X 2 s i n ( 2 α ) s i n ( α / 2 ) ( m + m 11 ) q u + ma z q 2 + Q [ C z 1 cos ( α / 2 ) sin ( 2 α ) + C z 2 sin ( 2 α ) + C z 3 sin ( α ) sin ( | α | ) ] Q [ C M 1 cos ( α / 2 ) sin ( 2 α ) + C M 2 sin ( 2 α ) + C M 3 sin ( α ) sin ( | α | ) ] - a z w sin θ q u cos θ + w sin θ - u sin θ + w cos θ
而a11,a13,a22,a31,a33为飞艇质量分布与转动惯量相关的参数,其计算方法通过下面M的逆阵获得,即满足
a 11 a 13 a 22 a 31 a 33 1 1 1 = M - 1
而M矩阵有飞艇的质量与转动惯量所决定,其求取方法如下:
I3为3阶单位矩阵;
其中,M3为M的子矩阵,用于计算M;m为飞艇的质量,az为飞艇结构参数,az=16.8,m11、m33、m55分别飞艇在不同方向的质量分布系数决定的参数,由飞艇质量分布与转动惯量所决定:m11=km1Mr,m33=km2Mr,m55=km3Iy,其中km1=0.1053;km2=0.8260;km3=0.1256;km1、km2、km3含义是飞艇的x,y,z三个方向的质量分布系数;Iy为飞艇沿y轴方向的转动惯量,Mr是飞艇所排开气体的质量,Mr=ρV,其中ρ为大气密度,V为飞艇的体积;
Q为动压头,其计算方法为Q=0.5ρVf 2;Vf为飞艇的运动速度;
为飞艇的前向飞行加速度;u为艇体坐标系中飞艇的前向飞行速度;
为飞艇的垂向飞行加速度;w为艇体坐标系中飞艇的垂向飞行速度;
为飞艇的俯仰角加速度;q为飞艇的俯仰角速度;
为飞艇的俯仰角速度,θ为飞艇的俯仰角;
为发射坐标系中飞艇的前向飞行速度;x为飞艇的前向飞行距离;
为发射坐标系中飞艇的垂向飞行速度;z为飞艇的飞行高度;
α含义是为飞艇向前与向上速度所形成的夹角;
kg1与kg2为舵效常数,为空气动力学系数,其数据来自于飞艇风洞试验;
CX1、CX2、Cz1、Cz2与Cz3为飞艇受力相关的空气动力系数,CM1、CM2、CM1为飞艇受力矩相关的空气动力系数;
针对上述复杂模型的分析,简化为如下一阶模型:
z · = - u s i n θ + - w c o s θ
其中飞艇俯仰通道姿态稳定控制的设计是通过设计飞艇俯仰舵偏角u1来控制飞艇的俯仰角θ跟踪期望的姿态角指令θd
CN201710008390.0A 2017-01-05 2017-01-05 平流层飞艇定高飞行非线性pid控制方法 Active CN106527122B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710008390.0A CN106527122B (zh) 2017-01-05 2017-01-05 平流层飞艇定高飞行非线性pid控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710008390.0A CN106527122B (zh) 2017-01-05 2017-01-05 平流层飞艇定高飞行非线性pid控制方法

Publications (2)

Publication Number Publication Date
CN106527122A true CN106527122A (zh) 2017-03-22
CN106527122B CN106527122B (zh) 2019-03-15

Family

ID=58336709

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710008390.0A Active CN106527122B (zh) 2017-01-05 2017-01-05 平流层飞艇定高飞行非线性pid控制方法

Country Status (1)

Country Link
CN (1) CN106527122B (zh)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107117280A (zh) * 2017-05-11 2017-09-01 南方科技大学 飞艇降落控制方法和装置
CN108646557A (zh) * 2018-05-08 2018-10-12 中国人民解放军海军航空大学 一种基于跟踪微分与柔化函数的飞行器攻角跟踪控制方法
CN110244754A (zh) * 2019-06-28 2019-09-17 上海工程技术大学 一种用于平流层浮空器定点驻空的控制系统及方法
CN111564850A (zh) * 2020-06-11 2020-08-21 王业勤 一种基于有界性pid控制的虚拟同步发电机型逆变器
CN111679571A (zh) * 2020-07-06 2020-09-18 中国人民解放军海军航空大学 一种低速飞艇的给定速度滑模自适应跟踪方法
CN112034885A (zh) * 2020-09-08 2020-12-04 中国人民解放军海军航空大学 一种采用低成本倾角仪测量的无人飞行器滚转稳定方法
CN112904871A (zh) * 2021-01-22 2021-06-04 北京电子工程总体研究所 一种基于螺旋桨和俯仰缆绳复合控制的囊体高度控制系统
CN111538350B (zh) * 2020-05-07 2023-06-23 烟台南山学院 一种采用三段柔化切换实现无人机的高度全自动飞行的方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103116280A (zh) * 2013-01-16 2013-05-22 北京航空航天大学 一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法
CN105182984A (zh) * 2015-07-16 2015-12-23 孙明玮 飞行器俯仰姿态的线性自抗扰控制器设计与参数整定
CN105652880A (zh) * 2016-02-24 2016-06-08 中国人民解放军海军航空工程学院 用于飞行器大空域飞行的非线性抗饱和高度指令生成方法
CN106094510A (zh) * 2016-06-30 2016-11-09 电子科技大学 一种基于干扰补偿器的pid参数调节方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103116280A (zh) * 2013-01-16 2013-05-22 北京航空航天大学 一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法
CN105182984A (zh) * 2015-07-16 2015-12-23 孙明玮 飞行器俯仰姿态的线性自抗扰控制器设计与参数整定
CN105652880A (zh) * 2016-02-24 2016-06-08 中国人民解放军海军航空工程学院 用于飞行器大空域飞行的非线性抗饱和高度指令生成方法
CN106094510A (zh) * 2016-06-30 2016-11-09 电子科技大学 一种基于干扰补偿器的pid参数调节方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
张新亮 等: "ICACMAC + PID 复合控制", 《四川兵工学报》 *

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107117280A (zh) * 2017-05-11 2017-09-01 南方科技大学 飞艇降落控制方法和装置
CN108646557A (zh) * 2018-05-08 2018-10-12 中国人民解放军海军航空大学 一种基于跟踪微分与柔化函数的飞行器攻角跟踪控制方法
CN110244754B (zh) * 2019-06-28 2021-12-10 上海工程技术大学 一种用于平流层浮空器定点驻空的控制系统及方法
CN110244754A (zh) * 2019-06-28 2019-09-17 上海工程技术大学 一种用于平流层浮空器定点驻空的控制系统及方法
CN111538350B (zh) * 2020-05-07 2023-06-23 烟台南山学院 一种采用三段柔化切换实现无人机的高度全自动飞行的方法
CN111564850A (zh) * 2020-06-11 2020-08-21 王业勤 一种基于有界性pid控制的虚拟同步发电机型逆变器
CN111564850B (zh) * 2020-06-11 2023-11-10 王业勤 一种基于有界性pid控制的虚拟同步发电机型逆变器
CN111679571B (zh) * 2020-07-06 2022-10-14 中国人民解放军海军航空大学 一种低速飞艇的给定速度滑模自适应跟踪方法
CN111679571A (zh) * 2020-07-06 2020-09-18 中国人民解放军海军航空大学 一种低速飞艇的给定速度滑模自适应跟踪方法
CN112034885B (zh) * 2020-09-08 2022-08-23 中国人民解放军海军航空大学 一种采用低成本倾角仪测量的无人飞行器滚转稳定方法
CN112034885A (zh) * 2020-09-08 2020-12-04 中国人民解放军海军航空大学 一种采用低成本倾角仪测量的无人飞行器滚转稳定方法
CN112904871A (zh) * 2021-01-22 2021-06-04 北京电子工程总体研究所 一种基于螺旋桨和俯仰缆绳复合控制的囊体高度控制系统
CN112904871B (zh) * 2021-01-22 2023-02-28 北京电子工程总体研究所 一种基于螺旋桨和俯仰缆绳复合控制的囊体高度控制系统

Also Published As

Publication number Publication date
CN106527122B (zh) 2019-03-15

Similar Documents

Publication Publication Date Title
CN106527122A (zh) 平流层飞艇定高飞行非线性pid控制方法
González-Rocha et al. Sensing wind from quadrotor motion
CN111268170B (zh) 一种面向扑翼飞行机器人的飞行测试系统
CN102393200B (zh) 基于飞行仿真的通用惯导测试方法
CN108490788B (zh) 一种基于双干扰观测的飞行器俯仰通道反演控制方法
CN109614633A (zh) 一种复合式旋翼飞行器非线性建模方法及配平方法
CN106896722B (zh) 采用状态反馈与神经网络的高超飞行器复合控制方法
CN106406333B (zh) 一种基于积分型终端滑模的平流层飞艇俯仰角跟踪方法
CN109635494A (zh) 一种飞行试验与地面仿真气动力数据综合建模方法
CN107063244B (zh) 一种飞行器飞行过程模拟方法
CN105652880B (zh) 用于飞行器大空域飞行的非线性抗饱和高度指令生成方法
CN108132604A (zh) 基于四元数的四旋翼飞行器鲁棒姿态控制方法、装置及系统
Gonzalez-Rocha et al. Measuring atmospheric winds from quadrotor motion
Siddiqui et al. Lab-scale, closed-loop experimental characterization, model refinement, and validation of a hydrokinetic energy-harvesting ocean kite
CN105242679A (zh) 一种四旋翼飞行器的控制系统设计方法
CN107065544A (zh) 基于攻角幂函数的高超飞行器神经网络控制方法
CN106774385B (zh) 一种采用自适应变结构的飞艇定点悬停控制方法
CN106681337B (zh) 基于奇次滑模的平流层飞艇定高飞行控制方法
CN106096091A (zh) 一种飞机运动模拟方法
CN106248082A (zh) 一种飞行器自主导航系统及导航方法
CN107315419A (zh) 一种实现飞艇远距离定点悬停的三段式控制策略
CN104503258B (zh) 基于光缆敷设的共轴双旋翼无人直升机建模方法
CN106484969A (zh) 一种大包线强机动飞行器动力学高精度仿真方法
CN106483967B (zh) 一种基于角速度信息测量与滑模的飞艇俯仰角稳定方法
CN106774370B (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