[发明专利]一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法有效
申请号: | 201310015336.0 | 申请日: | 2013-01-16 |
公开(公告)号: | CN103116280A | 公开(公告)日: | 2013-05-22 |
发明(设计)人: | 吴森堂;孙健;杜阳;胡楠希 | 申请(专利权)人: | 北京航空航天大学 |
主分类号: | G05B13/04 | 分类号: | G05B13/04 |
代理公司: | 北京永创新实专利事务所 11121 | 代理人: | 姜荣丽 |
地址: | 100191*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明公开了一种存在网络随机延迟的微小型无人飞行器纵向控制方法,属于飞行控制技术领域,该方法首先建立无人飞行器纵向系统模型并设计不存在网络延迟的飞行控制系统;然后在不同网络随机延迟条件下,进行飞行控制系统随机鲁棒性分析与设计;确定飞行控制系统的增益调度策略;最后闭环六自由度非线性蒙特卡洛仿真验证。本发明缓解了网络延迟导致的飞行控制系统品质恶化,能够增强分布式系统的稳定性;利用随机鲁棒分析与设计方法以及基于线性插值的增益调度策略,得到的控制律具有简单便于工程实现的优点,能够在大网络时延变化的情况下较好的维持原控制系统的控制品质。 | ||
搜索关键词: | 一种 存在 分布 网络 随机 延迟 微小 无人 飞行器 纵向 控制 方法 | ||
【主权项】:
1.一种存在变分布网络随机延迟的微小型无人飞行器纵向控制方法,其特征在于,包括如下步骤:步骤一:建立无人飞行器纵向系统模型并设计不存在网络延迟的飞行控制系统,具体为:(1)根据风洞吹风获得无人飞行器动力学参数和物理参数;(2)建立飞行器纵向非线性动力学与运动学方程;(3)解耦线性化;假设无人飞行器处于定高稳定平飞状态,则必有升力-重力平衡、推力-阻力平衡以及俯仰力矩平衡,因此下面三个等式成立:1 2 ρ V 2 · S w · ( C L 0 + C Lα · α + C L δ e · δ e ) = m · g 1 2 ρ V 2 · S w · ( C D 0 + C Dα · α + C D δ e · δ e ) = t A 1 2 ρ V 2 · S w · ( C m 0 + C mα · α + C m δ e · δ e ) · C A = 0 - - - ( 3 ) ]]> 解方程(3),得到无人飞行器的配平攻角α0,配平升降舵偏角δe0,配平飞行速度V0,在该状态点利用小扰动线性化原理得无人飞行器纵向线性状态方程为:V · α · q · θ · h · δ · e δ · t = A V α q θ h δ e δ t + B δ e * δ t * - - - ( 4 ) ]]> 其中A为纵向线性系统状态矩阵,B为纵向线性系统控制矩阵;(4)LQR设计控制律;步骤二:在不同网络随机延迟条件下,进行飞行控制系统随机鲁棒性分析与设计;(1)飞行控制系统随机鲁棒性分析:采用相互独立的随机延迟作为网络飞行控制系统的主要延迟类型,假设网络随机延迟τi服从均值μi,方差σi的正态分布,即:τi∈N(μi,σi),i=1,2,...,N (9)无人飞行器非线性系统方程为:X ‾ · ( t ) = f ( X - ( t ) , u ( t - τ i ) ) - - - ( 10 ) ]]> 其中:
为飞行状态向量,
为飞行状态向量的导数,u(t-τi)为加入网络随机延迟的飞行控制向量;(2)飞行控制系统随机鲁棒性设计:随机鲁棒性设计过程包括控制器结构设计和现代优化算法两部分,控制器结构设计采用传统的PID控制,现代优化算法采用标准粒子群算法,优化指标是飞行控制系统随机鲁棒性分析中的鲁棒性衡量标准;采用标准粒子群算法求解该优化问题,问题的解对应于搜索空间中的一个粒子,每个粒子都有自己的位置和速度及一个由被优化函数决定的代价函数;各个粒子记忆、追随当前的最优粒子,每次迭代中,粒子通过跟随两个极值来更新自己的位置和速度:一个是粒子本身获得的最优解
一个是整个粒子群中全部粒子历代搜索获得的最优解
标准粒子群算法中,速度更新和位置更新如式(11)所示:v id k + 1 = ωv i k + c 1 r 1 ( p id k - x id k ) + c 2 r 2 ( g id k - x id k ) x id k + 1 = x id k + v id k + 1 - - - ( 11 ) ]]> 式中,i∈N(1,ns),ns为粒子群中粒子的个数,N代表整数;d∈N(1,n),n为解向量的维数,k为迭代次数,c1和c2为学习因子;ω为惯量权重;r1和r2为[0,1]之间的随机数,判断粒子群中粒子优劣的标准是蒙特卡洛仿真获得的代价函数W,代价函数越小,在下一代该粒子存在的概率越大;设定粒子最大的迭代次数,判断迭代是否到达最大迭代次数,如果到达,输出最好粒子代表的网络随机延迟τi下的控制系统参数
否则,继续进行迭代;步骤三:确定飞行控制系统的增益调度策略;采用线性插值进行网络飞行控制系统的增益调度,假设网络随机延迟在τ1和τi之间,网络随机延迟在τ1~N(μ1,σ1),τ2~N(μ2,σ2)......τi~N(μi,σi)时分别利用随机鲁棒分析与设计方法设计的控制系统参数
控制器当前测量的网络随机延迟为τN,则实际采用的控制器反馈系数KN为:K N = τ N - τ 1 τ 2 - τ 1 · ( K 2 N - K 1 N ) + K 1 N , τ 1 ≤ τ N ≤ τ 2 τ N - τ 2 τ 3 - τ 2 · ( K 3 N - K 2 N ) + K 2 N , τ 2 < τ N ≤ τ 3 · · · · · · τ N - τ i - 1 τ i - τ i - 1 · ( K i N - K i - 1 N ) + K i - 1 N , τ i - 1 < τ N ≤ τ i ]]> 步骤四:闭环六自由度非线性蒙特卡洛仿真验证。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京航空航天大学,未经北京航空航天大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201310015336.0/,转载请声明来源钻瓜专利网。