CN103116280A - 一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法 - Google Patents
一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法 Download PDFInfo
- Publication number
- CN103116280A CN103116280A CN2013100153360A CN201310015336A CN103116280A CN 103116280 A CN103116280 A CN 103116280A CN 2013100153360 A CN2013100153360 A CN 2013100153360A CN 201310015336 A CN201310015336 A CN 201310015336A CN 103116280 A CN103116280 A CN 103116280A
- Authority
- CN
- China
- Prior art keywords
- centerdot
- delta
- alpha
- tau
- coefficient
- 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
Links
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明公开了一种存在网络随机延迟的微小型无人飞行器纵向控制方法,属于飞行控制技术领域,该方法首先建立无人飞行器纵向系统模型并设计不存在网络延迟的飞行控制系统;然后在不同网络随机延迟条件下,进行飞行控制系统随机鲁棒性分析与设计;确定飞行控制系统的增益调度策略;最后闭环六自由度非线性蒙特卡洛仿真验证。本发明缓解了网络延迟导致的飞行控制系统品质恶化,能够增强分布式系统的稳定性;利用随机鲁棒分析与设计方法以及基于线性插值的增益调度策略,得到的控制律具有简单便于工程实现的优点,能够在大网络时延变化的情况下较好的维持原控制系统的控制品质。
Description
技术领域
本发明涉及存在变分布网络随机延迟的微小型无人飞行器纵向控制,属于飞行控制技术领域,具体涉及一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法。
背景技术
当前已经有多达三十多个国家投入大量人力和财力从事无人机的研究和生产。经过二十年的发展,该项技术已经比较成熟,在军民各个领域发挥着作用,尽管如此,单架无人机在遂行任务时存在着一些问题,例如单架无人机可能受到传感器的数量限制,不能从多角度全方位的对目标区域进行观察,面临大面积搜索任务时,不能有效的覆盖整个搜索区域;如果执行的是救援任务,单架无人机在载荷方面受到限制,往往影响整个救援的效能,带来更大损失,另外,一旦单架无人机出现故障,必须立即中断任务返回,可能会延误救援时机。
针对单架无人机的上述缺点,近些年提出了编队飞行控制的概念并取得了一定得研究成果,其中网络飞行控制系统设计是编队飞行控制是否成功的决定性因素,目前无人机群编队控制主要采用集中式控制结构:将编队成员分成一个长机和若干僚机,长机将自身的制导回路信息通过无线通信网络发送给僚机,僚机接收到长机的信息后与自身的制导回路信息比较,按照某种队形结构计算自身的制导指令进而与长机以一定队形结构飞行。由于无人机制导回路的惯性大,带宽较窄,而按照最优随机控制的观点,网络延迟往往可以等效为频率相对较高的白噪声,因此集中式控制体制下的网络延迟对编队队形控制的影响不大。近些年来,随着分布式编队控制的发展,要求编队成员不仅要在制导回路进行协调,甚至是控制回路也要进行协调,这就对网络飞行控制系统设计提出了较高的要求,由于控制回路的带宽相对制导回路宽,很有可能将网络延迟近似的噪声纳入到带宽之内,故网络延迟可能导致飞控系统控制品质恶化。
网络飞行控制系统设计的概念是:针对无人机编队飞行过程中的无线通信网络延迟、丢包和时序错乱情况,设计飞行控制系统,满足系统对超调量和调节时间等性能指标的要求。大量的网络测试研究表明网络状况是随时间变化而变化的,在不同的网络状态下,采用与之相适应的状态反馈增益能提高网络控制系统的控制品质,因此依据不同的网络状况调度相适应的状态反馈增益是非常有必要的。增益调度的方法分为传统增益调度、基于LPV(线性变参数)的增益调度和基于回路成形的鲁棒增益调度三种,其中后两种方法有严格的数学证明和可量化的控制品质评价标准,但是增益调度结构复杂,不利于实现和在线调整;增益调度设计过程复杂,不易为工程设计人员掌握。
发明内容
本发明的目的是为了解决上述问题,针对无人飞行器编队飞行过程中不可避免的无线自组织网络随机延迟问题,引入了随机鲁棒分析与设计方法,设计了无人机的控制律,解决了传统的线性二次型调节器(LQR)控制对通信质量要求较高和鲁棒性较差的缺点,降低了对编队无线数据链更新率的要求;根据不同的网络随机延迟,提出了基于线性插值的增益调度策略,拓宽了线性控制系统的控制范围,使飞行器在存在较大网络随机延迟变化的情况下控制品质仍能满足要求。控制策略简单不含复杂数学运算,便于有实时性要求的情况下进行工程实现。采用这种控制策略可以降低对无人机编队无线数据链更新率的要求,进而能够增强无人机群编队的鲁棒性。
本发明提供的一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法,具体包括如下步骤:
步骤一:建立无人飞行器纵向系统模型并设计不存在网络延迟的飞行控制系统;
具体为:
(1)根据风洞吹风获得无人飞行器动力学参数和物理参数;
(2)建立飞行器纵向非线性动力学与运动学方程;
(3)解耦线性化,得到无人飞行器纵向线性状态方程;
(4)LQR设计控制律;
步骤二:在不同网络随机延迟条件下,进行飞行控制系统随机鲁棒性分析与设计;
步骤三:确定飞行控制系统的增益调度策略;
采用线性插值进行网络飞行控制系统的增益调度,假设网络延迟在τ1和τi之间,网络随机延迟在τ1~N(μ1,σ1),τ2~N(μ2,σ2)......τi~N(μi,σi)时分别利用随机鲁棒分析与设计方法设计的控制系统参数控制器当前测量的网络延迟为τN,则实际采用的控制器反馈系数KN为:
步骤四:闭环六自由度非线性蒙特卡洛仿真验证。
本发明的优点在于:
(1)本发明在一定程度上缓解了网络延迟导致的飞行控制系统品质恶化,能够增强分布式系统的稳定性;其次控制系统的随机鲁棒分析与设计针对的网络传输模式是事件驱动的,这种传输模式有以下两个优点,一是降低了数据链设计的难度与成本,二是能较好的与现有民用网络协议兼容;
(2)利用随机鲁棒分析与设计方法设计了基于单一分布网络延迟的控制系统后,采用基于线性插值的增益调度策略设计了适用于大网络时延变化的控制系统,控制律具有简单便于工程实现的优点,能够在大网络时延变化的情况下较好的维持原控制系统的控制品质;
(3)本发明设计过程没有繁琐的数学推导,而是充分利用了计算机高速处理数据的能力,相对于以往的针对线性时滞系统依靠数学推导获得控制律的方法,该方法工程性与可操作性较强,加之采用的线性插值的增益调度策略,能够放宽线性控制系统的控制范围,对网络时延分布变化较大的系统有较好的控制品质。
附图说明
图1是本发明提供的存在变分布网络随机延迟的微小型无人飞行器纵向控制方法总体框图;
图2a~图2h是不存在网络随机延迟时LQR设计的控制律在飞行器纵向通道响应曲线;
图3a~图3c为τ1~N(μ1,σ1 2)的AID值和高度响应的蒙特卡洛仿真曲线;
图4a~图4c为τ2~N(μ2,σ2 2)的AID值和高度响应的蒙特卡洛仿真曲线;
图5a~5c为τ3~N(μ3,σ3 2)的AID值和高度响应的蒙特卡洛仿真曲线;
图6a~6d为τ1~N(μ1,σ1 2)的随机鲁棒设计结果;
图7a~7d为τ2~N(μ2,σ2 2)的随机鲁棒设计结果;
图8a~8d为τ3~N(μ3,σ3 2)的随机鲁棒设计结果;
图9为K1在网络随机延迟服从τ3~N(μ3,σ3 2)分布时蒙特卡洛仿真曲线;
图10a~10b为正态分布闭环六自由度非线性蒙特卡洛仿真验证图;
图11a~11b为均匀分布闭环六自由度非线性蒙特卡洛仿真验证图。
具体实施方式
下面将结合附图和实施例对本发明作进一步的详细说明。
本发明是一种存在变分布网络随机延迟的微小型无人飞行器控制方法,流程如图1所示,包括以下几个步骤:
步骤一:建立无人飞行器纵向系统模型并设计不存在网络延迟的飞行控制系统;
具体为:
(1)根据风洞吹风获得无人飞行器动力学参数和物理参数;
无人飞行器动力学参数和物理参数可以根据实际风洞吹风得到,采用英美坐标系,具体为:
获取动力学参数包括纵向力和力矩系数:包括升力系数CL0、CLa、CLq、阻力系数CD0、CDa、CDq、俯仰力矩系数Cm0、Cma、Cmq、其中,CL0为攻角为0度时的升力系数,CLa为升力关于攻角的升力系数,CLq为升力关于俯仰角速度的升力系数,为升力关于升降舵的升力系数,CD0为攻角为0度时的阻力系数,CDa为阻力关于攻角的阻力系数,CDq为阻力关于俯仰角速度的阻力系数,为阻力关于升降舵的阻力系数,Cm0为攻角为0度时的俯仰力矩系数,Cma为俯仰力矩关于攻角的力矩系数,Cmq为俯仰力矩关于俯仰角速度的力矩系数、为俯仰力矩关于升降舵的力矩系数;
获取物理参数包括无人飞行器的质量m(kg)、平均几何弦长CA(m)、翼展b(m)、飞行器参考面积Sw(m2)、X轴转动惯量IX(kg·m2)、Y轴转动惯量IY(kg·m2)、Z轴转动惯量IZ(kg·m2)、惯量积IXZ(kg·m2)、舵机时间常数Tδ(s)、舵机放大系数Kδ、发动机时间常数Tt(s)、发动机放大系数Kt、怠速推力tA(N)、最大推力tmax(N)和最小推力tmin(N)。
(2)建立飞行器纵向非线性动力学与运动学方程;
选取无人机飞行状态向量为:
其中,V表示速度、α表示攻角、q表示俯仰角速度、θ表示俯仰角、x表示东向位置、h表示高度、m表示质量、δe表示升降舵偏角、δt表示发动机推力。
建立无人飞行器非线性六自由度运动学与动力学方程如下:
其中:表示速度的导数、表示攻角的导数、俯仰角速度的导数、表示俯仰角的导数、表示东向位置导数、表示高度的导数、表示质量消耗率、表示升降舵偏角的导数、表示发动机推力的导数、表示升降舵偏角指令、表示油门指令、μ为航迹倾角、Km为发动机耗油率、δT为发动机推力、Tδ为舵机时间常数、Tt为发动机时间常数、Kδ为舵机放大系数、Kt为发动机放大系数,IY为Y轴转动惯量,式(1)简记为:其中为飞行状态向量的导数,为飞行控制向量。
其中:CL为总升力系数、CD为总阻力系数、Cm为总俯仰力矩系数、ρ为空气密度、L为总升力、D为总阻力、M为总俯仰力矩、Sw为飞行器参考面积、CA为飞行器平均几何弦长、b为翼展。
(3)解耦线性化;
假设无人飞行器处于定高稳定平飞状态,则必有升力-重力平衡、推力-阻力平衡以及俯仰力矩平衡,因此下面三个等式成立:
解方程(3),得到无人飞行器的配平攻角α0,配平升降舵偏角δe0,配平飞行速度V0,在该状态点利用小扰动线性化原理可得无人飞行器纵向线性状态方程为:
其中A为纵向线性系统状态矩阵,B为纵向线性系统控制矩阵;
(4)LQR设计控制律;
针对纵向:选取Q1和R1矩阵,采用线性二次型调节器LQR设计纵向控制律K,K为2×7的矩阵。用kij表示K中的第i行第j列元素,为使控制系统结构尽量简化,速度反馈只加入发动机油门控制(k22=k23=k24=k25=0.0)中,而不加入升降舵控制(k11=0.0)中,无人飞行器舵机一般采用电动舵机,在飞行过程中无法准确测量舵面偏角,因此k16=k17=k26=k27=0.0,因为速度反馈不参与升降舵控制,而发动机油门调节只依赖速度,故应增加其他状态量对升降舵控制的反馈力度,最终选择以下控制器结构:
其中:δe0为配平升降舵偏角,α0为无人飞行器的配平攻角,h*为高度指令,V0为配平飞行速度。微小型飞行器由于结构较小无法安装精确的攻角传感器,故将攻角反馈换算为过载反馈,由于微小型飞行器在飞行过程中,机翼和水平安定面是主要升力面,升降舵面产生的升力相对较小,主要是提供俯仰力矩诱导主升力面发生变化,因此:
其中:NZ是无人飞行器的法向过载,CL0相对CLa较小,可以忽略,δt·sin(α)相对 较小也可以忽略,代入数据得:
联立式(5)、式(7)可得实际飞行中的控制器结构:
其中:k1k2k3k4k5表示按照(5)和(7)换算后的最终应用的控制器反馈系数。
步骤二:在不同网络随机延迟条件下,进行飞行控制系统随机鲁棒性分析与设计;
(1)飞行控制系统随机鲁棒性分析。
网络随机延迟的定义是:在传感器、执行器和控制器等多个节点通过网络交换数据时,由于网络带宽有限且网络中的数据流量变化不规则,不可避免的造成数据碰撞、多路传输、连接中断和网络拥塞等现象。本发明主要采用相互独立的随机延迟作为网络飞行控制系统的主要延迟类型,假设网络随机延迟τi服从均值μi,方差σi的正态分布,即:
τi∈N(μi,σi),i=1,2,...,N (9)
由于控制系统采用事件驱动的方式处理数据,故延迟发生的时刻并不均匀,无人飞行器非线性系统方程由原来的 变为了:
其中:为飞行状态向量,为飞行状态向量的导数,u(t-τi)为加入控制延迟的飞行控制向量。网络延迟本身的随机性为随机鲁棒分析的应用提供了条件。对服从(9)式的网络随机延迟进行蒙特卡洛仿真考察(8)式控制律在网络延迟情况下对无人飞行器控制的鲁棒性,鲁棒性的衡量标准取为一定时间内实际高度与指令高度的平均偏差。
(2)飞行控制系统随机鲁棒性设计:
随机鲁棒设计过程包括控制器结构设计和现代优化算法两部分,控制器结构采用传统的PID控制,在步骤一中已叙述,现代优化算法采用粒子群算法,优化指标是飞行控制系统随机鲁棒性分析中的鲁棒性衡量标准,因为控制器反馈系数k1,k2,k3,k4,k5变化是连续的,粒子群算法在处理多连续变量寻优相对遗传算法和蚁群算法具有优势。
采用标准粒子群算法求解该优化问题,问题的解对应于搜索空间中的一个粒子,每个粒子都有自己的位置和速度及一个由被优化函数决定的代价函数。各个粒子记忆、追随当前的最优粒子,每次迭代中,粒子通过跟随两个极值来更新自己的位置和速度:一个是粒子本身获得的最优解一个是整个粒子群中全部粒子历代搜索获得的最优解标准粒子群算法中,速度更新和位置更新如式(11)所示:
式中,i∈N(1,ns),ns为粒子群中粒子的个数,N代表整数;d∈N(1,n),n为解向量的维数,k为迭代次数,c1和c2为学习因子,初始值均为0.6,随迭代次数增加降为0.2;ω为惯量权重,初始值为0.9,随迭代次数增加降为0.4;r1和r2为[0,1]之间的随机数,判断粒子群中粒子优劣的标准是蒙特卡洛仿真获得的代价函数W,代价函数越小,在下一代该粒子存在的概率越大。
针对不同的网络随机延迟分布τi利用随机鲁棒性设计方法设计对应的控制律,保证该控制律在对应的网络随机延迟分布情况下随机鲁棒性分析的鲁棒性最优。
步骤三:确定飞行控制系统的增益调度策略;
随机鲁棒设计的控制器只能保证网络随机延迟在一定范围内的鲁棒性能满足一定要求,当网络随机延迟变化较大时,控制器的鲁棒性能可能不满足指标要求。采用线性插值进行网络飞行控制系统的增益调度。假设网络延迟在τ1和τi之间,网络随机延迟在τ1~N(μ1,σ1),τ2~N(μ2,σ2)......τi~N(μi,σi)时分别利用随机鲁棒分析与设计方法设计控制系统参数控制器当前测量的网络延迟为τN,则实际采用的控制器反馈系数KN为:
步骤四:闭环六自由度非线性蒙特卡洛仿真验证;
在存在网络随机延迟τ的情况下,对步骤二中随机鲁棒设计出的控制系统参数和步骤三中设计的控制增益调度策略进行蒙特卡洛仿真验证,结果显示,采用随机鲁棒分析与设计后的控制系统参数较步骤一得出的最终应用的控制器反馈系数k1k2k3k4k5抗网络随机延迟能力增强,最大超调量获得明显改善;在线性增益调度的调节下,放大了控制律保证控制品质的范围,可以在网络随机延迟存在较大变化的情况下仍能维持控制器的鲁棒稳定性和鲁棒性能。所以采用本发明方法获得的控制律调度策略,相对于LQR设计出的控制律抗网络延迟的能力加强,把本发明方法设计出的控制律应用到无人机自动驾驶仪的纵向通道中,在无人机自主飞行过程中,能够在存在较大网络延迟的情况下维持无人机的正常飞行。
图1给出了本专利方法的总体流程图。本发明能够解决一类具有大变化网络随机延迟的网络飞行控制律设计与调节问题,近些年来,随着分布式编队控制的发展,要求编队成员不仅要在制导回路进行协调,甚至是控制回路也要进行协调,这就对网络飞行控制系统设计提出了较高的要求,由于控制回路的带宽相对制导回路宽,很有可能将网络延迟近似的噪声纳入到带宽之内,故网络延迟可能导致飞控系统控制品质恶化,本发明在一定程度上缓解了网络延迟导致的飞行控制系统品质恶化,能够增强分布式系统的稳定性;其次控制系统的随机鲁棒分析与设计针对的网络传输模式是事件驱动的,这种传输模式有以下两个优点,一是不需要设计定时精确的定时器,降低了数据链设计的难度与成本,二是能较好的与现有民用网络协议兼容。
实施例:
步骤一:建立无人飞行器系统模型并确定不存在网络延迟的飞行控制系统的控制律;
无人飞行器动力学参数和物理参数可以根据实际风洞吹风得到,采用英美坐标系,具体数值见下表:
(2)建立非线性六自由度动力学与运动学方程;
选取无人机飞行状态向量为:
建立如公式(1)所示的无人机六自由度动力学与运动学方程;
(3)解耦线性化;
解公式(3),得到无人飞行器的配平攻角α0=4.4821°,配平升降舵偏角δe0=-2.2736°,配平飞行速度V0=41.0214m/s,在该状态点利用小扰动线性化原理可得无人飞行器纵向线性系统状态方程为:
(4)LQR设计控制律;
针对纵向:选取Q1和R1矩阵如下:
采用线性二次型调节器设计纵向控制律:
根据公式(7)(8)(9)(10)的运算最终可得
无人机的升降舵不接入速度反馈,油门控制只接入速度控制,由于除速度以外的其他状态量不能通过油门调节,故加强升降舵对其他状态量的反馈,最终选择如下控制器反馈系数:
k1=-0.48,k2=0.02632,k3=2.4003,k4=0.008,k5=-0.46118;
假设初始无人机飞行高度在300m,这时给高度指令h*=250m,控制计算机频率为50Hz,系统响应如图2所示,分别包括速度、攻角、俯仰角速度、俯仰角、高度、升降舵偏角、油门、法向过载的相应图。
取仿真时间100s内的平均指令偏差(Average Instruction Deviation,AID)作为系统控制品质的度量:
此时系统的AID为6.4394m。
步骤二:在不同网络随机延迟条件下,进行飞行控制系统随机鲁棒性分析与设计;
(1)飞行控制系统随机鲁棒性分析
假设无人机控制系统的网络延迟可以分为两个等级,一类网络延迟属于短时间延迟,记为τ1,服从均值μ1为700ms,方差σ1为100ms的标准正态分布;一类网络延迟属于中时间延迟,记为τ2,服从均值μ2为900ms,方差σ2为100ms的标准正态分布;一类网络延迟属于长时间延迟,记为τ3,服从均值μ3为1100ms,方差σ3为100ms的标准正态分布,即:
τ1~N(μ1,σ1 2),τ2~N(μ2,σ2 2),τ3~N(μ3,σ3 2)
对网络延迟服从上述分布的网络飞行控制系统进行蒙特卡洛仿真,控制律采用步骤一中设计的无人机纵向控制律,图3是τ1~N(μ1,σ1 2)的AID值和高度响应的蒙特卡洛仿真曲线,此时最大超调量达到20%,AID最大值为6.87;图4是τ2~N(μ2,σ2 2)的AID值和高度响应的蒙特卡洛仿真曲线,此时最大超调量达到35%,AID最大值为7.48;图5是τ3~N(μ3,σ3 2)的AID值和高度响应的蒙特卡洛仿真曲线,此时最大超调量达到45%,AID最大值为8.35,所以三种分布的网络随机延迟造成的控制系统的控制品质较差,控制系统的控制律是针对不含网络随机延迟的连续系统,采用LQR方法设计的,设计的控制律对含有网络延迟的飞行器纵向通道控制品质不高,因此采用随机鲁棒性设计方法进一步提高控制品质。
(2)飞行控制系统随机鲁棒性设计
控制器结构采用传统的PID控制,利用粒子群算法优化控制器参数,粒子群中粒子的个数取为30,解向量的维数n为5,迭代次数k为20,对控制器反馈参数k1…k5进行寻优,网络随机延迟τ1~N(μ1,σ1 2)的随机鲁棒设计结果如图6所示,图6给出了标准粒子群算法的代价收敛曲线,获得AID的最小值为6.26927,蒙特卡洛仿真中获得的最大AID为6.33,获得的最终控制系统参数
控制器结构采用传统的PID控制,利用粒子群算法优化控制器参数,粒子群中粒子的个数取为30,解向量的维数n为5,迭代次数k为20,对控制器反馈参数k1…k5进行寻优,网络随机延迟τ2~N(μ2,σ2 2)的随机鲁棒设计结果如图7所示,图7给出了标准粒子群算法的代价收敛曲线,获得AID的最小值为6.47923,蒙特卡洛仿真中获得的最大AID为6.7,获得的最终控制系统参数
控制器结构采用传统的PID控制,利用粒子群算法优化控制器参数,粒子群中粒子的个数m取为30,解向量的维数n为5,迭代次数k为20,对控制器反馈参数k1…k5进行寻优,网络随机延迟τ3~N(μ3,σ3 2)的随机鲁棒设计结果如图8所示,图8给出了标准粒子群算法的代价收敛曲线,获得AID的最小值为6.51899,蒙特卡洛仿真中获得的最大AID为6.82,获得的最终控制系统参数
步骤三:确定飞行控制系统的增益调度策略;
由于随机鲁棒设计的控制器只能保证网络随机延迟在一定范围内的鲁棒性能满足一定要求,例如K1在网络随机延迟服从τ3~N(μ3,σ3 2)分布时蒙特卡洛仿真曲线如图9所示,此时的鲁棒性能已经下降到不可接受的地步,所以网络控制系统增益调度策略是有必要的。采用线性插值进行网络飞行控制系统的增益调度。假设网络延迟在600ms和1200ms之间,控制器测量的网络延迟为τN,则实际采用的控制器反馈系数KN为:
步骤四:闭环六自由度非线性蒙特卡洛仿真验证;
图10给出了高度指令和网络随机延迟满足正态分布
时的控制律增益调度策略50次蒙特卡洛仿真曲线,可见控制品质可以满足要求。
图11给出了高度指令和网络随机延迟满足均匀分布
时的控制律增益调度策略50次蒙特卡洛仿真曲线,其中a=600ms,b=1200ms,这是控制器增益调度中是最差的情况,可见控制品质可以满足要求。
图10和图11的结果的前提是网络随机延迟可以准确的测量,这时可以根据测量值采用响应的线性调度策略,实际情况中应研究网络随机延迟的估计方法。
Claims (4)
1.一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法,其特征在于,包括如下步骤:
步骤一:建立无人飞行器纵向系统模型并设计不存在网络延迟的飞行控制系统,具体为:
(1)根据风洞吹风获得无人飞行器动力学参数和物理参数;
(2)建立飞行器纵向非线性动力学与运动学方程;
(3)解耦线性化;
假设无人飞行器处于定高稳定平飞状态,则必有升力-重力平衡、推力-阻力平衡以及俯仰力矩平衡,因此下面三个等式成立:
解方程(3),得到无人飞行器的配平攻角α0,配平升降舵偏角δe0,配平飞行速度V0,在该状态点利用小扰动线性化原理得无人飞行器纵向线性状态方程为:
其中A为纵向线性系统状态矩阵,B为纵向线性系统控制矩阵;
(4)LQR设计控制律;
步骤二:在不同网络随机延迟条件下,进行飞行控制系统随机鲁棒性分析与设计;
(1)飞行控制系统随机鲁棒性分析:
采用相互独立的随机延迟作为网络飞行控制系统的主要延迟类型,假设网络随机延迟τi服从均值μi,方差σi的正态分布,即:
τi∈N(μi,σi),i=1,2,...,N (9)
无人飞行器非线性系统方程为:
(2)飞行控制系统随机鲁棒性设计:
随机鲁棒性设计过程包括控制器结构设计和现代优化算法两部分,控制器结构设计采用传统的PID控制,现代优化算法采用标准粒子群算法,优化指标是飞行控制系统随机鲁棒性分析中的鲁棒性衡量标准;
采用标准粒子群算法求解该优化问题,问题的解对应于搜索空间中的一个粒子,每个粒子都有自己的位置和速度及一个由被优化函数决定的代价函数;各个粒子记忆、追随当前的最优粒子,每次迭代中,粒子通过跟随两个极值来更新自己的位置和速度:一个是粒子本身获得的最优解一个是整个粒子群中全部粒子历代搜索获得的最优解标准粒子群算法中,速度更新和位置更新如式(11)所示:
式中,i∈N(1,ns),ns为粒子群中粒子的个数,N代表整数;d∈N(1,n),n为解向量的维数,k为迭代次数,c1和c2为学习因子;ω为惯量权重;r1和r2为[0,1]之间的随机数,判断粒子群中粒子优劣的标准是蒙特卡洛仿真获得的代价函数W,代价函数越小,在下一代该粒子存在的概率越大;
步骤三:确定飞行控制系统的增益调度策略;
采用线性插值进行网络飞行控制系统的增益调度,假设网络随机延迟在τ1和τi之间,网络随机延迟在τ1~N(μ1,σ1),τ2~N(μ2,σ2)......τi~N(μi,σi)时分别利用随机鲁棒分析与设计方法设计的控制系统参数控制器当前测量的网络随机延迟为τN,则实际采用的控制器反馈系数KN为:
步骤四:闭环六自由度非线性蒙特卡洛仿真验证。
2.根据权利要求1所述的一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法,其特征在于:所述的动力学参数包括纵向力和力矩系数:包括升力系数CL0、CLa、CLq、阻力系数CD0、CDa、CDq、俯仰力矩系数Cm0、Cma、Cmq、其中,CL0为攻角为0度时的升力系数,CLa为升力关于攻角的升力系数,CLq为升力关于俯仰角速度的升力系数,为升力关于升降舵的升力系数,CD0为攻角为0度时的阻力系数,CDa为阻力关于攻角的阻力系数,CDq为阻力关于俯仰角速度的阻力系数,为阻力关于升降舵的阻力系数,Cm0为攻角为0度时的俯仰力矩系数,Cma为俯仰力矩关于攻角的力矩系数,Cmq为俯仰力矩关于俯仰角速度的力矩系数、为俯仰力矩关于升降舵的力矩系数;
所述的物理参数包括无人飞行器的质量m,单位kg;平均几何弦长CA,单位m;翼展b,单位m;飞行器参考面积Sw单位m2;X轴转动惯量IX,单位kg·m2;Y轴转动惯量IY,单位kg·m2;Z轴转动惯量IZ,单位kg·m2;惯量积IXZ,单位kg·m2;舵机时间常数Tδ,单位s;舵机放大系数Kδ;发动机时间常数Tt,单位s;发动机放大系数Kt、怠速推力tA,单位N;最大推力tmax和最小推力tmin,单位N。
3.根据权利要求1所述的一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法,其特征在于:步骤一(2)中所述的飞行器纵向非线性动力学与运动学方程具体如下:
选取无人机飞行状态向量为:
其中,V表示速度、α表示攻角、q表示俯仰角速度、θ表示俯仰角、x表示东向位置、h表示高度、m表示质量、δe表示升降舵偏角、δt表示发动机推力;
建立无人飞行器非线性六自由度运动学与动力学方程如下:
其中:表示速度的导数、表示攻角的导数、俯仰角速度的导数、表示俯仰角的导数、表示东向位置导数、表示高度的导数、表示质量消耗率、表示升降舵偏角的导数、表示发动机推力的导数、表示升降舵偏角指令、表示油门指令、μ为航迹倾角、Km为发动机耗油率、δT为发动机推力、Tδ为舵机时间常数、Tt为发动机时间常数、Kδ为舵机放大系数、Kt为发动机放大系数,IY为Y轴转动惯量,式(1)简记为:其中为飞行状态向量的导数,为飞行控制向量;
其中:CL为总升力系数、CD为总阻力系数、Cm为总俯仰力矩系数、ρ为空气密度、L为总升力、D为总阻力、M为总俯仰力矩、Sw为飞行器参考面积、CA为飞行器平均几何弦长、b为翼展。
4.根据权利要求1所述的一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法,其特征在于:步骤一(4)中所述的LQR设计控制律,具体为得到最终应用的控制器反馈系数,针对纵向:
选取Q1和R1矩阵,采用线性二次型调节器LQR设计纵向控制律K,K为2×7的矩阵;用kij表示K中的第i行第j列元素,选择以下控制器结构:
其中:δe0为配平升降舵偏角,α0为无人飞行器的配平攻角,h*为高度指令,V0为配平飞行速度;对于
其中:NZ是无人飞行器的法向过载,进一步化简并代入数据得:
联立式(5)、式(7)得实际飞行中的控制器结构:
其中:k1k2k3k4k5表示按照式(5)和式(7)换算后的最终应用的控制器反馈系数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310015336.0A CN103116280B (zh) | 2013-01-16 | 2013-01-16 | 一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310015336.0A CN103116280B (zh) | 2013-01-16 | 2013-01-16 | 一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103116280A true CN103116280A (zh) | 2013-05-22 |
CN103116280B CN103116280B (zh) | 2016-03-02 |
Family
ID=48414694
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310015336.0A Active CN103116280B (zh) | 2013-01-16 | 2013-01-16 | 一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103116280B (zh) |
Cited By (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103454927A (zh) * | 2013-08-22 | 2013-12-18 | 哈尔滨工业大学 | 飞行器分布式网络化全物理地面仿真装置及方法 |
CN103792848A (zh) * | 2014-02-28 | 2014-05-14 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇人机闭环复合根轨迹多级pid鲁棒控制器设计方法 |
CN103809457A (zh) * | 2014-02-28 | 2014-05-21 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇复合频率控制器设计方法 |
CN103809445A (zh) * | 2014-02-28 | 2014-05-21 | 西安费斯达自动化工程有限公司 | 飞行器多回路模型簇复合pid控制器设计方法 |
CN103809456A (zh) * | 2014-02-28 | 2014-05-21 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇人机闭环pid鲁棒控制器设计方法 |
CN103809454A (zh) * | 2014-02-28 | 2014-05-21 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇人机闭环复合频率鲁棒控制器设计方法 |
CN104063537A (zh) * | 2014-05-30 | 2014-09-24 | 北京控制工程研究所 | 基于分布式时间触发的多体动力学参数确定系统及其方法 |
CN104133477A (zh) * | 2014-04-17 | 2014-11-05 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种可以实现瞬态抑制的调效控制律指令控制方法 |
CN103676646B (zh) * | 2013-12-29 | 2016-01-20 | 哈尔滨理工大学 | 一种具有随机发生的不确定性和分布式传感器时滞的网络化控制系统的状态估计方法 |
CN105468018A (zh) * | 2015-11-26 | 2016-04-06 | 北京航天科颐技术有限公司 | 一种无人机目标特性模拟系统 |
CN106354021A (zh) * | 2016-11-30 | 2017-01-25 | 江西洪都航空工业集团有限责任公司 | 基于pso的飞机纵向运动俯仰角控制系统pid优化方法 |
CN106440844A (zh) * | 2016-07-20 | 2017-02-22 | 长春工业大学 | 一种篦冷机刮板速度控制方法 |
CN106483844A (zh) * | 2015-09-01 | 2017-03-08 | 南京理工大学 | 基于非线性鲁棒的电液伺服系统自适应位置控制器的实现方法 |
CN106527122A (zh) * | 2017-01-05 | 2017-03-22 | 烟台南山学院 | 平流层飞艇定高飞行非线性pid控制方法 |
CN106527128A (zh) * | 2016-10-13 | 2017-03-22 | 南京航空航天大学 | 兼顾瞬态响应与鲁棒稳定性的飞行控制律设计新方法 |
CN108132877A (zh) * | 2017-12-08 | 2018-06-08 | 中国航空工业集团公司成都飞机设计研究所 | 一种飞行控制软件中增益覆盖率测试的方法 |
CN108427430A (zh) * | 2018-03-30 | 2018-08-21 | 南京航空航天大学 | 基于网络控制的四旋翼飞行器控制方法 |
CN109358646A (zh) * | 2018-07-26 | 2019-02-19 | 北京航空航天大学 | 带有乘性噪声的导弹自主编队队形随机控制系统建模方法 |
CN109460048A (zh) * | 2018-11-02 | 2019-03-12 | 中国航空工业集团公司西安飞机设计研究所 | 一种轨迹不稳定性控制方法 |
CN110147120A (zh) * | 2019-06-25 | 2019-08-20 | 西北工业大学 | 一种自主水下航行器舵面主动容错控制方法 |
CN110161855A (zh) * | 2019-05-21 | 2019-08-23 | 中国电子科技集团公司第三十八研究所 | 一种基于鲁棒伺服增益调度无人机控制器的设计方法 |
CN110597071A (zh) * | 2019-10-17 | 2019-12-20 | 陕西师范大学 | 一种飞行器纵向过载控制的主动抗扰方法 |
CN111240304A (zh) * | 2020-01-23 | 2020-06-05 | 北京航天自动控制研究所 | 一种用于飞行器推力故障在线辨识的机器学习样本生成方法 |
CN111413866A (zh) * | 2020-03-06 | 2020-07-14 | 大连理工大学 | 一种考虑时延的航空发动机分布式控制律设计及验证方法 |
CN112147956A (zh) * | 2019-06-26 | 2020-12-29 | 丰田自动车株式会社 | 分布式控制系统 |
CN117915348A (zh) * | 2024-03-19 | 2024-04-19 | 成都流体动力创新中心 | 一种飞行器集群通信网络生成方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2112268C1 (ru) * | 1996-12-25 | 1998-05-27 | Акционерное общество открытого типа "Московский вертолетный завод им.М.Л.Миля" | Комплекс наведения и управления полетом летательных аппаратов |
EP1957365B1 (en) * | 2005-12-06 | 2009-11-25 | Airbus Deutschland GmbH | Method for reconstructing gusts and structural loads at aircraft, in particular passenger aircraft |
CN102354114A (zh) * | 2011-07-18 | 2012-02-15 | 安徽工程大学 | 一种网络控制系统的随机时延建模方法 |
CN102591358A (zh) * | 2012-03-12 | 2012-07-18 | 北京航空航天大学 | 一种多无人机的动态编队控制方法 |
-
2013
- 2013-01-16 CN CN201310015336.0A patent/CN103116280B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2112268C1 (ru) * | 1996-12-25 | 1998-05-27 | Акционерное общество открытого типа "Московский вертолетный завод им.М.Л.Миля" | Комплекс наведения и управления полетом летательных аппаратов |
EP1957365B1 (en) * | 2005-12-06 | 2009-11-25 | Airbus Deutschland GmbH | Method for reconstructing gusts and structural loads at aircraft, in particular passenger aircraft |
CN102354114A (zh) * | 2011-07-18 | 2012-02-15 | 安徽工程大学 | 一种网络控制系统的随机时延建模方法 |
CN102591358A (zh) * | 2012-03-12 | 2012-07-18 | 北京航空航天大学 | 一种多无人机的动态编队控制方法 |
Non-Patent Citations (2)
Title |
---|
LIU XING等: "Autonomous Formation and Cooperative Guidance of Multi-UAV: Concept, Design and Simulation", 《系统仿真学报》 * |
吴森堂等: "高超声速飞行器的非线性随机控制方法", 《航天控制》 * |
Cited By (42)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103454927A (zh) * | 2013-08-22 | 2013-12-18 | 哈尔滨工业大学 | 飞行器分布式网络化全物理地面仿真装置及方法 |
CN103454927B (zh) * | 2013-08-22 | 2016-06-08 | 哈尔滨工业大学 | 飞行器分布式网络化全物理地面仿真装置 |
CN103676646B (zh) * | 2013-12-29 | 2016-01-20 | 哈尔滨理工大学 | 一种具有随机发生的不确定性和分布式传感器时滞的网络化控制系统的状态估计方法 |
CN103809456B (zh) * | 2014-02-28 | 2016-08-17 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇人机闭环pid鲁棒控制器设计方法 |
CN103809457B (zh) * | 2014-02-28 | 2016-05-25 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇复合频率控制器设计方法 |
CN103809454A (zh) * | 2014-02-28 | 2014-05-21 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇人机闭环复合频率鲁棒控制器设计方法 |
CN103792848A (zh) * | 2014-02-28 | 2014-05-14 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇人机闭环复合根轨迹多级pid鲁棒控制器设计方法 |
CN103809454B (zh) * | 2014-02-28 | 2016-06-15 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇人机闭环复合频率鲁棒控制器设计方法 |
CN103809445A (zh) * | 2014-02-28 | 2014-05-21 | 西安费斯达自动化工程有限公司 | 飞行器多回路模型簇复合pid控制器设计方法 |
CN103792848B (zh) * | 2014-02-28 | 2016-03-30 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇人机闭环复合根轨迹多级pid鲁棒控制器设计方法 |
CN103809457A (zh) * | 2014-02-28 | 2014-05-21 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇复合频率控制器设计方法 |
CN103809445B (zh) * | 2014-02-28 | 2016-05-25 | 西安费斯达自动化工程有限公司 | 飞行器多回路模型簇复合pid控制器设计方法 |
CN103809456A (zh) * | 2014-02-28 | 2014-05-21 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇人机闭环pid鲁棒控制器设计方法 |
CN104133477A (zh) * | 2014-04-17 | 2014-11-05 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种可以实现瞬态抑制的调效控制律指令控制方法 |
CN104133477B (zh) * | 2014-04-17 | 2016-10-26 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种可以实现瞬态抑制的调效控制律指令控制方法 |
CN104063537B (zh) * | 2014-05-30 | 2017-04-19 | 北京控制工程研究所 | 基于分布式时间触发的多体动力学参数确定系统及其方法 |
CN104063537A (zh) * | 2014-05-30 | 2014-09-24 | 北京控制工程研究所 | 基于分布式时间触发的多体动力学参数确定系统及其方法 |
CN106483844A (zh) * | 2015-09-01 | 2017-03-08 | 南京理工大学 | 基于非线性鲁棒的电液伺服系统自适应位置控制器的实现方法 |
CN105468018A (zh) * | 2015-11-26 | 2016-04-06 | 北京航天科颐技术有限公司 | 一种无人机目标特性模拟系统 |
CN105468018B (zh) * | 2015-11-26 | 2018-05-25 | 北京航天科颐技术有限公司 | 一种无人机目标特性模拟系统 |
CN106440844B (zh) * | 2016-07-20 | 2019-06-18 | 长春工业大学 | 一种篦冷机刮板速度控制方法 |
CN106440844A (zh) * | 2016-07-20 | 2017-02-22 | 长春工业大学 | 一种篦冷机刮板速度控制方法 |
CN106527128B (zh) * | 2016-10-13 | 2019-02-12 | 南京航空航天大学 | 兼顾瞬态响应与鲁棒稳定性的飞行控制律设计方法 |
CN106527128A (zh) * | 2016-10-13 | 2017-03-22 | 南京航空航天大学 | 兼顾瞬态响应与鲁棒稳定性的飞行控制律设计新方法 |
CN106354021A (zh) * | 2016-11-30 | 2017-01-25 | 江西洪都航空工业集团有限责任公司 | 基于pso的飞机纵向运动俯仰角控制系统pid优化方法 |
CN106527122A (zh) * | 2017-01-05 | 2017-03-22 | 烟台南山学院 | 平流层飞艇定高飞行非线性pid控制方法 |
CN106527122B (zh) * | 2017-01-05 | 2019-03-15 | 烟台南山学院 | 平流层飞艇定高飞行非线性pid控制方法 |
CN108132877B (zh) * | 2017-12-08 | 2021-04-20 | 中航(成都)无人机系统股份有限公司 | 一种飞行控制软件中增益覆盖率测试的方法 |
CN108132877A (zh) * | 2017-12-08 | 2018-06-08 | 中国航空工业集团公司成都飞机设计研究所 | 一种飞行控制软件中增益覆盖率测试的方法 |
CN108427430A (zh) * | 2018-03-30 | 2018-08-21 | 南京航空航天大学 | 基于网络控制的四旋翼飞行器控制方法 |
CN109358646A (zh) * | 2018-07-26 | 2019-02-19 | 北京航空航天大学 | 带有乘性噪声的导弹自主编队队形随机控制系统建模方法 |
CN109460048A (zh) * | 2018-11-02 | 2019-03-12 | 中国航空工业集团公司西安飞机设计研究所 | 一种轨迹不稳定性控制方法 |
CN110161855A (zh) * | 2019-05-21 | 2019-08-23 | 中国电子科技集团公司第三十八研究所 | 一种基于鲁棒伺服增益调度无人机控制器的设计方法 |
CN110147120A (zh) * | 2019-06-25 | 2019-08-20 | 西北工业大学 | 一种自主水下航行器舵面主动容错控制方法 |
CN110147120B (zh) * | 2019-06-25 | 2021-07-06 | 西北工业大学 | 一种自主水下航行器舵面主动容错控制方法 |
CN112147956A (zh) * | 2019-06-26 | 2020-12-29 | 丰田自动车株式会社 | 分布式控制系统 |
CN112147956B (zh) * | 2019-06-26 | 2024-06-18 | 丰田自动车株式会社 | 分布式控制系统 |
CN110597071A (zh) * | 2019-10-17 | 2019-12-20 | 陕西师范大学 | 一种飞行器纵向过载控制的主动抗扰方法 |
CN110597071B (zh) * | 2019-10-17 | 2022-05-31 | 陕西师范大学 | 一种飞行器纵向过载控制的主动抗扰方法 |
CN111240304A (zh) * | 2020-01-23 | 2020-06-05 | 北京航天自动控制研究所 | 一种用于飞行器推力故障在线辨识的机器学习样本生成方法 |
CN111413866A (zh) * | 2020-03-06 | 2020-07-14 | 大连理工大学 | 一种考虑时延的航空发动机分布式控制律设计及验证方法 |
CN117915348A (zh) * | 2024-03-19 | 2024-04-19 | 成都流体动力创新中心 | 一种飞行器集群通信网络生成方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103116280B (zh) | 2016-03-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103116280B (zh) | 一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法 | |
CN102880182B (zh) | 一种存在网络随机延迟的微小型无人飞行器控制方法 | |
CN103645636B (zh) | 一种pid控制器参数优化方法 | |
CN102163059B (zh) | 推力变向无人机的姿态控制系统及控制方法 | |
US20170131726A1 (en) | Automated operation of aircraft systems in inverted-v formations | |
CN104460681A (zh) | 倾转旋翼无人直升机过渡段的飞行控制方法 | |
CN105222648A (zh) | 一种线性伪谱广义标控脱靶量制导控制方法 | |
CN113220021B (zh) | 基于虚拟领导者的飞行编队协同自适应跟踪控制方法 | |
Munoz et al. | Robust nonlinear real-time control strategy to stabilize a PVTOL aircraft in crosswind | |
Abramov et al. | Controlling flight vehicle spatial motion along a given route | |
Nair et al. | Longitudinal dynamics control of UAV | |
CN114003052B (zh) | 一种基于动态补偿系统的固定翼无人机纵向运动鲁棒自适应控制方法 | |
Hervas et al. | Sliding mode control of fixed-wing uavs in windy environments | |
CN102707616A (zh) | 基于飞行器三角模型的控制器区域设计方法 | |
CN102707629B (zh) | 基于飞行器切换模型的全维控制器区域设计方法 | |
Kan et al. | Tensor product model-based control design with relaxed stability conditions for perching maneuvers | |
CN117434838A (zh) | 一种变时域事件触发交会对接协同预测控制方法 | |
Michailidis et al. | A controller design framework for a NextGen circulation control based UAV | |
CN106292714B (zh) | 一种静不稳定无人机的跃升与俯冲机动控制方法 | |
CN110162084A (zh) | 基于一致性理论的飞航导弹集群系统编队控制方法 | |
CN107991884A (zh) | 基于距离信息的小型固定翼无人机深度失速回收方法 | |
CN114415734A (zh) | 基于adp和避障机制的四旋翼无人机编队重构控制系统 | |
Chrpa et al. | Smoothed hex-grid trajectory planning using helicopter dynamics | |
Jia et al. | Control of an airship using particle swarm optimization and neural network | |
Xin et al. | Adaptive robust control based on TS fuzzy-neural systems for a hypersonic vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |