地形匹配定位中有效伪波峰估计与多点融合初始定位方法技术

本发明专利技术公开了地形匹配定位中有效伪波峰估计与多点融合初始定位方法，包括以下步骤：步骤一：获得N个地形匹配定位点的似然函数；步骤二：计算每一个地形匹配定位点的置信区间；步骤三：查找地形匹配定位的有效峰值点以及有效峰值点的定位误差；步骤四：确定地形匹配融合定位的组合形式，计算每一个组合形式下的多点融合定位结果；步骤五：得到NU个地形匹配定位点融合定位结果；步骤六：计算每一个定位结果的代价函数，找到代价函数最小值对应的q就是最优的定位结果对应的索引序号，到此算法执行完毕，定位点确定。本发明专利技术的有益效果为：能够针对地形匹配定位结果连续的出现多伪波峰和误匹配的情况下提高地形匹配定位的精度。

Effective Pseudo-crest Estimation and Multi-point Fusion Initial Location Method in Terrain Matching Location

The invention discloses an effective pseudo-peak estimation and multi-point fusion initial location method in terrain matching positioning, which includes the following steps: step 1: obtaining the likelihood function of N terrain matching locating points; step 2: calculating the confidence interval of each terrain matching locating point; step 3: finding the effective peak point of terrain matching positioning and the positioning error of the effective peak point; step 4: Determine the combination form of terrain matching fusion positioning and calculate the multi-point fusion positioning results under each combination form; Step 5: Get the fusion positioning results of NU terrain matching positioning points; Step 6: Calculate the cost function of each positioning result, find the Q corresponding to the minimum value of the cost function is the index serial number corresponding to the optimal positioning result, and after the implementation of this algorithm, determine. Locus determination. The beneficial effect of the invention is that the accuracy of terrain matching positioning can be improved in the case of multiple pseudo-peaks and mismatches occurring continuously in the result of terrain matching positioning.

【技术实现步骤摘要】
地形匹配定位中有效伪波峰估计与多点融合初始定位方法
本专利技术涉及一种地形匹配定位方法，具体涉及地形匹配定位中有效伪波峰估计与多点融合初始定位方法。
技术介绍
地形匹配定位的初始阶段往往存在很大的初始定位误差，导致初始阶段的地形匹配定位需要很大的初始搜索区间，从而很容易导致初始阶段的地形匹配定位结果出现误匹配和多伪波峰现象，地形匹配定位的结果十分的不稳定，并且存在很强的跳变性。如何在地形匹配定位结果存在较多的伪波峰和误匹配现象时能够获得较稳定的定位结果是地形匹配导航领域的难点。
技术实现思路
针对现有技术上存在的不足，本专利技术的目的在于提出一种地形匹配定位的高精度与高稳定性定位方法，主要用于地形匹配定位结果连续的出现多伪波峰和误匹配的情况下提高地形匹配定位的精度。为了实现上述目的，本专利技术是通过如下的技术方案来实现：地形匹配定位中有效伪波峰估计与多点融合初始定位方法，包括以下步骤：步骤一：获得N个地形匹配定位点的似然函数，并得到的每一个地形匹配定位点的参考导航定位点和参考导航的定位误差；步骤二：根据步骤一得到的N个地形匹配定位点的似然函数计算其极大似然值的置信度下确界平面，并以此平面截取似然函数曲面获得得等值线即为置信区间边界；由此可得，每一个地形匹配定位点的置信区间，且在搜索区间内的搜索点被置信区间分割为两部分，其中搜索区间是由参考导航系统的误差得到，位于地形匹配定位置信区间内部的搜索点为有效的地形匹配定位点，即地形匹配定位有效定位点；步骤三：根据步骤二得到的地形匹配定位置信区间和地形匹配定位有效定位点计算地形匹配定位的有效峰值点以及有效峰值点的定位误差；步骤四：根据步骤三得到的地形匹配定位点的有效峰值点、有效峰值点的似然函数值以及有效峰值点的定位误差来确定地形匹配融合定位的组合形式，计算每一个组合形式下的多点融合定位结果；步骤五：根据步骤一得到的每一个地形匹配定位点的参考导航定位点和参考导航的定位误差，步骤三得到的有效峰值点以及有效峰值点的定位误差，再利用步骤四得到的索引矩阵进行每一个有效峰值点组合的定位结果解算，一共能够得到NU个地形匹配定位点融合定位结果；步骤六：根据步骤五中的地形匹配定位多点融合定位结果计算其中每一个定位结果的代价函数Jq,q＝1,2,3...NU，q表示由所有的地形匹配定位点的有效峰值点所组成的多地形匹配定位点融合组合的索引号，设第q个组合得到的定位修正量为中mtp表示该定位偏差是由多地形匹配定位算法获取的；找到Jq最小值对应的q就是最优的定位结果对应的索引序号，此时索引号为q的定位修正量即为最优的定位修正量，到此算法执行完毕，多地形匹配定位点融合定位确定。上述的地形匹配定位中有效伪波峰估计与多点融合初始定位方法，所述步骤一中似然函数的具体获得方法如下：假设在一个航迹段内规划了N个地形匹配定位点，并且已经获得了N个地形匹配定位结果，每一个地形匹配定位点对应一个参考导航定位点，同时得到每一个地形匹配定位点的似然函数，再同时记录下每一个地形匹配定位点对应的参考导航定位点Dk和参考导航的定位误差Rk，k表示规划的地形匹配定位点索引号。上述的地形匹配定位中有效伪波峰估计与多点融合初始定位方法，所述步骤三中有效峰值点的计算方法如式(1)中所示，Si,j表示任意一个搜索点，C表示地形匹配定位的置信区间，式(1)中Li,j表示索引号为(i,j)的地形匹配定位有效定位点；式(1)表示有效定位点的似然函数值比他周围的其他点的似然值高，则表示该点为有效峰值点；找到有效峰值点之后，计算有效峰值点的地形匹配定位误差，假设第k个地形匹配定位点的索引号为有效峰值点，其地形匹配定位误差是按照这种方法能够计算所述步骤一得到的所有N个地形匹配定位点的有效峰值点、有效峰值点的似然函数值以及有效峰值点的定位误差；上述的地形匹配定位中有效伪波峰估计与多点融合初始定位方法，所述步骤四中每一个组合形式下的多点融合定位结果的具体计算方法如下：具体计算方法如下：假设一共有N个地形匹配定位点，索引号以k表示，每一个地形匹配定位点对应的有效峰值点的总数为mk，则组合模式的总数NU可以由下式得到：然后是生成索引，根据式(2)的计算结果能够看到一共可以有NU种组合模式。上述的地形匹配定位中有效伪波峰估计与多点融合初始定位方法，生成组合模式时对于每一个地形匹配定位点的有效峰值的具体索引方法如下：根据步骤四中的假设一共有N个地形匹配定位点，每一个地形匹配定位点的有效峰值点为mk个，k表示地形匹配定位点的索引号，则多点融合地形匹配定位中对定位点的有效峰值点的索引矩阵A的大小是NU×N，第k个地形匹配定位点的索引顺序由A的第k列确定，索引矩阵A的任意一个列的形式可以有下述的方法确定：先计算由每一个地形匹配定位点的有效峰值点个数组成的序列的顺序累积结果和由后向前的累积结果对于k,1＜k＜N列向量的形式为：其中，每一个编号复制IMk-1次，每一个序列复制Mk-1次；对于k＝1的情况，索引矩阵的列向量为：其中，每一个编号复制IM2次；对于k＝N的情况，索引矩阵的列向量为：其中，每一个序列复制MN-1次；通过上述四步能够获得NU×N的有效峰值点索引矩阵。上述的地形匹配定位中有效伪波峰估计与多点融合初始定位方法，所述步骤五中NU个地形匹配定位点融合定位结果的具体计算方法为：设第q个组合得到的定位修正量为其计算方法如式(3)，式(3)中表示第k个地形匹配定位点位置的第l号有效峰值点与第k个地形匹配定位点的参考导航定位点之间的距离，λk表示权重系数，它与参考导航的定位误差以及有效峰值点的定位误差有关，即为待求解的定位修正量；本专利技术的有益效果为：本专利技术提出的地形匹配定位高精度与高稳定性定位方法，可针对地形匹配定位结果连续的出现多伪波峰和误匹配的情况下提高地形匹配定位的精度。附图说明下面结合附图和具体实施方式来详细说明本专利技术：图1为本专利技术地形匹配导航的规划路径与规划匹配定位点；图2为本专利技术地形匹配定位结果的示意图；图3为本专利技术地形匹配定位点的置信区间和有效峰值点。图中附图标记的含义：1、一个航迹段，2、参考导航定位点，3、地形匹配定位点，4、搜索区间，5、置信区间，6、搜索点，7、有效峰值点。具体实施方式为使本专利技术实现的技术手段、创作特征、达成目的与功效易于明白了解，下面结合具体实施方式，进一步阐述本专利技术。如图1至图3所示，本专利技术的地形匹配定位中有效伪波峰估计与多点融合初始定位方法，包括以下步骤：步骤一：获得N个地形匹配定位点3的似然函数，并得到的每一个地形匹配定位点3的参考导航定位点2和参考导航的定位误差，具体获得方法如下：如图1所示，假设在一个航迹段内规划了N个地形匹配定位点3，并且已经获得了N个地形匹配定位结果，每一个地形匹配定位点3对应一个参考导航定位点2，同时得到每一个地形匹配定位点3的似然函数，再同时记录下每一个地形匹配定位点3对应的参考导航定位点Dk和参考导航的定位误差Rk，k表示规划的地形匹配定位点索引号。步骤二：根据步骤一得到的N个地形匹配定位点3的似然函数计算每一个地形匹配定位点3的置信区间5，计算其极大似然值的置信度下确界平面，并以此平面截取似然函数曲面获得等值线即为置信区间5的边界；由此可得，每一个地形匹配定位点的置信区间5，如本文档来自技高网...

【技术保护点】
1.地形匹配定位中有效伪波峰估计与多点融合初始定位方法，其特征在于，包括以下步骤：步骤一：获得N个地形匹配定位点的似然函数，并得到的每一个地形匹配定位点的参考导航定位点和参考导航的定位误差；步骤二：根据步骤一得到的N个地形匹配定位点的似然函数计算其极大似然值的置信度下确界平面，并以此平面截取似然函数曲面获得等值线即为置信区间边界；由此可得，每一个地形匹配定位点的置信区间，且在搜索区间内的搜索点被置信区间分割为两部分，其中搜索区间是由参考导航系统的误差得到，位于地形匹配定位置信区间内部的搜索点为有效的地形匹配定位点，即地形匹配定位有效定位点；步骤三：根据步骤二得到的地形匹配定位置信区间和地形匹配定位有效定位点计算地形匹配定位的有效峰值点以及有效峰值点的定位误差；步骤四：根据步骤三得到的地形匹配定位点的有效峰值点、有效峰值点的似然函数值以及有效峰值点的定位误差来确定地形匹配融合定位的组合形式，计算每一个组合形式下的多点融合定位结果；步骤五：根据步骤一得到的每一个地形匹配定位点的参考导航定位点和参考导航的定位误差，步骤三得到的有效峰值点以及有效峰值点的定位误差，再利用步骤四得到的索引矩阵进行每一个有效峰值点组合的定位结果解算，一共能够得到NU个地形匹配定位点融合定位结果；步骤六：根据步骤五中的地形匹配定位多点融合定位结果计算其中每一个定位结果的代价函数Jq,q＝1,2,3...NU，q表示由所有的地形匹配定位点的有效峰值点所组成的多地形匹配定位点融合组合的索引号，设第q个组合得到的定位修正量为...

【技术特征摘要】
1.地形匹配定位中有效伪波峰估计与多点融合初始定位方法，其特征在于，包括以下步骤：步骤一：获得N个地形匹配定位点的似然函数，并得到的每一个地形匹配定位点的参考导航定位点和参考导航的定位误差；步骤二：根据步骤一得到的N个地形匹配定位点的似然函数计算其极大似然值的置信度下确界平面，并以此平面截取似然函数曲面获得等值线即为置信区间边界；由此可得，每一个地形匹配定位点的置信区间，且在搜索区间内的搜索点被置信区间分割为两部分，其中搜索区间是由参考导航系统的误差得到，位于地形匹配定位置信区间内部的搜索点为有效的地形匹配定位点，即地形匹配定位有效定位点；步骤三：根据步骤二得到的地形匹配定位置信区间和地形匹配定位有效定位点计算地形匹配定位的有效峰值点以及有效峰值点的定位误差；步骤四：根据步骤三得到的地形匹配定位点的有效峰值点、有效峰值点的似然函数值以及有效峰值点的定位误差来确定地形匹配融合定位的组合形式，计算每一个组合形式下的多点融合定位结果；步骤五：根据步骤一得到的每一个地形匹配定位点的参考导航定位点和参考导航的定位误差，步骤三得到的有效峰值点以及有效峰值点的定位误差，再利用步骤四得到的索引矩阵进行每一个有效峰值点组合的定位结果解算，一共能够得到NU个地形匹配定位点融合定位结果；步骤六：根据步骤五中的地形匹配定位多点融合定位结果计算其中每一个定位结果的代价函数Jq,q＝1,2,3...NU，q表示由所有的地形匹配定位点的有效峰值点所组成的多地形匹配定位点融合组合的索引号，设第q个组合得到的定位修正量为中mtp表示该定位偏差是由多地形匹配定位算法获取的；找到Jq最小值对应的q就是最优的定位结果对应的索引序号，此时索引号为q的定位修正量即为最优的定位修正量，到此算法执行完毕，多地形匹配定位点融合定位确定。2.根据权利要求1所述的地形匹配定位中有效伪波峰估计与多点融合初始定位方法，其特征在于：所述步骤一中似然函数的具体获得方法如下：假设在一个航迹段内规划了N个地形匹配定位点，并且已经获得了N个地形匹配定位结果，每一个地形匹配定位点对应一个参考导航定位点，同时得到每一个地形匹配定位点的似然函数，再同时记录下每一个地形匹配定位点对应的参考导航定位点Dk和参考导航的定位误差Rk，k表示规划的地形匹配定位点索引号。3.根据权利要求1或2所述的地形匹配定位中有效伪波峰估计与多点融合初始定位方法，其特征在于：所述步骤三中有效峰值点的计算方法如式...

【专利技术属性】
技术研发人员：徐鹏飞，王汝鹏，陈茂飞，蔡文瑞，骆佳成，程红霞，
申请(专利权)人：河海大学，
类型：发明
国别省市：江苏,32