一种固定翼无人机组合导航系统的自适应方法与流程

摘要: 本技术涉及无人机导航,更具体地,涉及一种固定翼无人机组合导航系统的自适应方法。背景技术:1、无人机长时间高精度导航与飞行控制极度依赖稳定可靠的航向、速度、风场状...
一种固定翼无人机组合导航系统的自适应方法与流程

本技术涉及无人机导航,更具体地,涉及一种固定翼无人机组合导航系统的自适应方法。

背景技术:

1、无人机长时间高精度导航与飞行控制极度依赖稳定可靠的航向、速度、风场状态估计。在固定翼无人机飞控系统中,为保证航向角具备可观测性,导航滤波普遍引入非完整性约束(nhc,即假设机体横向侧滑速度为0)辅助状态更新;常规组合导航滤波器融合imu、gnss、空速计观测信息,传统容错校验逻辑完全依赖滤波器自身输出的后验状态完成导航结果的有效性判断。

2、现有的导航滤波方案存在三方面核心缺陷:其一,气动扰动场景下导航状态易发散。当无人机遭遇持续侧风、突风或大机动转弯时,“机体横向侧滑速度为零” 的物理假设不再成立。传统底层滤波器缺少精细化的气动干扰识别逻辑,强制启用nhc约束会造成偏航角、水平风场两类状态量交叉影响,一段时间后导航结果出现明显发散;其二,观测维度相互耦合,易引发风速估计滞后、滤波增益不合适。现有算法在复杂多变风场环境下,空速计与nhc两类观测通道相互干扰,出现水平风速估计滞后、滤波增益抢占观测通道等问题,航向估计精度显著下降;其三,容错校验存在循环论证逻辑缺陷,扰动下校验失效。传统容错判断完全依赖滤波内部漂移的后验状态作为评判基准;当外部扰动导致滤波状态发生偏移时,校验基准本身存在误差,无法实现有效阻断,难以提前抑制导航的发散趋势。

技术实现思路

1、有鉴于此,本技术的目的在于提供一种固定翼无人机组合导航系统的自适应方法,具有能够实时监测无人机运动工况和非完整性约束健康度,动态调整组合导航滤波器的参数,有效抑制在大机动飞行或强风环境下的导航状态发散,提高系统的鲁棒性和精度。

2、本技术提供了一种固定翼无人机组合导航系统的自适应方法,包括:

3、构建组合导航滤波器的导航状态向量;

4、基于空速计测得的总空速构建空速标量观测方程;

5、基于机体系横向相对空速分量为零的非完整性约束,构建非完整性约束虚拟观测方程;

6、通过应用层旁路状态监测器获取惯性测量单元的原始测量数据,并根据所述原始测量数据计算无人机的机动强度指数,以根据所述机动强度指数判定无人机的运动工况;

7、获取底层组合导航滤波器输出的非完整性约束新息及对应的新息协方差,并基于滑动窗口对所述非完整性约束新息进行时序自相关检验,以判定非完整性约束对应的新息序列是否呈现有色噪声特性;

8、根据所述运动工况以及所述新息序列的自相关检验结果,对所述底层组合导航滤波器中的非完整性约束量测噪声、风场状态过程噪声和/或先验协方差矩阵进行自适应调控。

9、优选地,导航状态向量至少包括姿态状态、导航系对地速度状态、导航系位置状态、惯性传感器零偏状态以及导航系水平风场状态;

10、所述导航状态向量为多维状态向量:

11、

12、其中,

13、为4维姿态四元数,用于表示无人机的姿态;

14、为3维ned导航坐标系的对地速度;

15、为3维ned导航坐标系的三维位置;

16、为3轴陀螺仪零偏;

17、为3轴加速度计零偏;

18、为2维导航系水平风场向量。

19、优选地,基于空速计测得的总空速构建空速标量观测方程,使所述空速标量观测方程用于约束无人机相对空速的能量关系;所述空速计观测方程为:

20、

21、其中,、、 分别为导航坐标系下的北向速度、东向速度和地向速度,、 分别为导航坐标系下的北向风速和东向风速。

22、优选地根据所述非完整性约束虚拟观测方程解析构建对应的非完整性约束量测矩阵,所述非完整性约束虚拟观测方程按照如下方式构建:

23、确定导航系下机体相对空速分量为:

24、

25、

26、

27、基于导航系至机体系的方向余弦矩阵,构建机体系横向相对空速分量:

28、

29、并将 作为所述非完整性约束虚拟观测方程。

30、优选地,非完整性约束量测矩阵为1×18维稀疏量测矩阵,表示为:

31、

32、其中, 为姿态四元数偏导块, 为对地速度偏导块, 为水平风场偏导块,位置状态、陀螺仪零偏状态和加速度计零偏状态对应的偏导为零矩阵。

33、优选地,所述根据所述原始测量数据计算无人机的机动强度指数包括:

34、所述应用层旁路状态监测器独立读取惯性测量单元输出的原始比力和角速度数据;

35、根据所述原始比力和角速度数据解算导航坐标系下的水平物理加速度、与偏航角速度,计算无人机机动强度指数:

36、

37、其中,、为依据无人机气动刚度预先标定的匹配系数。

38、优选地,采用双阈值迟滞防抖状态机进行运动工况判定;

39、当连续多个判定周期内所述机动强度指数 大于第一阈值 时,判定无人机进入大机动转弯工况;

40、当连续多个判定周期内所述机动强度指数 小于第二阈值 时,判定无人机回归直线巡航工况;

41、其中,所述第一阈值 大于所述第二阈值 。

42、优选地,所述根据所述运动工况以及所述新息序列的自相关检验结果,对所述底层组合导航滤波器进行自适应调控包括:

43、当判定无人机处于大机动转弯工况,或者判定所述非完整性约束新息序列呈现有色噪声特性时,增大所述非完整性约束量测噪声,以降低非完整性约束在组合导航滤波更新中的置信权重。

44、优选地,所述非完整性约束量测噪声按照如下公式进行指数加权膨胀:

45、

46、其中,, 为当前时刻的非完整性约束量测噪声, 为直线巡航工况下的基准非完整性约束量测噪声, 为噪声膨胀增益, 为一阶延迟自相关系数, 为独立性门限。

47、优选地,根据所述运动工况以及所述新息序列的自相关检验结果,对所述底层组合导航滤波器进行自适应调控还包括:

48、当判定无人机回归直线巡航工况且所述非完整性约束新息序列回归白噪声状态时,平滑收缩所述非完整性约束量测噪声,使其逐步恢复至基准非完整性约束量测噪声。

49、本技术有效规避了容错校验的循环论证缺陷,增设了独立的应用层旁路监测模块,采用原始imu物理测量量、滤波新息统计特征两类独立评判依据,不依赖滤波内部失真后验状态完成模型评估,实现气动约束健康度客观判定;

50、本技术实现观测空间正交解耦,抑制长时航向发散,将空速计总能量标量约束、nhc 方向几何约束分开建模解耦;当nhc约束因大机动失效时,空速标量观测可持续约束风场状态,显著降低长时间推算下航向漂移、发散概率。

51、本技术缓解了工况切换的滤波震荡现象,提出基于量测矩阵外积的协方差定向微量注入策略,仅针对性软化侧滑约束对应状态子空间,使巡航/机动工况切换过程中卡尔曼增益平滑过渡,飞行器姿态控制输出无抖动。

52、本技术中全工况自适应鲁棒性强,同时适配直线巡航、持续侧风、剧烈转弯全部典型飞行工况,无需人工分段调参,算法可在常规无人机嵌入式机载设备实时运行,可适配固定翼无人机平台。