[发明专利]一种融合机载测高数据及地形数据的导航定位修正方法

说明书

本发明公开了一种融合机载测高数据及地形数据的导航定位修正方法。在飞机飞行运动过程中，首先基于惯性导航设备获取的位置状态数据及地形数据，构建基于并行卡尔曼滤波算法构建机载定位系统的联合导航定位模型，然后采用递推方法对惯性导航系统的定位结果进行修正，提高导航设备的精度，从而解决在复杂地形环境以及GPS信号信号受到遮挡或屏蔽条件下的机载导航定位修正技术，实现飞机位置的精确定位，从而提高机载导航系统的性能和可靠性,提高战机低空突防能力。

技术领域

本发明涉及一种融合机载测高数据及地形数据的导航定位修正方法。

技术背景

机载导航定位技术是机载系统的重要组成部分，可以为机载系统提供实时准确的当前位置和姿态数据，有助于飞行员了解目前所处战地环境，提高作战效能。但是，由于受外界环境影响及导航设备本身性能的约束，单一的导航设备难以满足机载系统的定位需求。惯性导航系统隐蔽性好，但是具有漂移累积位置误差的缺点，全球导航定位技术可以获取高精度的定位结果,但是,在山地丘陵地带，接收机因可见卫星少且卫星信号受到遮挡或屏蔽，导航精度将明显降低.因此,亟需开展复杂地形环境下的机载导航定位修正技术，适应复杂多变的地形环境,提高机载系统的定位精度和可靠性。

地形辅助导航技术是一种广泛应用的地形导航定位技术，其主要采用数字地图提供参考信息辅助校正机载惯性导航系统，从而达到提高导航精度，増强系统可靠性目标的一种精确导航的技术，由于其具有自主、隐蔽、全天候、导航定位精度与航程无关的特点，因此在导航定位领域得到了广泛的应。本文基于导航定位的基本原理，提出了一种融合机载惯性测高数据及地形数据的导航定位修正技术。首先基于惯性导航设备获取的位置状态数据及地形数据，构建基于并行卡尔曼滤波算法构建机载定位系统的联合导航定位模型，然后采用递推方法对惯性导航系统的定位结果进行修正，提高导航设备的精度，从而解决在复杂地形环境以及GPS信号信号受到遮挡或屏蔽条件下的机载导航定位修正技术，实现飞机位置的精确定位，从而提高机载导航系统的性能和可靠性,提高战机低空突防能力。

发明内容

本发明公开了一种融合机载测高数据及地形数据的导航定位修正方法。在飞机飞行运动过程中，首先基于惯性导航设备获取的位置状态数据及地形数据，构建基于并行卡尔曼滤波算法构建机载定位系统的联合导航定位模型，然后采用递推方法对惯性导航系统的定位结果进行修正，提高导航设备的精度，从而解决在复杂地形环境以及GPS信号信号受到遮挡或屏蔽条件下的机载导航定位修正技术，实现飞机位置的精确定位，从而提高机载导航系统的性能和可靠性,提高战机低空突防能力。

本发明提供了一种融合机载测高数据及地形数据的导航定位修正方法，其特征在于，包括以下步骤：

步骤A：基于飞机运动学定理以及机载惯性导航设备的位置偏差、速度偏差，以及加速度偏差，建立飞行器运动的状态方程。

步骤B：基于机载惯性导航设备获取的的当前位置及高度数据，数字地形DEM存储的高度及雷达高度计获取的高度，建立机载导航定位的量测方程。

步骤C：基于机载观测导航设备获取的当前位置及地形数据，对地形数据进行线性化处理，获取机载导航定位的量测方程的系数，构建机载定位系统的联合导航定位的数据模型。

步骤D：根据机载惯性导航定位结果的可靠性，建立惯性导航行为结果的协方差矩阵，构建联合导航定位模型的统计模型。

步骤E：基于联合导航定位模型的数据模型和统计模型，采用机载导航系统的连续观测数据，采用卡尔曼滤波算法对其进行解算，获取机载惯性导航设备的导航定位的修正量。

步骤F：利用机载惯性导航设备的系统误差的最佳估计对机载惯性导航定位结果进行位置修正及补偿，提高导航定位结果的精度。

所述步骤A中的飞行器运动的状态方程的建立可以根据飞行器的运行定理，根据相邻时刻的机载惯性导航设备的位置偏差、速度偏差，以及加速度偏差建立，具体如下：