1.一种基于假设约束的组合导航数据融合方法,其特征在于,所述方法包括:步骤1、基于假设约束构建用于量测噪声协方差估计的代价函数;
步骤2、根据构建的代价函数,估计出量测噪声的协方差;
步骤3、根据估计出的量测噪声的协方差,实时更新滤波参数,完成对组合导航数据的融合;
所述步骤1包括:步骤11、给定一个组合导航系统的非线性系统模型为:其中,
采用容积卡尔曼滤波器初始化后验容积点误差阵其中,
步骤12、根据步骤11给定的组合导航系统的非线性系统模型和传播容积点其中,
通过状态量的先验状态估计值其中,
步骤13、通过
基于假设约束构建用于量测噪声协方差估计的代价函数,其表示为:其中,
2.根据权利要求1所述的方法,其特征在于,所述步骤2包括:根据卡罗需-库恩-塔克条件,通过代价函数获得下式:其中,
若
其中,
结合
当
将量测噪声协方差的估计值
3.根据权利要求1所述的方法,其特征在于,所述步骤3包括:步骤31、获取预测容积点误差阵对
其中,
步骤32、计算卡尔曼增益其中,
获得当前时刻的导航数据融合对
计算用于下一次导航数据融合的后验容积点误差阵循环执行步骤31,以进行更新导航数据融合。