1.一种导航系统初始化方法,其特征在于:包括如下过程:计算推算导航起始位置的置信区间;
对起始位置的置信区间进行网格化处理获得规划起点的似然函数;
根据推算导航的误差得到起始点的似然函数的前向运动至下一位置的似然函数网格;
根据当前位置的网格节点的似然函数值对后向位置的网格节点似然函数值进行平滑处理,得到初始位置的平滑网格;
根据初始位置的平滑网格计算其正态分布网格;
计算初始位置的正态分布网格和平滑网格之间的残差,若其小于预设检验阈值则进行下一步,否则转向根据推算导航的误差得到起始点的似然函数的前向运动至下一位置的似然函数网格的步骤;
根据初始位置的平滑网格进行粒子滤波初始化处理。
2.根据权利要求1所述的一种导航系统初始化方法,其特征在于:对于平面坐标系x0y内的规划起点,其推算导航位置的表达式为:所述规划起点的定位误差的表达式为:
所述置信区间的表达式为:
式中:γ表示置信区间的方放大系数;α表示推算导航的误差椭圆长轴与x轴的夹角;
为规划
起点对应的粒子序列(xi,yi),i=1,2,3...n中x轴坐标的均值, 为规划起点对应的粒子序列(xi,yi),i=1,2,3...n中y轴坐标的均值;K的表达式为:
3.根据权利要求2所述的一种导航系统初始化方法,其特征在于:所述对起始位置的置信区间进行网格化处理获得规划起点的似然函数的具体过程为:将置信区间进行网格化处理得到网格节点作为定位点的概率值,其表达式为:其中lm×ln为网格数量;
计算每个网格节点的似然值,其表达式为:其中 表示置信区间内索引号为
(i,j)的搜索点;Z表示测量地形的高程序列; 表示测量地形的高程序列Z在搜索点(i,j)的地形插值序列;C表示似然函数的归一化参数;
计算规划起点的似然函数,其表达式为:
4.根据权利要求3所述的一种导航系统初始化方法,其特征在于:所述根据推算导航的误差得到起始点似然函数的前向运动至下一位置的似然函数网格的过程为:计算从第一个规划起点X1点运动到第二个规划起点X2点后网格节点的似然值 以及X2位置对应的网格节点的地形匹配定位似然函数 其表达式为:K,L表示网格
的行数和列数;△X12表示定位点X1与推算导航位置X2点之间的距离;P12表示从X1到X2点的推算导航误差,C表示归一化参数;
计算经过观测修正后的地形匹配导航似然函数网格节点的似然值 其表达式为:重复上述过程得到XN位置的地形匹配定位似然函数LN或者地形匹配导航误差TN。
5.根据权利要求4所述的一种导航系统初始化方法,其特征在于:所述根据当前位置的网格节点的似然函数值对后向位置的网格节点似然函数值进行平滑处理,得到初始位置的平滑网格的具体过程为:利用SN平滑地形匹配导航点XN-1位置的地形匹配导航定位似然函数网格TN-1,其表达式为:式中: 表示地形匹配
导航点位置XN-1位置的地形匹配定位似然函数网格中索引点(i,j)的似然值;它可以替换为该变量表示地形匹配导航点位置XN-1位置的地形匹配导航似然函数网格中索引点(i,j)的似然值;△XN-1,N表示从XN-1点到XN点的推算导航距离;
重复上述过程依次得到XN-2,XN-3,……,X1位置的平滑结果SN-2,SN-3,……,S1。
6.根据权利要求5所述的一种导航系统初始化方法,其特征在于:所述根据初始位置的平滑网格计算其正态分布网格的具体过程为:对初始位置的S1计算定位点 其表达式为:表示S1网格中索引号为(i,j)网格点的坐标;
进行高斯拟合优度检验,设置检验阈值ε,计算S1的网格节点构成的样本的方差 其表达式为:计算服从方差为 均值为 的正态分布的网格的取值Gij,其表达式为:
7.根据权利要求6所述的一种导航系统初始化方法,其特征在于:所述残差的表达式为:
8.根据权利要求7所述的一种导航系统初始化方法,其特征在于:所述根据初始位置的平滑网格进行粒子滤波初始化处理的具体过程为:对网格进行加密处理,获得加密后的似然函数;
将加密后的似然函数转化为灰度图;
对灰度图进行四叉树分解;
对分解后的网格中心布置粒子,并将该中心的似然值赋值为粒子的初始权重。
9.根据权利要求8所述的一种导航系统初始化方法,其特征在于:所述对灰度图进行四叉树分解的具体过程为:判断某一子块的面积和其中心对应的似然值的乘机是否大于四叉树分解的阈值,若是则继续分解该子块直至所有子块均满足其面积和其中心对应的似然值的乘机大于四叉树分解的阈值。