[发明专利]一种飞行姿态的控制方法、装置、无人机和存储介质有效
申请号: | 201911001092.4 | 申请日: | 2019-10-21 |
公开(公告)号: | CN110673619B | 公开(公告)日: | 2022-06-17 |
发明(设计)人: | 张添保 | 申请(专利权)人: | 深圳市道通智能航空技术股份有限公司 |
主分类号: | G05D1/08 | 分类号: | G05D1/08;G05D1/10 |
代理公司: | 北京品源专利代理有限公司 11332 | 代理人: | 孟金喆 |
地址: | 518055 广东省深圳市南山*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 飞行 姿态 控制 方法 装置 无人机 存储 介质 | ||
1.一种飞行姿态的控制方法,其特征在于,包括:
根据无人机的当前飞行姿态参数、姿态调节参数和遥控设备为所述无人机设定的遥控姿态参数,确定所述无人机的转换控制参数;
所述根据无人机的当前飞行姿态参数、姿态调节参数和遥控设备为所述无人机设定的遥控姿态参数,确定所述无人机的转换控制参数,包括:
根据所述无人机的当前飞行姿态角、姿态角调节参数和遥控姿态角,确定所述无人机的目标姿态角速率;
根据所述无人机的当前飞行姿态角速率、姿态角速率调节参数和目标姿态角速率,确定所述无人机的转换控制参数;
所述确定所述无人机的转换控制参数的方式,包括:
根据姿态动力模型得到X2c=A-1K1(X1c-X1),u=B-1K2(X2c-X2),以及或ΔK2(k)=γ2(EdWnd-E(k)Wn(k)),其为对应的离散化形式,其中,X1为无人机的飞行姿态角;Ed为无人机的期望阻尼矩阵;Wnd为无人机的带宽矩阵;E为无人机的阻尼信息;Wn为无人机的带宽信息;表示无人机姿态角变化率;X2表示无人机飞行姿态角速率;表示无人机姿态角加速度;u为无人机的转换控制参数;A和B分别为标称的模型参数;K1和K2分别为姿态调节参数中的姿态角调节参数和姿态角速率调节参数,X2c为目标姿态角速率,X1c为遥控设备为无人机设定的遥控姿态角,u为无人机的转换控制参数,γ1和γ2为由开发者自由设定的常数,所述姿态调节参数中的K1和K2的初始值为:K20=2EdWnd;或所述姿态调节参数中的K1和K2的初始值为:K2(0)=2EdWnd,其为对应的离散化形式;
根据所述无人机的转换控制参数和当前飞行分配参数,对所述无人机的飞行姿态进行补偿,得到所述无人机的目标飞行姿态参数;
根据所述目标飞行姿态参数控制所述无人机飞行。
2.根据权利要求1所述的方法,其特征在于,所述根据所述无人机的转换控制参数和当前飞行分配参数,对所述无人机的飞行姿态进行补偿,得到所述无人机的目标飞行姿态参数,包括:
根据所述无人机的转换控制参数和当前飞行分配参数,确定所述无人机的电机输入信号;
根据所述电机输入信号对所述无人机中的电机进行控制补偿,生成对应的脉冲宽度调制信号;
根据所述脉冲宽度调制信号确定所述无人机在下一时刻的目标飞行姿态参数。
3.根据权利要求2所述的方法,其特征在于,还包括:
根据所述无人机的当前飞行姿态参数和上一时刻的电机输入信号,确定所述当前飞行分配参数。
4.根据权利要求1所述的方法,其特征在于,还包括:
根据所述无人机的当前飞行姿态参数和遥控姿态参数,确定所述无人机的闭环响应特性参数;
根据所述闭环响应特性参数,确定对应的姿态调节参数。
5.根据权利要求4所述的方法,其特征在于,所述闭环响应特性参数包括所述无人机在闭环系统下的阻尼信息和带宽信息。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市道通智能航空技术股份有限公司,未经深圳市道通智能航空技术股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201911001092.4/1.html,转载请声明来源钻瓜专利网。