[发明专利]一种基于非线性控制律的飞行器风洞自由飞的控制方法有效
申请号: | 201810706131.X | 申请日: | 2018-06-26 |
公开(公告)号: | CN109032171B | 公开(公告)日: | 2019-07-16 |
发明(设计)人: | 但英浩;孙海生;岑飞;刘志涛;郭林亮;刘多能;朱正龙;张海酉 | 申请(专利权)人: | 中国空气动力研究与发展中心低速空气动力研究所 |
主分类号: | G05D1/10 | 分类号: | G05D1/10 |
代理公司: | 成都帝鹏知识产权代理事务所(普通合伙) 51265 | 代理人: | 黎照西 |
地址: | 621000 四川*** | 国省代码: | 四川;51 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明公开一种基于非线性控制律的飞行器风洞自由飞的控制方法,包括步骤:根据水平风洞的飞行器试验系统数据建立飞行动力学方程;将所述飞行动力学方程转化为状态空间方程;通过时标分离理论将飞行器控制系统分为内环转动控制回路和外环质心控制回路;对内环转动控制回路,以INDI增量式动态逆方法或NDI动态逆方法设计控制律;对外环质心控制回路,根据风洞动态试验数据,加入动导数影响项设计控制律;通过内环转动控制回路和外环质心控制回路控制飞行器各舵面。本发明能够有效抵消系统非线性,降低干扰,满足所需的控制要求且优化控制效果,提高控制精度。 | ||
搜索关键词: | 风洞 转动控制回路 控制回路 质心 非线性控制律 飞行动力学 控制律 飞行器 内环 飞行器控制系统 状态空间方程 飞行器试验 控制飞行器 抵消系统 动态试验 方程转化 分离理论 降低干扰 控制要求 系统数据 优化控制 增量式 导数 舵面 时标 自由 | ||
【主权项】:
1.一种基于非线性控制律的飞行器风洞自由飞的控制方法,其特征在于,包括步骤:S100,根据水平风洞的飞行器系统数据建立飞行动力学方程,所述飞行动力学方程包括质心动力学方程和转动动力学方程;S200,将所述飞行动力学方程转化为状态空间方程;S300,通过时标分离理论将飞行器控制系统分为内环转动控制回路和外环质心控制回路;对内环转动控制回路,以增量式非线性动态逆方法或非线性动态逆方法设计控制律;根据转动动力学方程转化为状态空间方程计算方程为:
输入三轴角加速度
输出的各舵面偏度[δc,δe,δa,δrl,δrr,δlef]T和[δy,δz]T;其中,δc是鸭翼偏度,δe是数字升降舵偏度,δa是数字副翼偏度,δrl是左方向舵偏度,δrr是右方向舵偏度,δlef是前缘襟翼偏度;[fp(x),fq(x),fr(x)]三轴角加速度p,q,r的转动函数:
其中,
分别为滚转、俯仰、偏航零控制力矩,c1~c9为惯量系数;其中,
c2=(Ix‑Iy+Iz)Ixz/Σ,c3=Iz/Σ,c4=Ixz/Σ,c5=(Iz‑Ix)/Iy,c6=Ixz/Iy,c7=1/Iy,
c9=Ix/Σ;其中Ix,Iy,Iz为转动惯量,Ixz为惯量积,
B1和B2是控制效能矩阵:![]()
其中,T是推力,XT为推力力臂;gpδc:表示鸭翼δc对滚转角速度p的效能;gpδe表示数字升降舵δe对滚转角速度p的效能;gpδa表示数字副翼δa对滚转角速度p的效能;gpδrl表示左方向舵δrl对滚转角速度p的效能;gpδrr表示右方向舵δrr对滚转角速度p的效能;gqδc表示鸭翼δc对俯仰角速度q的效能;gqδe表示数字升降舵δe对俯仰角速度q的效能;gqδa表示数字副翼δa对俯仰角速度q的效能;gqδrl表示左方向舵δrl对俯仰角速度q的效能;gqδrr表示右方向舵δrr对俯仰角速度q的效能;grδc表示鸭翼δc对偏航角速度r的效能;grδe表示数字升降舵δe对偏航角速度r的效能;grδa表示数字副翼δa对偏航角速度r的效能;grδrl表示左方向舵δrl对偏航角速度r的效能;grδrr表示右方向舵δrr对偏航角速度r的效能;对外环质心控制回路,根据风洞动态试验数据,加入动导数影响项设计控制律;根据质心动力学方程转化为状态空间方程计算方程为:
输入三个气流角[α,β,μ]T,输出的飞行器滚转、俯仰、偏航角速度指令[p q,r]T;其中,[fα(x),fβ,(x),fμ(x)]三个气流角α,β,μ的质心函数;B3是控制效能矩阵:
B3中g为各内环状态量相对于外环状态量并加入动导数影响项的效能系数,其中:gαp滚转角速度p相对迎角α的效能,gαq俯仰角速度q相对迎角α的效能,gαr偏航角速度r相对迎角α的效能,gβp滚转角速度p相对侧滑角β的效能,gβq俯仰角速度q相对侧滑角β的效能,gβr偏航角速度r相对侧滑角β的效能,gμp滚转角速度p相对绕速度矢量滚转角μ的效能,gμq俯仰角速度q相对绕速度矢量滚转角μ的效能,gμr偏航角速度r相对绕速度矢量滚转角μ的效能;S400,通过内环转动控制回路和外环质心控制回路控制飞行器各舵面。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国空气动力研究与发展中心低速空气动力研究所,未经中国空气动力研究与发展中心低速空气动力研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201810706131.X/,转载请声明来源钻瓜专利网。
- 上一篇:一种基于无人机的野外遇险求救方法
- 下一篇:一种无人机自动农药喷洒系统和方法