[发明专利]一种针对海面低空侧风切变的无人机抗扰方法和抗扰系统有效
申请号: | 202310133132.0 | 申请日: | 2023-02-20 |
公开(公告)号: | CN115826624B | 公开(公告)日: | 2023-04-28 |
发明(设计)人: | 李道春;王永志;王天杰;邵浩原;姚卓尔;阚梓;向锦武 | 申请(专利权)人: | 北京航空航天大学;彩虹无人机科技有限公司 |
主分类号: | G05D1/10 | 分类号: | G05D1/10 |
代理公司: | 北京天汇航智知识产权代理事务所(普通合伙) 11987 | 代理人: | 高永 |
地址: | 100191*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 针对 海面 低空 切变 无人机 方法 系统 | ||
1.一种针对海面低空侧风切变的无人机抗扰方法,其特征在于,包括以下步骤:
第一步,建立无人机的力矩方程组;
第二步,根据风扰特征将所述力矩方程组转化为海面低空侧风切变的无人机抗扰方程组;
第三步,将所述无人机抗扰方程组在巡航状态下已配平的物理量消去,获取简化后的变化量方程组;
第四步,依据所述变化量方程组求解获取无人机姿态控制响应和,其中表示副翼偏转角,表示方向舵偏转角;
第五步,持续将侧风切变导致的新的侧滑角反馈回控制系统,重复求解所述变化量方程组,以调整、的大小,从而使无人机回摆至稳定巡航状态;
第一步,建立无人机的力矩方程组如下所示:
其中,
表示无人机机体沿X轴的滚转力矩系数,表示无人机机体沿Y轴的俯仰力矩系数,表示无人机机体沿Z轴的偏航力矩系数;
表示滚转力矩系数关于副翼偏转角的变化率,表示滚转力矩系数关于方向舵偏转角的变化率,表示滚转力矩系数关于滚转角速度的变化率,表示滚转力矩系数关于偏航角速度的变化率;表示俯仰力矩系数关于升降舵偏转角的变化率,表示俯仰力矩系数关于俯仰角速度的变化率;表示偏航力矩系数关于副翼偏转角的变化率,表示偏航力矩系数关于方向舵偏转角的变化率,表示偏航力矩系数关于滚转角速度的变化率,表示偏航力矩系数关于偏航角速度的变化率;
第二步,根据风扰特征将所述力矩方程组转化为海面低空侧风切变的无人机抗扰方程组具体为:
假设稳定状态为无人机平飞巡航状态,无侧滑即侧滑角
式中,Δ
第三步,将所述无人机抗扰方程组在巡航状态下已配平的物理量消去,获取简化后的变化量方程组具体为:
已配平的物理量方程为:
消去稳态量的变化量方程组变为:
;
第四步,依据所述变化量方程组求解获取无人机姿态控制响应和具体为:
。
2.一种针对海面低空侧风切变的无人机抗扰系统,其特征在于,包括:
控制系统、初始力矩方程组构建模块、无人机抗扰方程组构建模块、无人机抗扰方程组简化模块、侧滑角反馈模块、姿态控制响应求解模块;所述控制系统分别连接初始力矩方程组构建模块、无人机抗扰方程组构建模块、无人机抗扰方程组简化模块、侧滑角反馈模块和姿态控制响应求解模块;使得无人机处于自动化抗扰状态;其中,
初始力矩方程组构建模块:建立无人机的力矩方程组;
无人机抗扰方程组构建模块:根据风扰特征将所述力矩方程组转化为海面低空侧风切变的无人机抗扰方程组;
无人机抗扰方程组简化模块:将所述无人机抗扰方程组在巡航状态下已配平的物理量消去,获取简化后的变化量方程组;
姿态控制响应求解模块:依据所述变化量方程组求解获取无人机姿态控制响应和,其中表示副翼偏转角,表示方向舵偏转角;
侧滑角反馈模块:持续将侧风切变导致的新的侧滑角反馈回控制系统;
控制系统:接收到侧滑角反馈模块反馈的新的侧滑角后,重复控制姿态控制响应求解模块求解所述变化量方程组,以调整、的大小,从而使无人机回摆至稳定巡航状态;
建立无人机的力矩方程组如下所示:
其中,
表示无人机机体沿X轴的滚转力矩系数,表示无人机机体沿Y轴的俯仰力矩系数,表示无人机机体沿Z轴的偏航力矩系数;
表示滚转力矩系数关于副翼偏转角的变化率,表示滚转力矩系数关于方向舵偏转角的变化率,表示滚转力矩系数关于滚转角速度的变化率,表示滚转力矩系数关于偏航角速度的变化率;表示俯仰力矩系数关于升降舵偏转角的变化率,表示俯仰力矩系数关于俯仰角速度的变化率;表示偏航力矩系数关于副翼偏转角的变化率,表示偏航力矩系数关于方向舵偏转角的变化率,表示偏航力矩系数关于滚转角速度的变化率,表示偏航力矩系数关于偏航角速度的变化率;
根据风扰特征将所述力矩方程组转化为海面低空侧风切变的无人机抗扰方程组具体为:
假设稳定状态为无人机平飞巡航状态,无侧滑即侧滑角
式中,Δ
将所述无人机抗扰方程组在巡航状态下已配平的物理量消去,获取简化后的变化量方程组具体为:
已配平的物理量方程为:
消去稳态量的变化量方程组变为:
;
依据所述变化量方程组求解获取无人机姿态控制响应和具体为:
。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京航空航天大学;彩虹无人机科技有限公司,未经北京航空航天大学;彩虹无人机科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202310133132.0/1.html,转载请声明来源钻瓜专利网。