申请/专利权人：吉林化工学院

申请日：2020-10-14

公开（公告）日：2024-04-12

公开（公告）号：CN112214036B

主分类号：G05D1/46

分类号：G05D1/46;G05D109/20

优先权：

专利状态码：有效-授权

法律状态：2024.04.12#授权;2021.01.29#实质审查的生效;2021.01.12#公开

摘要：本发明提供一种主从机编队飞行控制方法，其特征在于：实用型主从机编队飞行控制方法引入从机跟随坐标系，本发明引入从机跟随坐标系，通过在从机跟随坐标系中计算从机位置跟踪误差，解决了控制信号相对主机航向变化较为敏感的问题，确保主从机精确编队飞行控制。

主权项：1.一种实用型主从机编队飞行控制方法，其特征在于：实用型主从机编队飞行控制方法引入从机跟随坐标系，包括以下步骤：S1、每个从机将各自起飞前的经纬度坐标作为坐标原点，建立各自的地面坐标系；S2、在飞行过程中，主机通过数传以广播的形式发送主机的飞行速度、经纬度坐标、飞行高度信息，每个从机接收主机的经纬度坐标，并在各自的地面坐标系下通过坐标变换得到主机的位置坐标；S3、在编队飞行过程中，每个从机相对主机的期望位置已知，每个从机在各自地面坐标系下可根据主机的位置坐标计算得到从机在地面坐标系下的期望位置指令；S4、已知从机在各自地面坐标系下的位置坐标和位置指令，引入从机跟随坐标系oLxsys，每个从机都有各自的跟随坐标系，从机跟随坐标系的原点在各自从机上，其oLxs轴与当前时刻的期望位置和前一时刻的期望位置的连线平行；S5、在从机跟随坐标系下计算每个从机的跟踪航向角θs，基于跟踪航向角计算从机的横纵向位置误差；S6、纵向位置误差分量δx用来进行速度控制，当δx增大时，从机通过提高飞行速度来减小纵向方向的跟踪误差，速度控制指令Vc的计算公式为： 其中，VL和VW分别主机和从机的飞行速度；ex为位置和速度跟踪控制的综合误差；kx1、kx2、kVP、kVD为控制器参数；横向位置误差分量δy用来进行滚转控制，滚转角指令φc的计算公式为： 其中，g为重力加速度；D1为航迹跟随中的虚拟导引距离。

全文数据：

权利要求：

百度查询： 吉林化工学院 一种实用型主从机编队飞行控制方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD