CN107289973A - 一种重力匹配导航中的重力场适配性判断方法 - Google Patents
一种重力匹配导航中的重力场适配性判断方法 Download PDFInfo
- Publication number
- CN107289973A CN107289973A CN201710480203.9A CN201710480203A CN107289973A CN 107289973 A CN107289973 A CN 107289973A CN 201710480203 A CN201710480203 A CN 201710480203A CN 107289973 A CN107289973 A CN 107289973A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtd
- gravity
- mfrac
- 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
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- 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/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Manufacturing & Machinery (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种重力匹配导航中的重力场适配性判断方法,引入空间域和重力异常域的密度函数估计方法,引入空间域和重力异常域的密度函数估计组成混合域的密度函数,通过对局部区域的积分,得到适配函数值,有效地弥补传统算法的缺陷,通过重力信息匹配过程提供更及时有效的位置信息修正惯导的积累误差。
Description
技术领域
本发明涉及惯性导航技术领域,具体涉及一种重力匹配导航中的重力场适配性判断方法。
背景技术
惯性导航系统是水下定位的主要设备。由于惯导的位置误差会随时间累积,长时间航行时需要进行重调和校正才能保证载体的定位精度。利用重力信息校正惯导的累积误差能够实现无源导航,因此重力匹配辅助导航是值得研究的方法。重力辅助惯导系统包括惯导系统,重力匹配算法,滤波环节,重力测量和重力数据背景图等部分。其中,匹配算法是重力匹配辅助导航系统的核心。
不同区域重力场分布的差异性以及来自各种测量手段和数据归算的误差,重力匹配算法难以实现精确无误的定位。为了进一步提高系统的定位成功率,需要结合航行区域的匹配数据分布特性,扬长避短,使重力匹配算法发挥更大效用。显然,重力场变化剧烈的区域,区域内重力数据相关性较弱,在匹配定位时更有利于减小匹配算法对量测误差的敏感性。所以,事先对背景图重力场的可匹配性和局部区域的适配性分析,不仅能保证匹配导航的有效性还会提高匹配定位的精度。完成预航行区域的可匹配性分析,使运载体尽量行驶于有利于重力匹配的区域,能有效提升导航定位效果。
发明内容
有鉴于此,本发明提供了一种重力匹配导航中的重力场适配性判断方法,能够实现对背景图重力场的可匹配性和局部区域的适配性进行判断,是否可用于导航,从而保证匹配导航的有效性并提高匹配定位的精度。
本发明的一种重力匹配导航中的重力场适配性判断方法,步骤如下:
步骤1、基于密度估计,计算重力异常背景图中各个网格点的局部区域重力异常适配性分析函数:
式中,x=[[L λ]TΔg],[L λ]是地理位置;Δg是重力异常值,n是以网格点x为中心的局部区域内的网格数,xi为局部区域内的网格点的地理位置,i=1,2,…,n;
多元密度函数表达式为:
空间域密度函数ks和重力异常域密度函数kr都为修剪的高斯分布密度函数,其表达式为:
式中,hs是空间带宽,其设定值与位置误差允许范围一致;σs为匹配位置误差标准差;σr为重力异常误差标准差;hr是重力异常带宽;
步骤2、遍历重力异常背景图中每个网格点,按照步骤1的方法获得每个网格点对应的重力异常适配性分析函数值,并与设定的阈值进行比较,由此判断该网格点对应的重力异常值是否用于导航中。
本发明具有如下有益效果:
本发明引入空间域和重力异常域的密度函数估计方法,引入空间域和重力异常域的密度函数估计组成混合域的密度函数,通过对局部区域的积分,得到适配函数值,有效地弥补传统算法的缺陷,通过重力信息匹配过程提供更及时有效的位置信息修正惯导的积累误差。
附图说明
图1为本发明的适配函数构建流程图。
具体实施方式
下面结合附图并举实施例,对本发明进行详细描述。
重力异常匹配算法的核心思想是通过重力异常值的匹配得到载体位置的估计。匹配算法的定位误差的大小决定了匹配算法的效果。在匹配过程中,发生误匹配产生的位置误差为两个被混淆点的距离,根据以上两个区域的网格点分布,第一个区域造成的误匹配后果更严重。基于以上分析,在误匹配无法完全避免的情况下,匹配数据的适配性分析应同时考虑局部区域数据的空间分布和重力异常分布,单个区域的数据变化程度并不能完全表征一个区域的适配性。
基于密度函数估计的数据适配性分析从匹配原理出发提出区域匹配效果的评价。因为重力异常变化的微弱性和不明确性,基于重力异常单值的匹配都是不可行的。一般的匹配过程都是在惯导提供的置信空间内进行的,即为基于局部区域的匹配过程。构建适配函数的实质是通过统计局部区域内引起误匹配的概率以及误匹配发生后造成的定位误差来评价局部区域的适配程度。通过适配函数的统计分析认为发生误匹配的几率较小或者即使误匹配但导致的位置误差较小的局部区域是适配效果较好的区域。
本发明提供了一种基于密度估计的适配性分析方法,引入空间域和重力异常域的密度函数估计组成混合域的密度函数,通过对局部区域的积分,得到适配函数值,如图1所示,具体为:
1、因为重力异常背景图为网格图,基于密度估计,针对重力异常背景图中网格点的局部区域重力异常适配性分析函数的形式为:
式中,x=[[L λ]TΔg],[L λ]是地理位置,用经纬度表示;Δg是重力异常值,n是以网格点x为中心的局部区域内的网格数,xi为局部区域内的网格点的地理位置,i=1,2,…,n。其中,n的取值根据背景图的大小确定,一般背景图越大,你取值越大。
多元密度函数表达式为:
式中,ks是空间域密度函数,kr是重力异常域密度函数。根据上面两个空间域的密度函数分析,密度函数计算的是局部区域内临近网格点对中心网格点匹配的干扰程度。根据统计特性,适配函数的值越小,在以x为中心的局部区域内干扰网格点越少,即使受到干扰,干扰引起的误差也越小,这样的局部区域的适配性越好。
2、适配函数空间域和重力异常域的密度函数都为修剪的高斯分布密度函数,其表达式为:
式中,hs是空间带宽,因为hs决定统计区域的大小,所以太小会统计信息不全面,太大会统计冗余信息,hs的设定应和位置误差允许范围一致;σs为匹配位置误差标准差,在网格化背景图中,即使匹配算法定位到正确的网格点,还有可能存在位置误差,且最大位置误差为网格长度;σr为重力异常误差标准差,这里的重力异常误差是观测误差,不仅包括背景图的重力异常数据精度,还包括重力传感器的测量精度;hr是重力异常带宽,根据圆概率误差,一般设定为3σr。空间密度函数和重力异常密度函数都选取修剪高斯密度函数的原因是:当重力异常值差超过最大限值时,这样的点不会引起误匹配,所以这些点对适配性的影响相同,当重力异常差小于最大限制,就对空间分布和重力异常分布进行高斯分布假设。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (1)
1.一种重力匹配导航中的重力场适配性判断方法,其特征在于,步骤如下:
步骤1、基于密度估计,计算重力异常背景图中各个网格点的局部区域重力异常适配性分析函数:
<mrow>
<msub>
<mover>
<mi>f</mi>
<mo>^</mo>
</mover>
<mi>K</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mi>n</mi>
</munderover>
<msub>
<mi>K</mi>
<mrow>
<msub>
<mi>k</mi>
<mi>s</mi>
</msub>
<mo>,</mo>
<msub>
<mi>k</mi>
<mi>r</mi>
</msub>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
式中,x=[[L λ]TΔg],[L λ]是地理位置;Δg是重力异常值,n是以网格点x为中心的局部区域内的网格数,xi为局部区域内的网格点的地理位置,i=1,2,…,n;
多元密度函数表达式为:
<mrow>
<msub>
<mi>K</mi>
<mrow>
<msub>
<mi>k</mi>
<mi>s</mi>
</msub>
<mo>,</mo>
<msub>
<mi>k</mi>
<mi>r</mi>
</msub>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>k</mi>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mo>&lsqb;</mo>
<mtable>
<mtr>
<mtd>
<mi>L</mi>
</mtd>
<mtd>
<mi>&lambda;</mi>
</mtd>
</mtr>
</mtable>
<mo>&rsqb;</mo>
<mo>)</mo>
</mrow>
<msub>
<mi>k</mi>
<mi>r</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&Delta;</mi>
<mi>g</mi>
<mo>)</mo>
</mrow>
</mrow>
空间域密度函数ks和重力异常域密度函数kr都为修剪的高斯分布密度函数,其表达式为:
<mrow>
<msub>
<mi>k</mi>
<mi>s</mi>
</msub>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mfrac>
<mn>1</mn>
<mrow>
<msqrt>
<mrow>
<mn>2</mn>
<mi>&pi;</mi>
</mrow>
</msqrt>
<msub>
<mi>&sigma;</mi>
<mi>s</mi>
</msub>
</mrow>
</mfrac>
<mi>exp</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mfrac>
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>x</mi>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
</mrow>
<msubsup>
<mi>&sigma;</mi>
<mi>s</mi>
<mn>2</mn>
</msubsup>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>x</mi>
<mo>|</mo>
<mo>|</mo>
<mo>&le;</mo>
<msub>
<mi>h</mi>
<mi>s</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>o</mi>
<mi>t</mi>
<mi>h</mi>
<mi>e</mi>
<mi>r</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<msub>
<mi>k</mi>
<mi>r</mi>
</msub>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mfrac>
<mn>1</mn>
<mrow>
<msqrt>
<mrow>
<mn>2</mn>
<mi>&pi;</mi>
</mrow>
</msqrt>
<msub>
<mi>&sigma;</mi>
<mi>r</mi>
</msub>
</mrow>
</mfrac>
<mi>exp</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mfrac>
<msup>
<mi>x</mi>
<mn>2</mn>
</msup>
<msubsup>
<mi>&sigma;</mi>
<mi>r</mi>
<mn>2</mn>
</msubsup>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mrow>
<mo>|</mo>
<mi>x</mi>
<mo>|</mo>
</mrow>
<mo>&le;</mo>
<msub>
<mi>h</mi>
<mi>s</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>o</mi>
<mi>t</mi>
<mi>h</mi>
<mi>e</mi>
<mi>r</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
式中,hs是空间带宽,其设定值与位置误差允许范围一致;σs为匹配位置误差标准差;σr为重力异常误差标准差;hr是重力异常带宽;
步骤2、遍历重力异常背景图中每个网格点,按照步骤1的方法获得每个网格点对应的重力异常适配性分析函数值,并与设定的阈值进行比较,由此判断该网格点对应的重力异常值是否用于导航中。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710480203.9A CN107289973B (zh) | 2017-06-22 | 2017-06-22 | 一种重力匹配导航中的重力场适配性判断方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710480203.9A CN107289973B (zh) | 2017-06-22 | 2017-06-22 | 一种重力匹配导航中的重力场适配性判断方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107289973A true CN107289973A (zh) | 2017-10-24 |
CN107289973B CN107289973B (zh) | 2019-08-27 |
Family
ID=60097953
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710480203.9A Active CN107289973B (zh) | 2017-06-22 | 2017-06-22 | 一种重力匹配导航中的重力场适配性判断方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107289973B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108225310A (zh) * | 2017-12-22 | 2018-06-29 | 中国船舶重工集团公司第七0七研究所 | 一种重力辅助导航航迹规划方法 |
CN109141426A (zh) * | 2018-08-10 | 2019-01-04 | 中国空间技术研究院 | 一种水下重力匹配导航适配区的优选方法 |
CN110031000A (zh) * | 2019-05-21 | 2019-07-19 | 北京理工大学 | 一种重力辅助惯性导航区域适配性的评价方法 |
CN110031001A (zh) * | 2019-05-21 | 2019-07-19 | 北京理工大学 | 一种重力辅助惯性导航的适配区选取方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103900567A (zh) * | 2014-03-08 | 2014-07-02 | 哈尔滨工程大学 | 一种基于贝叶斯递推滤波的重力辅助捷联惯性导航方法 |
CN105157704A (zh) * | 2015-06-03 | 2015-12-16 | 北京理工大学 | 一种基于贝叶斯估计的粒子滤波重力辅助惯导匹配方法 |
CN105157703A (zh) * | 2015-06-03 | 2015-12-16 | 北京理工大学 | 一种重力辅助惯性导航适配区可导航性的评价方法 |
-
2017
- 2017-06-22 CN CN201710480203.9A patent/CN107289973B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103900567A (zh) * | 2014-03-08 | 2014-07-02 | 哈尔滨工程大学 | 一种基于贝叶斯递推滤波的重力辅助捷联惯性导航方法 |
CN105157704A (zh) * | 2015-06-03 | 2015-12-16 | 北京理工大学 | 一种基于贝叶斯估计的粒子滤波重力辅助惯导匹配方法 |
CN105157703A (zh) * | 2015-06-03 | 2015-12-16 | 北京理工大学 | 一种重力辅助惯性导航适配区可导航性的评价方法 |
Non-Patent Citations (2)
Title |
---|
BO WANG ETAL.: "The Gravity Matching Area Selection Criteria for Underwater Gravity-Aided Navigation Application Based on the Comprehensive Characteristic Parameter", 《IEEE/ASME TRANSACTIONS ON MECHATRONICS》 * |
张辰等: "一种新的重力辅助导航海区适配性分析方法", 《中国惯性技术学会第七届学术年会论文集》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108225310A (zh) * | 2017-12-22 | 2018-06-29 | 中国船舶重工集团公司第七0七研究所 | 一种重力辅助导航航迹规划方法 |
CN108225310B (zh) * | 2017-12-22 | 2020-08-25 | 中国船舶重工集团公司第七0七研究所 | 一种重力辅助导航航迹规划方法 |
CN109141426A (zh) * | 2018-08-10 | 2019-01-04 | 中国空间技术研究院 | 一种水下重力匹配导航适配区的优选方法 |
CN109141426B (zh) * | 2018-08-10 | 2020-11-10 | 中国空间技术研究院 | 一种水下重力匹配导航适配区的方法 |
CN110031000A (zh) * | 2019-05-21 | 2019-07-19 | 北京理工大学 | 一种重力辅助惯性导航区域适配性的评价方法 |
CN110031001A (zh) * | 2019-05-21 | 2019-07-19 | 北京理工大学 | 一种重力辅助惯性导航的适配区选取方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107289973B (zh) | 2019-08-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107289973A (zh) | 一种重力匹配导航中的重力场适配性判断方法 | |
CN105467415B (zh) | 一种基于差分气压高度约束的小型无人机rtk相对定位方法 | |
CN104390646B (zh) | 水下潜器地形辅助惯性导航系统的位置匹配方法 | |
CN103941270B (zh) | 一种多系统融合定位的方法及装置 | |
CN111426313B (zh) | 一种基于重力灯塔的线匹配与面匹配融合导航方法和系统 | |
CN108007401A (zh) | 一种基于船载InSAR平台的河湖库沿岸形变检测装置及方法 | |
CN106885576A (zh) | 一种基于多点地形匹配定位的auv航迹偏差估计方法 | |
CN108919321A (zh) | 一种基于尝试法的gnss定位粗差探测方法 | |
CN105953799B (zh) | 基于熵值法的重力场适配区内水下运载体航迹规划方法 | |
CN104406610A (zh) | 一种磁力计实时校正装置及方法 | |
CN105759311A (zh) | 一种近实时地震震源位置定位方法 | |
CN109059964A (zh) | 一种基于重力峰的惯性导航与重力测量双校准方法 | |
CN103369466A (zh) | 一种地图匹配辅助室内定位方法 | |
CN102914786B (zh) | 水下自主航行器auv自主定位方法 | |
CN107504974A (zh) | 地形分块与地形测点加权的地形匹配定位方法 | |
US20240061130A1 (en) | High-precision positioning method and system for high-speed train | |
CN108508468A (zh) | 中长基线单历元模糊度解算方法、系统、设备、存储介质 | |
CN104833373A (zh) | 一种基于Procrustes的地磁匹配导航方法 | |
CN105866811A (zh) | 一种基于地面合作信号的双星座定位方法 | |
CN112415542A (zh) | 一种基于北斗和ins结合的变形监测解算方法 | |
CN115203625A (zh) | 一种旱涝指数数据缺失值插补方法及其插补装置 | |
CN105204047B (zh) | 一种卫星导航系统中观测量单个粗差的探测与修复方法 | |
CN110031000A (zh) | 一种重力辅助惯性导航区域适配性的评价方法 | |
CN106597415A (zh) | 一种高斯噪声下提高稀疏孔径成像系统误差检测精度的方法 | |
CN106937378A (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 |