CN110031001B - 一种重力辅助惯性导航的适配区选取方法 - Google Patents
一种重力辅助惯性导航的适配区选取方法 Download PDFInfo
- Publication number
- CN110031001B CN110031001B CN201910425876.3A CN201910425876A CN110031001B CN 110031001 B CN110031001 B CN 110031001B CN 201910425876 A CN201910425876 A CN 201910425876A CN 110031001 B CN110031001 B CN 110031001B
- Authority
- CN
- China
- Prior art keywords
- gravity
- grid point
- characteristic parameter
- area
- anomaly
- 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.)
- Active
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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
- Navigation (AREA)
Abstract
本发明提供了一种重力辅助惯性导航适配区的选择方法,将衡量区域整体数据变化特性的传统参数与可直接从匹配角度衡量适配度的矢量参数相结合;本发明对区域重力信息的挖掘和利用更完全,选取的适配区面积更大更集中,连续性更好,且可携带每个导航点方向适配信息;本发明的适配区选取方法不仅构造了包含四种特征参数特征的综合特征参数,而且是基于熵值法根据每个区域各特征参数的重要性进行客观赋权构造的,使得评价结果更接近客观实际;本发明方法选取的区域更为集中面积更大,连续性更好,对方向的敏感度更低,适配性更高,可供规划的航行路线更多。
Description
技术领域
本发明属于组合导航技术领域,具体涉及一种重力辅助惯性导航的适配区选取方法。
背景技术
惯性导航系统是一种广泛应用于水下导航领域的自主式无源导航定位系统,短时导航精度较高。但其存在定位误差随时间积累的问题,当其应用于长航时时,必须通过其他导航方法对其发散的误差进行修正。重力匹配导航根据地球重力场的变化来进行定位,并不需要发射和接收电磁信号等其他信号,是真正的无源导航,且具有隐蔽性、实时性好等特点,被视为最适辅助水下惯性导航的导航方式之一。
传统的重力匹配适配区选取方法主要依赖于传统的重力异常统计特征参数,通过对这些传统特征参数的单一或多个选取完成适配区的划分,如阈值法通过几种重力特征参数与阈值比较的交集进行适配区的选取,层次分析法通过分析比较各种重力特征参数的重要性构建综合特征参数,再与阈值比较进行适配区选取等。从上可以看出,传统的重力异常统计特征参数无法直观衡量导航点重力异常值序列的方向性。但对同一区域,当水下潜器沿不同方向以不同航线行驶时,重力异常序列差异性不同。而匹配效率较高的方向才正是水下潜器应该航行的方向,但传统的适配区选取方法无法进一步指出此方向,忽略了方向适配性。
发明内容
有鉴于此,本发明提供了一种重力辅助惯性导航适配区的选择方法,将衡量区域整体数据变化特性的传统参数与可直接从匹配角度衡量适配度的矢量参数相结合。本发明对区域重力信息的挖掘和利用更完全,选取的适配区面积更大更集中,连续性更好,且可携带每个导航点方向适配信息。
一种重力辅助惯性导航的适配区选取方法,其特征在于,包括如下步骤:
步骤1,根据导航区域大小确定空间带宽hs,该值即为以当前计算网格点x为中心的局部区域的大小;计算当前网格点x与其所在局部区域中其它各网格点之间的重力异常值差值,得到差向量的模值;再计算当前网格点x所在地理位置指向所在局部区域中其它网格点所在地理位置的方向,即为差向量的方向;
步骤4,根据差向量的模值,求取当前网格点x与局部区域内所有网格点的综合差向量的合向量值,表达式为:
步骤6,按照步骤1至5的方法,将重力异常地图中每一个网格点分别作为网格点x,计算得到网格点x对应的综合差向量的合向量值d(x)、重力异常标准差σ、重力异常经度方向绝对粗糙度rλ和重力异常纬度方向绝对粗糙度
步骤7、根据每种重力特征参数对所选重力适配区的重要程度和影响程度来为每种重力特征参数确定一个权值,然后通过加权求和的方法求得四个重力特征参数的综合重力特征参数T;
将综合重力特征参数T大于设定阈值的网格点连成适配区域,完成适配区域的选取。
较佳的,所述步骤7中,为每种重力特征参数确定一个权值的方法为:
首先对所述四种重力特征参数进行归一化,如下所示:
式中,vpq为通过公式归一化得到的第p种重力特征参数在第q个网格点的数据,其中,q=1,2,...,n_total,n_total表示重力异常地图总网格数;v0pq为第p种重力特征参数在第q个网格点的原值,Φp为第p种重力特征参数的n_total个网格点的数据集,max(Φp)和min(Φp)分别为第p种重力特征参数数据集Φp中的最大值和最小值;
第p种重力特征参数的熵值hp计算公式如下:
然后,通过求得的熵值hp来确定每种特征参数的熵权,计算公式如下:
得到综合重力特征参数T表达式如下:
T=w1·σ+w2·rλ+w3·rφ+w4·d(x) (11)。
本发明具有如下有益效果:
(1)本发明的适配区选取方法不仅构造了包含四种特征参数特征的综合特征参数,而且是基于熵值法根据每个区域各特征参数的重要性进行客观赋权构造的,使得评价结果更接近客观实际。
(2)本发明方法选取的区域更为集中面积更大,连续性更好,对方向的敏感度更低,适配性更高,可供规划的航行路线更多。
(3)本发明改进后的适配区选取方法能更充分利用重力信息,对选取面积一定时,可利用现有区域重力信息选出较优区域,提高匹配效率。
具体实施方式
本发明的一种重力辅助惯性导航的适配区选取方法,包括如下步骤:
步骤1,计算重力异常差向量统计量:
根据导航区域大小确定空间带宽hs,该值即为以当前计算网格点x为中心的局部区域的大小。用[Lλ]T表示网格点x的地理位置,用g表示网格点x的重力异常值。计算网格点x与其所在局部区域中各网格点之间的重力异常值差值,得到差向量的模值;再计算当前网格点x所在地理位置指向其它网格点所在地理位置的方向,即为差向量的方向。
步骤2,根据重力异常值域特性对差向量进行处理:
基于圆概率误差特性,用高斯核函数统计局部区域内各网格点重力异常值对中心点定位的影响情况,本发明中,由于这里设定1为适配性为优,所以需对基本的高斯概率密度函数做相应数值上的转换,将其沿横向坐标轴(重力异常差值轴)对称再沿纵向坐标轴(kg值轴)平移,使kg=1为渐进轴。则当前计算网格点x与其所在局部区域内各网格点xi,j对应的重力异常值域密度函数表达式如下:
式中,表示当前计算网格点x的重力异常值g与局部区域内网格点xi,j的重力异常值之差,hg是重力异常带宽,带宽表示重力异常观测误差的变化范围,设为3σΔg,σΔg为重力异常观测误差标准差。σr是局部区域内重力异常域标准差,这里设其为重力异常观测误差标准差σΔg。
步骤3,根据空间域特性对差向量进行处理:
步骤4,对差向量求和得到重力异常差合向量值,进行区域适配性的评价:综合域差向量模值积分求和,统计各网格点对中心网格点匹配的影响信息,得到重力异常差合向量的模值,即基于网格点的局部区域重力异常值差异度衡量值。根据差向量的模值,求取当前网格点x与周围所有网格点的综合差向量的合向量值,表达式为:
重力异常标准差σ计算公式如下所示:
步骤6,按照步骤1至5的方法,将重力异常地图中每一个网格点分别作为当前网格点x,计算得到当前网格点x对应的局部区域的综合差向量d(x)、力异常标准差σ、重力异常经度方向绝对粗糙度rλ和重力异常纬度方向绝对粗糙度
将步骤4计算得到的综合差向量d(x)以及步骤5计算得到的重力异常标准差σ、重力异常经度方向绝对粗糙度rλ和重力异常纬度方向绝对粗糙度作为4种重力异常特征参数,对每种特征参数进行熵权分配,确定每一种特征参数的熵权。对每种特征参数进行熵权分配,首先对m=4种重力特征参数进行归一化,通过以上可知,四种特征参数均为值越大越有利于重力匹配,所以采用min-max标准化计算公式,如下所示:
式中,vpq为通过公式归一化得到的第p种重力特征参数在第q个网格点的数据,其中,q=1,2,...,n_total,n_total表示重力异常地图总网格数,即总评价对象数;v0pq为第p种重力特征参数在第q个网格点的原值,Φp为第p种重力特征参数的n_total个网格点的数据集,max(Φp)和min(Φp)分别为第p种重力特征参数数据集Φp中的最大值和最小值。
在重力场理论中熵可以用以下函数式来表示:
H(x)=-∑f(xk)lnf(xk) (8)
其中,等式左侧的H(x)表示重力信息熵——一种反映重力场无序程度的度量;等式右侧表示重力信息——一种反映重力场有序程度的度量,等式两边绝对值相等,符号相反。重力场信息量越大,其不确定性就越小,熵值也就越小;反之亦然。则第p种重力特征参数的熵值hp计算公式如下:
其中,k是系数因子,且有k=1/ln(n_total),当某个特征参数归一化后的值为0时,会出现fij=0的情况,这里令fijlnfij=0代入计算,最终可以得到每种重力特征参数的熵值h1、h2、h3、h4。
然后,通过求得的熵值hp来确定每种特征参数的熵权,计算公式如下:
式中,m=4;wp表示第p种重力特征参数的熵权,其为根据此种重力特征参数对所选重力适配区的重要程度、影响程度来确定的量化权重值。对同一适配区,当某一重力特征参数的权重与其它重力特征参数相差十倍以上,且去除这一重力特征参数,其它重力特征参数的权重几乎不变时,说明其几乎不影响我们对适配区重力异常变化程度的判断,可将其忽略。
步骤7,确定综合重力特征参数表达式,对适配区进行选取。
基于上述步骤,得到综合重力特征参数T表达式如下:
T=w1·σ+w2·rλ+w3·rφ+w4·d(x) (11)
以T来划分重力辅助导航适配区与非适配区,适配区阈值的选取标准为:
Tθ>t0 (12)
其中,t0为划分适配区域与非适配区域的阈值。根据新的适配区选择准则,综合大量仿真实验和经验确定划分的阈值。
本实施例中,取经纬度跨度为5°×5°的海洋区域,分辨率为1'×1',对此海洋区域进行适配区选取。局部计算区域空间带宽hs=3。
将传统阈值法与本发明方法对比,本方法更能充分利用重力信息,所选取区域更为集中面积更大,连续性更好,而阈值法所选区域较为分散且部分区域面积较小,并漏掉了部分重力异常值变化明显的区域。在所选适配区上进行匹配实验,本发明方法所选区域匹配性更好,对方向较为不敏感。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (2)
1.一种重力辅助惯性导航的适配区选取方法,其特征在于,包括如下步骤:
步骤1,根据导航区域大小确定空间带宽hs,该值即为以当前计算网格点x为中心的局部区域的大小;计算当前网格点x与其所在局部区域中其它各网格点之间的重力异常值差值,得到差向量的模值;
步骤4,根据差向量的模值,求取当前网格点x与局部区域内所有网格点的综合差向量的合向量值,表达式为:
步骤6,按照步骤1至5的方法,将重力异常地图中每一个网格点分别作为网格点x,计算得到网格点x对应的综合差向量的合向量值d(x)、重力异常标准差σ、重力异常经度方向绝对粗糙度rλ和重力异常纬度方向绝对粗糙度
步骤7、根据每种重力特征参数对所选重力适配区的重要程度和影响程度来为每种重力特征参数确定一个权值,然后通过加权求和的方法求得四个重力特征参数的综合重力特征参数T;
将综合重力特征参数T大于设定阈值的网格点连成适配区域,完成适配区域的选取。
2.如权利要求1所述的一种重力辅助惯性导航的适配区选取方法,其特征在于,所述步骤7中,为每种重力特征参数确定一个权值的方法为:
首先对所述四种重力特征参数进行归一化,如下所示:
式中,vpq为通过公式归一化得到的第p种重力特征参数在第q个网格点的数据,其中,q=1,2,...,n_total,n_total表示重力异常地图总网格数;v0pq为第p种重力特征参数在第q个网格点的原值,Φp为第p种重力特征参数的n_total个网格点的数据集,max(Φp)和min(Φp)分别为第p种重力特征参数数据集Φp中的最大值和最小值;
第p种重力特征参数的熵值hp计算公式如下:
然后,通过求得的熵值hp来确定每种特征参数的熵权,计算公式如下:
得到综合重力特征参数T表达式如下:
T=w1·σ+w2·rλ+w3·rφ+w4·d(x) (11)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910425876.3A CN110031001B (zh) | 2019-05-21 | 2019-05-21 | 一种重力辅助惯性导航的适配区选取方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910425876.3A CN110031001B (zh) | 2019-05-21 | 2019-05-21 | 一种重力辅助惯性导航的适配区选取方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110031001A CN110031001A (zh) | 2019-07-19 |
CN110031001B true CN110031001B (zh) | 2020-12-11 |
Family
ID=67242885
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910425876.3A Active CN110031001B (zh) | 2019-05-21 | 2019-05-21 | 一种重力辅助惯性导航的适配区选取方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110031001B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110487276B (zh) * | 2019-08-20 | 2021-01-12 | 北京理工大学 | 一种基于相关分析的采样矢量匹配定位方法 |
CN110544244B (zh) * | 2019-08-29 | 2022-04-12 | 长江存储科技有限责任公司 | 沟道通孔特征参数的获得方法及装置 |
CN111561922B (zh) * | 2020-04-26 | 2021-08-31 | 中国人民解放军61540部队 | 一种基于重力灯塔特征描述与分类的潜艇导航方法及系统 |
CN111649763B (zh) * | 2020-04-26 | 2021-08-27 | 中国人民解放军61540部队 | 一种基于重力灯塔建立的潜艇导航方法及系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102128625A (zh) * | 2010-12-08 | 2011-07-20 | 北京航空航天大学 | 重力辅助惯性导航系统中重力图匹配的初始匹配方法 |
CN105021182A (zh) * | 2015-06-03 | 2015-11-04 | 北京理工大学 | 一种重力辅助惯性导航适配区的选择方法 |
CN105043388A (zh) * | 2015-06-29 | 2015-11-11 | 中国船舶重工集团公司第七0七研究所 | 基于惯性/重力匹配组合导航的向量搜索迭代匹配方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105157703A (zh) * | 2015-06-03 | 2015-12-16 | 北京理工大学 | 一种重力辅助惯性导航适配区可导航性的评价方法 |
US10107627B2 (en) * | 2017-03-08 | 2018-10-23 | Northrop Grumman Systems Corporation | Adaptive navigation for airborne, ground and dismount applications (ANAGDA) |
CN107289973B (zh) * | 2017-06-22 | 2019-08-27 | 北京理工大学 | 一种重力匹配导航中的重力场适配性判断方法 |
-
2019
- 2019-05-21 CN CN201910425876.3A patent/CN110031001B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102128625A (zh) * | 2010-12-08 | 2011-07-20 | 北京航空航天大学 | 重力辅助惯性导航系统中重力图匹配的初始匹配方法 |
CN105021182A (zh) * | 2015-06-03 | 2015-11-04 | 北京理工大学 | 一种重力辅助惯性导航适配区的选择方法 |
CN105043388A (zh) * | 2015-06-29 | 2015-11-11 | 中国船舶重工集团公司第七0七研究所 | 基于惯性/重力匹配组合导航的向量搜索迭代匹配方法 |
Non-Patent Citations (2)
Title |
---|
Internal Path Planning Method for Underwater Vehicle with Gravity Aided Navigation;FENG Xiaoqing et al.;《Proceedings of the 35th Chinese Control Conference》;20160729;第5537-5541页 * |
一种新的基于特征值融合的重力辅助导航适配区选择方法;张璐等;《导航与控制》;20180430;第32-40页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110031001A (zh) | 2019-07-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110031001B (zh) | 一种重力辅助惯性导航的适配区选取方法 | |
CN109141426B (zh) | 一种水下重力匹配导航适配区的方法 | |
CN101354253B (zh) | 一种基于匹配度的地磁辅助导航方法 | |
CN110081884B (zh) | 基于虚拟航向的重力辅助惯性导航区域适配性评价方法 | |
CA2808155C (en) | Adaptive method for estimating the electron content of the ionosphere | |
JP6328917B2 (ja) | 電離層を横断するのに要する時間の推定における誤差を判定する方法およびシステム | |
Arowolo et al. | Comparison of spatial interpolation techniques to generate high‐resolution climate surfaces for Nigeria | |
CN111595345B (zh) | 一种基于多维重力梯度灯塔的潜艇导航方法及系统 | |
CN108896040B (zh) | 天空海一体化水下潜器惯性/重力组合导航方法和系统 | |
Wang et al. | The gravity matching area selection criteria for underwater gravity-aided navigation application based on the comprehensive characteristic parameter | |
KR102319145B1 (ko) | 고해상도 해양 데이터를 생성하기 위한 방법 및 이를 이용한 장치 | |
CN112946784B (zh) | 一种基于深度学习的SuperDARN雷达对流图短期预报方法 | |
Sun et al. | Using dual‐polarization GPS antenna with optimized adaptive neuro‐fuzzy inference system to improve single point positioning accuracy in urban canyons | |
Laver et al. | Screening GPS telemetry data for locations having unacceptable error | |
CN110031000B (zh) | 一种重力辅助惯性导航区域适配性的评价方法 | |
Zhang et al. | Modeling of spatial distributions of farmland density and its temporal change using geographically weighted regression model | |
Bakış et al. | Analysis and comparison of spatial rainfall distribution applying different interpolation methods in Porsuk river basin, Turkey | |
CN114089443B (zh) | 一种基于tec积分量及季节变化系数的uhf频段电离层闪烁事件预报方法 | |
Zhang et al. | Design and Application of an Intelligent Patrol Algorithm for Forest Management and Protection Based on Global Positioning System. | |
CN113686336A (zh) | 基于格网拓扑结构迭代最佳环域点提高水下导航精度方法 | |
Mosavi | An effective method for GPS GDOP clustering using ant colony optimization algorithm | |
CN114325625B (zh) | 海洋-电离层混沌动力学特征提取方法、装置、介质、应用 | |
Shang et al. | Study on the improved IDW in the maanshan reach of the Yangtze River modeling | |
CN113220812B (zh) | 一种基于多源地图平台交叉验证的数据空间化方法及装置 | |
CN113048976B (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 |