[发明专利]一种基于外部条件约束的多平台信息协同导航增强方法

权利要求书

1.一种基于外部条件约束的多平台信息协同导航增强方法，其特征在于，包括如下步骤：

步骤1、以海上舰船平台为地面监控部分，所述地面监控部分由主控站、监测站、注入站以及通信和辅助系统组成，无人机携带惯性导航单元、视觉导航单元、卫星导航单元、辅助导航单元，具体步骤如下：

步骤（1-1）海上舰船平台以恒定速度航行，通过监测站进行晴雨状况、对流层参数、海风状况、洋流状况的数据采样，获得海面环境数据；

步骤（1-2）无人机对环境参数进行补充监测，获得海面环境数据，将海面环境数据发送至主控站；

步骤（1-3）无人机将其惯性、视觉、卫星、气象导航单元的内部参数测量值发送至舰主控站；

步骤2、基于步骤（1-1）与步骤（1-2）构建的海面环境数据，构建外部条件约束综合参数模型；

步骤3、基于步骤（1-1）中的海上舰船平台的视觉导航单元、卫星导航单元、气象导航单元，步骤（1-3）中的无人机的惯性、视觉、卫星、气象导航单元，步骤2构建的外部条件约束综合参数模型，组合各导航单元形成组合导航系统，构建组合导航系统的外部约束校准模型；

步骤4、根据基于因子图的多平台信息协同导航增强方法，基于线性时变系统的可观测度分析，采用增量因子图架构，计算组合导航系统的各导航单元子滤波器的权重因子；基于组合导航系统中视觉、卫星、气象导航单元的权重因子，在线选择最佳因子进行融合，自动调节各导航单元的信息权重，从而实现基于外部条件约束的多平台信息协同导航增强方法；

步骤5、构建以惯导传感器为核心的组合导航模型，基于卡尔曼滤波，确定多平台信息协同导航增强系统的状态方程和量测方程；根据卡尔曼滤波算法的时间更新方程、状态更新方程，随着外界环境的变化，在线调整估计误差协方差矩阵以及卡尔曼滤波增益。

2.根据权利要求1所述的一种基于外部条件约束的多平台信息协同导航增强方法，其特征在于，所述步骤2的外部条件约束综合参数模型包括：基于晴、雾、降雨、降雪的不同气象环境，构建海上气象环境参数模型；基于对流层电离参数，构建基于水平梯度模型的对流层环境参数模型；基于海上舰船平台和无人机平台风力变换，构建海面无人机风场参数模型；基于海浪运动导致反射路径阴影衰落波动效应，构建洋流状况环境参数模型。

3.根据权利要求2所述的一种基于外部条件约束的多平台信息协同导航增强方法，其特征在于，所述步骤3的计算步骤如下：

引入海上气象环境、对流层环境、海面无人机风场、洋流状态环境参数模型对视觉、卫星、气象导航单元的影响，构建视觉、卫星、气象导航校正模型，并构建外部条件对视觉、卫星、气象导航单元的综合约束参数校准矩阵。

4.根据权利要求3所述的一种基于外部条件约束的多平台信息协同导航增强方法，其特征在于，所述步骤4的具体步骤为：

步骤（4.1） 基于线性时变系统的可观测度分析，计算各导航单元子滤波器状态变量可观测度；

步骤（4.2） 基于步骤（4.1）计算得出的每个导航单元子滤波器状态变量的可观测度，根据信息守恒原则并通过归一化处理，计算出每个子滤波器中的各状态变量的信息分配权重；

步骤（4.3）基于最大后验概率计算多平台信息协同导航增强变量的最优系统状态估计；

步骤（4.4）采用增量平滑的因子图融合算法，对于第一次检测，定义先验因子，构建可信度先验因子结点；

步骤（4.5）考虑可信度权值对接入的多源组合导航因子的影响，定义传感器与惯性导航单元组合时的因子结点；

步骤（4.6）利用两相邻时刻变量结点之间的约束，定义k及k+1时刻间的二元状态转移因子；

步骤（4.7）假设为高斯噪声模型，代价函数定义为平方马氏距离；基于步骤（4.4）中可信度先验因子结点，基于步骤（4.5）中传感器与惯性导航单元组合时的因子结点，基于步骤（4.6）中k及k+1时刻间的二元状态转移因子结点，计算多平台信息协同导航增强变量的最优估计；

通过高斯牛顿法求解非线性最小二乘问题，经过QR分解使用增量平滑，将最优解更新迭代直到收敛。