面向动态降落平台的飞行器自主回收方法和飞行器与流程

摘要: 本发明涉及飞行器回收,尤其涉及一种面向动态降落平台的飞行器自主回收方法和飞行器。背景技术:1、随着无人机在物流配送、海洋监测、应急救援等领域的广泛应用,无人机在...
面向动态降落平台的飞行器自主回收方法和飞行器与流程

本发明涉及飞行器回收,尤其涉及一种面向动态降落平台的飞行器自主回收方法和飞行器。

背景技术:

1、随着无人机在物流配送、海洋监测、应急救援等领域的广泛应用,无人机在动态降落平台(如行驶车辆、舰船甲板等)上的自主起飞与回收需求日益迫切。相比于静态平台降落,动态降落平台具有时变的六自由度运动状态(包括平移速度、加速度以及横摇、纵摇、垂荡等姿态变化),这对无人机的相对导航精度与动态回收控制策略提出了更高要求。

2、现有技术中,针对无人机在动态降落平台上的自主降落,主要存在视觉引导着陆、舰载甲板运动补偿以及超宽带(ultra wide band,uwb)/相对定位增强等技术路线。视觉引导方案多依赖机载相机跟踪合作靶标,通过估计相对坐标与速度来调整轨迹;舰载着舰方案则侧重于将甲板运动模型引入引导回路,通过预估与补偿改善着舰轨迹;uwb等相对定位方案旨在利用射频测距提升近距相对位置解算精度。

3、上述技术路线普遍存在以下缺陷:

4、缺乏触地时刻的预测制导:现有方案多侧重于跟踪靶标的当前位置或当前相对速度,未显式估计平台的线加速度及姿态角速度,且缺少面向触地时刻的显式落点预测。当平台处于加减速、转向等非匀速运动时,控制滞后或过冲现象明显,相对误差随平台机动迅速放大。

5、多源观测融合与运动补偿能力弱:rtk相对定位、uwb测距、视觉位姿等信息往往独立使用,未在统一的动态坐标系下进行运动补偿融合。在传感器切换或平台姿态剧烈变化时,易引入相对轨迹跳变,影响控制的连续性与稳定性。

6、平台运动约束建模不完整:现有方案未系统地将舰载平台的垂荡/横摇/纵摇,或车载平台的路径曲率纳入相对高度与姿态对准约束,触地窗口判定逻辑单一,难以应对复杂海况或路况下的精准对准需求。

7、安全决策与失效应对策略缺失:现有方案多缺乏面向动态回收的阶段化状态机设计,未构建可复现的安全包线与强制复飞联锁机制。在观测丢失、相对误差超限或平台突发机动等危险工况下,无人机往往缺乏有效的复飞、重对准或中止终降策略,仍存在继续下降的风险,安全冗余不足。

8、综上所述,上述技术路线难以实现无人机在动态降落平台上高精度、高鲁棒性自主回收。

技术实现思路

1、本发明实施例提供了一种面向动态降落平台的飞行器自主回收方法和飞行器,可以实现无人机等飞行器在动态降落平台上高精度、高鲁棒性自主回收。

2、第一方面,提供了一种面向动态降落平台的飞行器自主回收方法,包括:

3、获取飞行器在导航坐标系下的第一运动状态信息,以及动态降落平台相对于所述飞行器的多源相对观测信息,并根据所述第一运动状态信息和所述多源相对观测信息估计所述动态降落平台的第二运动状态信息,所述第二运动状态信息至少包括所述动态降落平台的位置与速度;

4、构建原点为降落参考点且坐标轴固连于所述动态降落平台的动态桩坐标系,其中,所述降落参考点为所述飞行器在所述动态降落平台上的预定触地区参考点;

5、在所述第二运动状态信息的支持下,对所述多源相对观测信息进行时延对齐与运动补偿并融合,得到融合相对观测信息;基于融合相对观测信息、所述第一运动状态信息和所述第二运动状态信息,确定所述飞行器在所述动态桩坐标系下的第三运动状态信息,所述第三运动状态信息至少包括相对位置与相对速度;

6、根据所述第二运动状态信息预测触地时刻所述降落参考点的预测触地点,并基于所述预测触地点和所述第三运动状态信息生成相对制导指令,所述相对制导指令使得按追及进近、相对对准、同步伴随、预测终降的阶段推进自主回收;

7、执行所述相对制导指令。

8、在一种可能的实现方式中,在回收过程中检验安全包线;当所述飞行器和所述动态降落平台之间的相对误差、所述动态降落平台的机动或观测完好性不满足所述安全包线时,禁止继续降低相对高度,并执行复飞或中止终降。

9、在一种可能的实现方式中,所述第二运动状态信息还包括所述动态降落平台的加速度、角速度、姿态、及不确定度中的任意一项或多项。

10、在一种可能的实现方式中,所述根据所述第二运动状态信息预测触地时刻所述降落参考点的预测触地点,包括:

11、根据相对高度与期望下降率确定预计触地时间;

12、根据所述动态降落平台的位置、速度以及可选的加速度,对所述预计触地时间对应的降落参考点位置进行外推,得到所述预测触地点;当加速度不可用或不确定度过大时,退化为基于位置与速度的匀速外推。

13、在一种可能的实现方式中,所述安全包线的判据包括:所述飞行器和所述动态降落平台之间的相对误差,所述动态降落平台的机动,所述动态降落平台的观测完好性;其中,当任一判据被破坏且持续时间超过设定阈值时,执行所述禁止继续降低相对高度,并执行复飞或中止终降,以及回到同步伴随高度后重新对准再进。

14、在一种可能的实现方式中,所述相对误差包括:水平位置误差和/或水平速度误差。

15、在一种可能的实现方式中,所述动态降落平台的机动包括:所述动态降落平台的加速度绝对值和/或角速度绝对值。

16、在一种可能的实现方式中,所述动态降落平台的观测完好性包括:视觉丟锁率和/或超宽带中断率。

17、在一种可能的实现方式中,所述多源相对观测信息包括实时动态差分rtk相对观测、uwb测距、视觉观测和高度计观测中的任意一项或多项。

18、第二方面,提供了一种飞行器,包括存储器和处理器,所述存储器中存储有可执行代码,所述处理器执行所述可执行代码时,实现第一方面所述的方法。

19、本发明提供的方案以相对状态与平台运动估计为核心,适应动态降落平台的真实动态回收需求,并且,预测触地制导减小对机动平台的滞后与过冲,落点跟踪目标与触地时刻一致。本发明提供的方案通过多源相对融合含运动补偿与时延对齐,降低动态场景下的误切换与轨迹跳变,以及,通过阶段化状态机和安全包线强制复飞联锁,提升可工程化安全性与可复现失效策略。

1.一种面向动态降落平台的飞行器自主回收方法,其特征在于,包括:

2.根据权利要求1所述的方法,其特征在于,所述方法还包括:

3.根据权利要求1所述的方法,其特征在于,所述第二运动状态信息还包括所述动态降落平台的加速度、角速度、姿态、及不确定度中的任意一项或多项。

4.根据权利要求1所述的方法,其特征在于,所述根据所述第二运动状态信息预测触地时刻所述降落参考点的预测触地点,包括:

5.根据权利要求2所述的方法,所述安全包线的判据包括:所述飞行器和所述动态降落平台之间的相对误差,所述动态降落平台的机动,所述动态降落平台的观测完好性;

6.根据权利要求5所述的方法,其特征在于,所述相对误差包括:水平位置误差和/或水平速度误差。

7.根据权利要求5所述的方法,其特征在于,所述动态降落平台的机动包括:所述动态降落平台的加速度绝对值和/或角速度绝对值。

8.根据权利要求5所述的方法,其特征在于,所述动态降落平台的观测完好性包括:视觉丟锁率和/或超宽带中断率。

9.根据权利要求1所述的方法,其特征在于,所述多源相对观测信息包括实时动态差分rtk相对观测、uwb测距、视觉观测和高度计观测中的任意一项或多项。

10.一种飞行器,其特征在于,包括存储器和处理器,所述存储器中存储有可执行代码,所述处理器执行所述可执行代码时,实现权利要求1-9中任一项所述的方法。