CN107727096A - 基于有效节点筛选的auv地形匹配定位方法 - Google Patents
基于有效节点筛选的auv地形匹配定位方法 Download PDFInfo
- Publication number
- CN107727096A CN107727096A CN201710833352.9A CN201710833352A CN107727096A CN 107727096 A CN107727096 A CN 107727096A CN 201710833352 A CN201710833352 A CN 201710833352A CN 107727096 A CN107727096 A CN 107727096A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- msubsup
- search
- msup
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明的目的在于提供基于有效节点筛选的AUV地形匹配定位方法,根据推算导航的输出结果确定搜索范围,再确定搜索范围后再利用测量地形数据与先验地形进行初步的匹配定位并获得匹配后的地形测量误差估计,然后分别计算节点的有效性和二次搜索范围,根据有效节点矩阵和二次搜索范围进行二次精确匹配定位,最后输出匹配定位结果。本发明所采用的初匹配与精细搜索匹配相结合的匹配定位方法有效的增加了搜索配准的效率同时提高定位精度。
Description
技术领域
本发明涉及的是一种地形匹配定位方法,具体地说是水下地形匹配定位方法。
背景技术
地形匹配导航的搜索匹配过程由于参考导航的误差估计难以达到较高的水平,为了使地形匹配定位的定位点尽量落在搜索区域内部通常采用较大的搜索区域进行搜索匹配,这虽然提高了定位的可靠性但未能提高定位的精度。
发明内容
本发明的目的在于提供减小测量误差给定位结果带来的不利影响的基于有效节点筛选的AUV地形匹配定位方法。
本发明的目的是这样实现的:
本发明基于有效节点筛选的AUV地形匹配定位方法,其特征是:
(1)初匹配搜索范围确定:
根据推算导航的输入信息,搜索区间由下式确定:
其中:xt和yt表示推算导航的位置,由AUV的导航系统给出;
λx和λy表示导航偏差占载体的运行里程的百分比,由参导航系统的统计结果事先给出;
lx和ly表示载体在x方向和y方向的运行里程;
Px和Py表示推算导航在x方向和y方向的误差,由推算导航计算得到;
以(xt,yt)为中心,2lxλx和2lyλy为x方向和y方向的长度构成的矩形区域就是搜索区间
(2)初匹配定位、潮差估计:
根据步骤(1)中计算得到的搜索范围XS开始搜索匹配,将搜索步长调整到1~2个网格边长,由于先验地形和实时测量地形的潮位差不确定,需要对其进行实时的估计,假设潮差为htide,搜索点ij的先验地形与测量地形的高度偏差序列:
假设地形高度偏差序列满足白噪声分布而潮差是常量,得到搜索点ij的潮差和地形测量误差估计:
得到了潮差的估计值之后,计算测量地形和先验地形的真实相似程度:
其中:h(xij,yij)表示测量序列点(xij,yij)在先验地形图中的插值结果,zij∈Z,Z表示测量地形,zij表示测量地形内的点;
查找似然函数Lij值最大的位置得到地形匹配定位的位置同时获得地形匹配定位位置的先验地形和测量地形的高度偏差并计算其均值和标准差,将其标点为定位点位置的潮差估计和测量地形的误差估计
(3)估计定位点的测量误差、剔除误差节点:
通过步骤(2)得到定位点后,计算测量序列和先验地形序列在位置的高度差并计算其均值式中:表示测量序列在先验地形图位置处的地形插值高度序列;
计算统计量:
得到误差的统计结果后对误差节点进行筛选,误差节点选择准则:
式中:表示偏差序列中ij号节点;Fij表示测量节点的有效性标记矩阵;
(4)计算二次匹配搜索区域:
根据步骤(3)中计算得到的潮差和测量误差估计计算分布的置信度为α的分位点
再计算似然函数下界Lminshrehold:
以Lminshrehold为等高平面截取步骤(2)中的似然函数Lij获得的截平面为定位点的置信区间中的x和y的最大值与最小值构成的矩形区域就是二次搜索匹配的搜索区间:
(5)二次精确搜索匹配:
通过步骤(4)得到搜索区间采用1~0.5网格边长的搜索步长,并根据步骤(3)得到的节点标记矩阵F,步骤(2)得到潮差估计tp测量误差估计σp,计算每一个搜索点的测量地形与先验地形高度差Δhij,再利用极大似然估计方法:
查找取得最大值时的搜索点坐标得到二次精确搜索匹配的结果:
得到定位位置
本发明的优势在于:本发明所采用的初匹配与精细搜索匹配相结合的匹配定位方法有效的增加了搜索配准的效率同时提高定位精度。初配准部分采用较大的搜搜步长,该部分用于确定大范围搜索区域内地形匹配定位点的初步定位区域,并根据初定位点的误差统计得到有效节点的筛选条件,第二步精细搜索定位部分包括噪声点的剔除,潮位估计,似然函数计算,定位精度估计。采用两步搜索算法可以有效提高搜索效率提高定位精度同时还可以得到更加精确的似然函数和精度估计。
附图说明
图1为初匹配流程图;
图2为二次搜索匹配流程图;
图3为基于有效节点筛选的AUV地形匹配定位流程图;
图4为有效节点筛选前后的定位点测量地形和先验地形的高度差统计;
图5为基于有效节点筛选的地形匹配定位方法主要步骤流程图。
具体实施方式
下面结合附图举例对本发明做更详细地描述:
结合图1-5,基于有效节点筛选的匹配定位主要步骤包括:根据推算导航的输出结果001确定搜索范围002,再确定搜索范围后再利用测量地形数据004与先验地形003进行初步的匹配定位005并获得匹配后的地形测量误差估计,然后分别计算节点的有效性006和二次搜索范围007,根据有效节点矩阵和二次搜索范围进行二次精确匹配定位008,最后输出匹配定位结果。
本发明所涉及的一种基于有效节点筛选的AUV地形匹配定位方法,具体的实现包括一下几个步骤:
1、初匹配搜索范围确定
初匹配阶段是确定定性点的大致区间,根据推算导航的输入信息100搜索区间由下式确定:
其中:xt和yt表示推算导航的位置,由AUV的导航系统给出;
λx和λy表示导航偏差占载体的运行里程的百分比,由参导航系统的统计结果事先给出;
lx和ly表示载体在x方向和y方向的运行里程;
Px和Py表示推算导航在x方向和y方向的误差,由推算导航计算得到;
以(xt,yt)为中心,2lxλx和2lyλy为x方向和y方向的长度构成的矩形区域就是搜索区间101。
2、初匹配定位、潮差估计
根据1中计算得到的搜索范围XS101开始搜索匹配,将搜索步长调整到1~2个网格边长。由于先验地形和实时测量地形的潮位差不确定,需要对其进行实时的估计。假设潮差为htide,搜索点ij的先验地形与测量地形107的高度偏差序列102:
假设地形高度偏差序列满足白噪声分布而潮差是常量,得到搜索点ij的潮差和地形测量误差估计103:
得到了潮差的估计值之后,计算测量地形和先验地形的真实相似程度:
其中:h(xij,yij)表示测量序列点(xij,yij)在先验地形图中的插值结果,zij∈Z,Z表示测量地形,zij表示测量地形内的点。
查找似然函数Lij值最大的位置104可得到地形匹配定位的位置同时可以获得地形匹配定位位置的先验地形和测量地形的高度偏差并计算其均值和标准差,将其标点为定位点位置的潮差估计和测量地形的误差估计105。
3、定位点的测量误差估计以及误差节点剔除
通过2得到定位点后,计算测量序列和先验地形序列在位置的高度差并计算其均值式中:表示测量序列在先验地形图位置处的地形插值高度序列。
下面计算统计量:
得到误差的统计结果后就可以对误差节点进行筛选,误差节点选择准则106:
式中:表示偏差序列中ij号节点;Fij表示测量节点的有效性标记矩阵。
4、计算二次匹配搜索区域
根据步骤3中计算得到的潮差和测量误差估计201,计算分布的置信度为α的分位点
再计算似然函数下界Lminshrehold:
以Lminshrehold为等高平面截取步骤2中的似然函数Lij获得的截平面就是定位点的置信区间中的x和y的最大值与最小值构成的矩形区域就是二次搜索匹配的搜索区间202:
5、二次精确搜索匹配
通过步骤4得到搜索区间202,采用1~0.5网格边长的搜索步长,并根据步骤3得到的节点标记矩阵F 106,步骤2得到潮差估计tp测量误差估计σp 105,计算每一个搜索点的测量地形与先验地形209高度差Δhij203,再利用极大似然估计方法204:
查找取得最大值时的搜索点坐标得到二次精确搜索匹配的结果204:
得到定位位置
Claims (1)
1.基于有效节点筛选的AUV地形匹配定位方法,其特征是:
(1)初匹配搜索范围确定:
根据推算导航的输入信息,搜索区间由下式确定:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>&lambda;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>l</mi>
<mi>x</mi>
</msub>
<mo>+</mo>
<mn>3</mn>
<msqrt>
<msup>
<mi>P</mi>
<mi>x</mi>
</msup>
</msqrt>
</mrow>
<mo>)</mo>
</mrow>
<mo><</mo>
<msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>X</mi>
<mi>S</mi>
<mn>1</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>x</mi>
</msub>
<mo><</mo>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>&lambda;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>l</mi>
<mi>x</mi>
</msub>
<mo>+</mo>
<mn>3</mn>
<msqrt>
<msup>
<mi>P</mi>
<mi>x</mi>
</msup>
</msqrt>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>&lambda;</mi>
<mi>y</mi>
</msub>
<msub>
<mi>l</mi>
<mi>y</mi>
</msub>
<mo>+</mo>
<mn>3</mn>
<msqrt>
<msup>
<mi>P</mi>
<mi>y</mi>
</msup>
</msqrt>
</mrow>
<mo>)</mo>
</mrow>
<mo><</mo>
<msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>X</mi>
<mi>S</mi>
<mn>1</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>y</mi>
</msub>
<mo><</mo>
<msub>
<mi>y</mi>
<mi>t</mi>
</msub>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>&lambda;</mi>
<mi>y</mi>
</msub>
<msub>
<mi>l</mi>
<mi>y</mi>
</msub>
<mo>+</mo>
<mn>3</mn>
<msqrt>
<msup>
<mi>P</mi>
<mi>y</mi>
</msup>
</msqrt>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中:xt和yt表示推算导航的位置,由AUV的导航系统给出;
λx和λy表示导航偏差占载体的运行里程的百分比,由参导航系统的统计结果事先给出;
lx和ly表示载体在x方向和y方向的运行里程;
Px和Py表示推算导航在x方向和y方向的误差,由推算导航计算得到;
以(xt,yt)为中心,2lxλx和2lyλy为x方向和y方向的长度构成的矩形区域就是搜索区间
(2)初匹配定位、潮差估计:
根据步骤(1)中计算得到的搜索范围XS开始搜索匹配,将搜索步长调整到1~2个网格边长,由于先验地形和实时测量地形的潮位差不确定,需要对其进行实时的估计,假设潮差为htide,搜索点ij的先验地形与测量地形的高度偏差序列:
<mrow>
<msub>
<mi>&Delta;h</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>Z</mi>
<mo>-</mo>
<msub>
<mover>
<mi>h</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
</mrow>
假设地形高度偏差序列满足白噪声分布而潮差是常量,得到搜索点ij的潮差和地形测量误差估计:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>t</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>m</mi>
<mi>e</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&Delta;h</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&sigma;</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>s</mi>
<mi>t</mi>
<mi>d</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&Delta;h</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
得到了潮差的估计值之后,计算测量地形和先验地形的真实相似程度:
<mrow>
<msub>
<mi>L</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<msqrt>
<mrow>
<mn>2</mn>
<msubsup>
<mi>&pi;&sigma;</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
<mn>2</mn>
</msubsup>
</mrow>
</msqrt>
</mfrac>
<mi>exp</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mrow>
<msubsup>
<mi>mn&sigma;</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
<mn>2</mn>
</msubsup>
</mrow>
</mfrac>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>m</mi>
</munderover>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>n</mi>
</munderover>
<msup>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>z</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>t</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>-</mo>
<mi>h</mi>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>)</mo>
</mrow>
</mrow>
其中:h(xij,yij)表示测量序列点(xij,yij)在先验地形图中的插值结果,zij∈Z,Z表示测量地形,zij表示测量地形内的点;
查找似然函数Lij值最大的位置得到地形匹配定位的位置同时获得地形匹配定位位置的先验地形和测量地形的高度偏差并计算其均值和标准差,将其标点为定位点位置的潮差估计和测量地形的误差估计
(3)估计定位点的测量误差、剔除误差节点:
通过步骤(2)得到定位点后,计算测量序列和先验地形序列在位置的高度差并计算其均值式中:表示测量序列在先验地形图位置处的地形插值高度序列;
计算统计量:
得到误差的统计结果后对误差节点进行筛选,误差节点选择准则:
式中:表示偏差序列中ij号节点;Fij表示测量节点的有效性标记矩阵;
(4)计算二次匹配搜索区域:
根据步骤(3)中计算得到的潮差和测量误差估计计算分布的置信度为α的分位点
再计算似然函数下界Lminshrehold:
<mrow>
<msub>
<mi>L</mi>
<mrow>
<mi>min</mi>
<mi>s</mi>
<mi>h</mi>
<mi>r</mi>
<mi>e</mi>
<mi>h</mi>
<mi>o</mi>
<mi>l</mi>
<mi>d</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<msqrt>
<mrow>
<mn>2</mn>
<msubsup>
<mi>&pi;&sigma;</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
</mrow>
</msqrt>
</mfrac>
<mi>exp</mi>
<mrow>
<mo>(</mo>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mrow>
<msubsup>
<mi>mn&sigma;</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
</mrow>
</mfrac>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>m</mi>
</munderover>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>n</mi>
</munderover>
<msup>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>z</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>t</mi>
<mi>p</mi>
</msub>
<mo>-</mo>
<mi>h</mi>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
以Lminshrehold为等高平面截取步骤(2)中的似然函数Lij获得的截平面为定位点的置信区间 中的x和y的最大值与最小值构成的矩形区域就是二次搜索匹配的搜索区间:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mi>s</mi>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>x</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>&le;</mo>
<msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>X</mi>
<mi>s</mi>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>x</mi>
</msub>
<mo>&le;</mo>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mi>s</mi>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>x</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mi>s</mi>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>y</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>&le;</mo>
<msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>X</mi>
<mi>s</mi>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>y</mi>
</msub>
<mo>&le;</mo>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
<mrow>
<mo>(</mo>
<msub>
<mrow>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mi>s</mi>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mi>y</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
(5)二次精确搜索匹配:
通过步骤(4)得到搜索区间采用1~0.5网格边长的搜索步长,并根据步骤(3)得到的节点标记矩阵F,步骤(2)得到潮差估计tp测量误差估计σp,计算每一个搜索点的测量地形与先验地形高度差Δhij,再利用极大似然估计方法:
<mrow>
<msubsup>
<mi>L</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
<mn>2</mn>
</msubsup>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mi>c</mi>
</mfrac>
<mi>exp</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mn>1</mn>
<msubsup>
<mi>&sigma;</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
</mfrac>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>m</mi>
</munderover>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>n</mi>
</munderover>
<msub>
<mi>F</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<msup>
<mrow>
<mo>(</mo>
<mrow>
<mi>Z</mi>
<mo>+</mo>
<msub>
<mi>t</mi>
<mi>p</mi>
</msub>
<mo>-</mo>
<mi>h</mi>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>x</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>,</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>)</mo>
</mrow>
<mo>,</mo>
<mi>c</mi>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<msup>
<mrow>
<mo>(</mo>
<mn>2</mn>
<msubsup>
<mi>&pi;&sigma;</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mrow>
<mi>N</mi>
<mo>/</mo>
<mn>2</mn>
</mrow>
</msup>
</mfrac>
</mrow>
查找取得最大值时的搜索点坐标得到二次精确搜索匹配的结果:
<mrow>
<msubsup>
<mi>X</mi>
<mn>2</mn>
<mi>p</mi>
</msubsup>
<mo>=</mo>
<munder>
<mi>argmax</mi>
<mrow>
<msubsup>
<mi>X</mi>
<mi>p</mi>
<mn>2</mn>
</msubsup>
<mo>&Element;</mo>
<msubsup>
<mi>X</mi>
<mi>s</mi>
<mn>2</mn>
</msubsup>
</mrow>
</munder>
<mrow>
<mo>(</mo>
<msubsup>
<mi>L</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
得到定位位置
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710833352.9A CN107727096B (zh) | 2017-09-15 | 2017-09-15 | 基于有效节点筛选的auv地形匹配定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710833352.9A CN107727096B (zh) | 2017-09-15 | 2017-09-15 | 基于有效节点筛选的auv地形匹配定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107727096A true CN107727096A (zh) | 2018-02-23 |
CN107727096B CN107727096B (zh) | 2020-10-27 |
Family
ID=61207221
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710833352.9A Active CN107727096B (zh) | 2017-09-15 | 2017-09-15 | 基于有效节点筛选的auv地形匹配定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107727096B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111121778A (zh) * | 2019-12-03 | 2020-05-08 | 河海大学 | 一种导航系统初始化方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101339036A (zh) * | 2008-08-20 | 2009-01-07 | 北京航空航天大学 | 地形辅助导航方法和设备 |
CN103743402A (zh) * | 2014-01-03 | 2014-04-23 | 东南大学 | 一种基于地形信息量的水下智能自适应地形匹配方法 |
US20140277864A1 (en) * | 2013-03-12 | 2014-09-18 | The Government Of The United States Of America, As Represented By The Secretary Of The Navy | System and method for navigation for unmanned undersea vehicles |
CN104075715A (zh) * | 2014-07-07 | 2014-10-01 | 东南大学 | 一种结合地形和环境特征的水下导航定位方法 |
CN104484891A (zh) * | 2014-10-22 | 2015-04-01 | 哈尔滨工程大学 | 一种基于纹理特征和地形特征参数的水下地形匹配方法 |
CN106767836A (zh) * | 2017-02-17 | 2017-05-31 | 哈尔滨工程大学 | 一种auv地形匹配导航滤波方法 |
-
2017
- 2017-09-15 CN CN201710833352.9A patent/CN107727096B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101339036A (zh) * | 2008-08-20 | 2009-01-07 | 北京航空航天大学 | 地形辅助导航方法和设备 |
US20140277864A1 (en) * | 2013-03-12 | 2014-09-18 | The Government Of The United States Of America, As Represented By The Secretary Of The Navy | System and method for navigation for unmanned undersea vehicles |
CN103743402A (zh) * | 2014-01-03 | 2014-04-23 | 东南大学 | 一种基于地形信息量的水下智能自适应地形匹配方法 |
CN104075715A (zh) * | 2014-07-07 | 2014-10-01 | 东南大学 | 一种结合地形和环境特征的水下导航定位方法 |
CN104484891A (zh) * | 2014-10-22 | 2015-04-01 | 哈尔滨工程大学 | 一种基于纹理特征和地形特征参数的水下地形匹配方法 |
CN106767836A (zh) * | 2017-02-17 | 2017-05-31 | 哈尔滨工程大学 | 一种auv地形匹配导航滤波方法 |
Non-Patent Citations (4)
Title |
---|
PENGYUN CHEN等: "Review of AUV Underwater Terrain Matching Navigation", 《THE JOURNAL OF NAVIGATION》 * |
YE LI等: "Terrain Correlation Correction Method", 《THE ROYAL INSTITUTE OF NAVIGATION》 * |
李瑶等: "AUV组合导航系统信息匹配的可观测度", 《中国惯性技术学报》 * |
陈小龙等: "基于极大似然估计的AUV 水下地形匹配定位方法", 《机器人》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111121778A (zh) * | 2019-12-03 | 2020-05-08 | 河海大学 | 一种导航系统初始化方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107727096B (zh) | 2020-10-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Wang et al. | Map-based localization method for autonomous vehicles using 3D-LIDAR | |
CN105424030B (zh) | 基于无线指纹和mems传感器的融合导航装置和方法 | |
CN106918342B (zh) | 无人驾驶车辆行驶路径定位方法及定位系统 | |
US8521418B2 (en) | Generic surface feature extraction from a set of range data | |
Li et al. | Lane-level map-matching with integrity on high-definition maps | |
CN106767836A (zh) | 一种auv地形匹配导航滤波方法 | |
CN106052688A (zh) | 基于地形轮廓匹配的惯性导航系统速度累积误差修正方法 | |
KR101858902B1 (ko) | 컴포넌트를 활용한 점군 데이터의 객체 위치정보 추출 시스템 | |
CN108061889A (zh) | Ais与雷达角度系统偏差的关联方法 | |
CN110441760B (zh) | 一种基于先验地形图的大范围海底地形图拓展构图方法 | |
CN107643082A (zh) | 基于多波束的多路径并行iccp水下地形匹配方法 | |
JP6153229B2 (ja) | 位置検出装置、位置検出システム及び位置検出方法 | |
CN114593739B (zh) | 基于视觉检测与参考线匹配的车辆全局定位方法及装置 | |
CN107504974A (zh) | 地形分块与地形测点加权的地形匹配定位方法 | |
CN107727096A (zh) | 基于有效节点筛选的auv地形匹配定位方法 | |
Srinara et al. | Performance analysis of 3D NDT scan matching for autonomous vehicles using INS/GNSS/3D LiDAR-SLAM integration scheme | |
CN113532438B (zh) | 一种大初始定位误差下的改进iccp地形匹配方法 | |
WO2018145334A1 (en) | Method, device and system for localizing a moving object | |
CN104898106B (zh) | 面向复杂地形机载激光雷达数据的地面点提取方法 | |
CN106289281A (zh) | 一种基于三证据ds理论的双模式地图匹配方法 | |
CN104915988A (zh) | 一种摄影测量密集点云生成方法 | |
JP2017142272A (ja) | 位置検出装置、位置検出システム及び位置検出方法 | |
Saarinen et al. | Best-first branch and bound search method for map based localization | |
Park et al. | Precise and reliable positioning based on the integration of navigation satellite system and vision system | |
CN116452764A (zh) | 一种融合地形信息的机载激光雷达点云分级抽稀方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |