CN101354253B - 一种基于匹配度的地磁辅助导航方法 - Google Patents
一种基于匹配度的地磁辅助导航方法 Download PDFInfo
- Publication number
- CN101354253B CN101354253B CN2008101199695A CN200810119969A CN101354253B CN 101354253 B CN101354253 B CN 101354253B CN 2008101199695 A CN2008101199695 A CN 2008101199695A CN 200810119969 A CN200810119969 A CN 200810119969A CN 101354253 B CN101354253 B CN 101354253B
- Authority
- CN
- China
- Prior art keywords
- magnetic
- num
- delta
- max
- matching
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Navigation (AREA)
Abstract
一种基于匹配度的地磁辅助导航方法,涉及一种地磁匹配导航算法,该方法根据灰度关联系数和地磁要素的权重计算匹配度,以此衡量匹配区域中位置点对应的地磁要素值与磁传感器实测量地磁要素值之间相似程度从而判断匹配区域中的匹配点,最终进行匹配定位。与传统的轮廓匹配算法相比,该方法充分利用地磁场矢量信息进行矢量定位,消除了传统匹配算法可能出现的误匹配现象,实现精确定位,实时性好。
Description
技术领域
本发明涉及基于匹配度的地磁辅助导航方法,适用于航空导航技术领域,可应用于航空器导航定位,也可适用于水下潜器的导航定位。
背景技术
随着国民经济的发展,导航定位技术已日益成为交通管制、救灾救护、物流管理、土地普查、勘测等领域不可或缺的技术手段;军事领域的精确打击依赖于高精度、高可靠的导航手段,并且对自主隐蔽性提出了要求。高精度的定位技术已经成为各国日益关注和大力发展的关键技术。
目前航空导航技术领域用于组合的导航手段比较丰富,主要有惯性导航、卫星导航、地形辅助导航、重力辅助导航、地磁辅助导航等。惯性导航能够连续输出全部导航参数,可完全自主工作,具有隐蔽性好、不受气象等条件限制的特点在军事应用领域得到广泛应用,但是它的初始校准时间较长,误差会随时间累积,难以长时间高精度工作,并且体积大、价格昂贵。卫星导航系统精度高,是一种全球全天候的导航系统,它具有较高的精度但自主性较差,信号经常受到建筑物、茂密树林等的遮挡,易受干扰甚至被攻击,在实际应用中会受到应用环境和其它国家的制约。地形辅助导航在平原、水面上导航效果很差;重力辅助导航的仪器设备价格昂贵。地磁辅助导航利用磁传感器敏感的地磁矢量进行定位,具有体积小、成本低、隐蔽性强、中高精度、连续导航的特点,当其它导航方式受限制时,是一种有效的导航手段。
地磁辅助导航的原理是在预先选定的载体轨道中选取某段地区上独特性好的地磁场为匹配区域,将其制成基准参考图并数字化储存在载体计算机存储器中,当载体经过匹配区域时,载体上的传感器实时地测定飞行轨道上地磁场的总强度值。实时测定的磁值与预存的地磁图匹配区域在计算机中进行相关匹配计算,得到的匹配点序列作为载体的估计轨迹。匹配算法是地磁辅助导航技术的关键技术之一。传统的匹配方法仅利用了地磁场要素中的总强度信息,在积累一段序列后,在地磁图上利用轮廓特征使用MAD或者MSD准则进行匹配定位,由于仅使用地磁要素中的单个要素进行匹配定位,会出现误匹配的现象,而且在获得一系列地磁场总强度值后才能进行相关定位,实时性较差。
发明内容
本发明的目的是:克服传统匹配方法中对地磁信息利用不充分的现象,充分利用了地磁矢量的六要素进行实时定位,消除传统匹配方法的误匹配现象,提高匹配的实时性。
本发明的技术解决方案为:一种基于匹配度的地磁辅助导航方法,步骤如下:
(1)选择匹配区域,分别从总强度,磁倾角,磁偏角,北向强度,东向强度,垂直强度六幅地磁参考图上读取区域中位置点对应的要素值;
(2)在匹配范围中,计算实测地磁要素数据与区域位置点的要素值之间的关联系数;
(3)通过要素值熵来计算权重;
(4)根据计算的关联系数和权重来计算匹配度;
(5)根据匹配度大小来确定载体的经纬度。
所述步骤(1)的要素为地磁要素中的总强度、磁倾角、磁偏角、北向强度、东向强度和垂直强度。
所述步骤(2)的关联系数为灰度关联系数,关联系数ξi(j)的计算方法为:
式中,Δmin表示M0(j)与Mi(j)序列绝对差中的最小值;Δmax表示M0(j)与Mi(j)序列绝对差中的最大值;Δi0(j)表示M0(j)与Mi(j)序列之间的绝对差;ρ表示分辨率,取值范围为ρ∈(0,1),一般取0.1~0.5;num表示匹配区中包含的候选匹配位置点总个数;εL为实际导航要求的经度允许误差指标,ελ为实际导航要求的纬度允许误差指标;ΔL为地磁图经度方向网格大小,Δλ为地磁图纬度方向网格大小;M0(j)表示由组成的参考值;Mi(j)表示匹配区域第i个位置对应的第j个属性值;Mij表示归一化后的属性值;表示各个要素中的最优值;Kij,j=1,2,...,6为总强度、磁倾角、磁偏角、北向强度、东向强度和垂直强度六幅地磁参考图中位置点(Li,λi)对应的地磁要素值,为第j个特性要素下的实测地磁值,表示Kij与序列之间的绝对差,表示序列中的最大值;表示序列中的最小值。
所述步骤(3)中权重wj,j=1,2...,6的计算方法为:
式中,dj表示第j个要素下各个比较序列贡献度的不一致程度;Ej表示第i个位置在第j个要素的贡献总量;pij表示匹配区域中第i个位置在第j个要素的贡献度;εL为实际导航要求的经度允许误差指标,ελ为实际导航要求的纬度允许误差指标。ΔL为地磁图经度方向网格大小,Δλ为地磁图纬度方向网格大小,表示Kij与序列之间的绝对差;Kij,j=1,2,...,6为总强度、磁倾角、磁偏角、北向强度、东向强度和垂直强度六幅地磁参考图中位置点(Li,λi)对应的地磁要素值,为第j个特性要素下的实测地磁值;num表示匹配区中包含的候选匹配位置点总个数。
所述步骤(4)中匹配度ηi的计算方法为:
上式中,aj表示第j要素的权重在权重序列wj,j=1,2,...,6中的排序数,bj表示第j要素关联系数在关联系数序列ξi(j),j=1,2,...,6中排序数。εL为实际导航要求的经度允许误差指标,ελ为实际导航要求的纬度允许误差指标。ΔL为地磁图经度方向网格大小,Δλ为地磁图纬度方向网格大小。
所述步骤(5)中载体经纬度的确定方法为最大匹配度相应的位置i所对应的经纬度(Li,λi)为匹配点,即基于匹配度的地磁辅助导航方法计算的载体的位置。
本发明的原理是:地球表面上存在的地磁场是一个矢量场,其特征和所有磁场一样可以通过六个要素来表示,如图2所示。地磁坐标系取x轴沿地理子午线的方向,指向地理正北,y轴沿纬圈的方向,指向地理正东;z轴垂直向下,以向下为正,xoy所在的平面为水平面。地磁场矢量相对于坐标系占据方位OA。矢量在x轴上的投影称为北向分量,在y轴上的投影称为东向分量,在z轴上的投影称为垂直分量,各个分量的大小为强度,并用X、Y、Z来分别表示,则X表示北向强度,Y表示东向强度,Z表示垂直强度。矢量在水平面上的投影称为水平分量H,矢量所在的垂直平面zOB称为磁子午面,而地理子午面与磁子午面之间的夹角(xOB)称为磁偏角D。水平面与地磁矢量之间的夹角AOB称为磁倾角I。由上述定义可以知道地磁矢量由北向东的磁偏角为正磁偏角,由北向西的磁偏角为负磁偏角。当地磁矢量由地表指向下方时,倾角I为正,在北半球是这样,而在南半球矢量指向上方,倾角I为负。飞行载体将预先选定的轨道中某段地区的地磁场六要素——总强度,磁倾角,磁偏角,北向强度,东向强度,垂直强度分别制成地磁要素参考图并储存在计算机存储器中,当载体飞越匹配区时,载体上的传感器实时测量匹配区中地磁场的六个要素值。实时测定的六个地磁要素值与预存的地磁参考图匹配区域中位置点相应的要素值在计算机中计算关联系数。
本发明中的关联系数选取灰度关联系数。地磁辅助导航的基本原理就是在匹配区中凭借实测地磁信号与载体存储地磁图的相似关系寻找最佳匹配点。灰色系统理论中的灰色关联系数依靠信息覆盖描述、分析、综合、处理信息不完全、不确定的灰对象,是评价相似关系的重要指标。考虑到六个要素特性不同,因此在辅助导航中的权重是不同的,所以需要计算各个要素的权重来反映各个要素的重要性从而修正关联系数,本发明通过要素值的熵来客观地反映出各个要素在导航中所起的作用,最后根据关联系数和权重计算出匹配度,匹配度可以合理地反映实测地磁场矢量与存储的匹配区地磁矢量之间的相似关系,匹配度最大值对应的地磁图位置点即匹配点,从而精确确定载体的实时位置。
本发明与现有技术相比的优点在于:
(1)本发明充分利用了地磁场矢量信息进行矢量定位,消除了传统的匹配方法利用地磁场总强度序列值轮廓匹配带来的误匹配现象,达到精确定位的效果。
(2)本发明中的定位是在采集完一个地磁矢量信息之后就在地磁图匹配区利用匹配度进行定位,实时性好。
附图说明
图1为本发明的一种基于匹配度的地磁辅助导航方法的设计流程图。
图2为地磁场六要素分量。
具体实施方式
选取实例的导航要求的经度允许误差指标εL为0.001度,纬度允许误差指标ελ为0.001度,实例选取的地磁图经度方向网格大小ΔL为0.0002度,纬度方向网格大小Δλ为0.0002度。
如图1所示,本发明的具体方法如下:
(1)选择匹配区域,分别从总强度,磁倾角,磁偏角,北向强度,东向强度,垂直强度六幅地磁参考图上读取区域中位置点对应的要素值。
根据惯性测量单元测量数据实时捷联解算载体的经纬度匹配区域为以惯导计算出的为中心,边长为0.002度×0.002度的矩形区域。在匹配区中的每个位置点(Li,λi),1≤i≤num都是候选匹配位置,匹配区中包含的候选匹配位置点总个数
六幅地磁参考图存储在载体计算机中,通过程序读取各幅参考图中位置点(Li,λi)对应的地磁要素Kij,i=1,2,...,100,j=1,2,...,6,Ki1为总强度,Ki2为磁倾角,Ki3为磁偏角,Ki4为北向强度,Ki5为东向强度,Ki6为垂直强度。
(2)在匹配区域中,计算实测地磁数据与区域位置点的要素值之间的关联系数。
式(2)中, j=1,2,...,6。
计算{Mij}每个要素的关联系数,记 ,(i=1,2,...100;j=1,2,...,6),则表示各个要素中的最优值,取由组成参考值 将匹配区域第i个位置对应的第j个属性值Mi(j)={Mij|j=1,2,...,6},(i=1,2,...,num)作为比较序列,则M0(j)与Mi(j)在第j个要素下的关联系数ξi(j)计算如下:
式(3)中 Δi0(j)=|M0(j)-Mi(j)|,分辨率ρ∈(0,1),分辨率ρ的作用是提高关联系数之间的差异显著性,一般取0.1~0.5,本实例取0.4。
(3)通过要素值熵来计算权重。
匹配区域中第i个位置在第j个要素的贡献度pij计算如下:
这种贡献度包括一种信息内容,可以用熵Ej来表示第i个位置在第j个要素的贡献总量,计算如下:
本实例中,式(5)中常数k一般取为: 可以保证Ej∈[0,1]。
第j个要素下各个比较序列贡献度的不一致程度dj计算如下:
dj=1-Ej,(j=1,2,3,...,6)(6)
计算权重如下:
(4)根据计算的关联系数和权重来计算匹配度。
将每个地磁要素的权重wj,(j=1,2,...,6)由大到小组成权重序列,根据非参数统计理论,由各要素的关联系数ξi(j)与权重序列wj计算匹配度ηi
式(8)中,aj表示第j要素的权重wj在权重序列中的排序数,bj表示第j要素关联系数在关联系数序列ξi(j),j=1,2,...,6中排序数。
(5)根据匹配度ηi大小来确定载体的经纬度。
式(8)计算的匹配度ηi范围为[-1,1]。当匹配度ηi取最大值也就是ηi=1时,表示权重与关联系数之间的秩次完全符合;当匹配度ηi取最小值也就是ηi=-1时,表示两者之间的秩次完全相反,呈负相关;当匹配度ηi中间值也就是ηi=0时,表示两者之间的秩次完全无关。显然,ηi值越大,权重与关联系数之间相关性越好,所以,ηi由大到小的顺序就是匹配区域中位置点对应的地磁要素值与磁传感器实测量地磁要素值之间相似程度由优到劣的次序。ηi最大值相应的位置i所对应的经纬度(Li,λi)为匹配点,即基于匹配度的地磁辅助导航方法计算的载体的位置。
Claims (7)
1.一种基于匹配度的地磁辅助导航方法,其特征在于包括以下步骤:
(1)选择匹配区域,分别从六幅地磁参考图上的每幅读取相对应的一个要素值;
(2)在匹配区域中,计算实测地磁要素数据与区域位置点的要素值之间的关联系数;
(3)通过要素值熵来计算权重;
(4)根据计算的关联系数和权重计算匹配度;
(5)根据匹配度大小确定载体的经纬度。
2.根据权利要求1所述的基于匹配度的地磁辅助导航方法,其特征在于:所述步骤(1)的要素为地磁要素中的总强度、磁倾角、磁偏角、北向强度、东向强度和垂直强度。
3.根据权利要求1所述的基于匹配度的地磁辅助导航方法,其特征在于:所述步骤(2)的关联系数为灰度关联系数。
4.根据权利要求1所述的基于匹配度的地磁辅助导航方法,其特征在于:所述步骤(2)中关联系数ξi(j)的计算方法为:
式中,Δmin表示M0(j)与Mi(j)序列绝对差中的最小值;Δmax表示M0(j)与Mi(j)序列绝对差中的最大值;Δi0(j)表示M0(j)与Mi(j)序列之间的绝对差;ρ表示分辨率,取值范围为ρ∈(0,1);num表示匹配区域中包含的候选匹配位置点总个数;εL为实际导航要求的经度允许误差指标,ελ为实际导航要求的纬度允许误差指标;ΔL为地磁图经度方向网格大小,Δλ为地磁图纬度方向网格大小;M0(j)表示由Mj *组成的参考值;Mi(j)表示匹配区域第i个位置对应的第j个属性值;Mij表示归一化后的属性值;Mj *表示各个要素中的最优值;Kij,j=1,2,...,6为总强度、磁倾角、磁偏角、北向强度、东向强度和垂直强度六幅地磁参考图中位置点(Li,λi)对应的地磁要素值,Kj *为第j个特性要素下的实测地磁值,K′ij表示Kij与Kj *序列之间的绝对差,Kj max表示K′ij序列中的最大值;Kj min表示K′ij序列中的最小值。
5.根据权利要求1所述的基于匹配度的地磁辅助导航方法,其特征在于:所述步骤(3)中权重wj的计算方法为:
式中,dj表示第j个要素下各个比较序列贡献度的不一致程度;Ej表示第i个位置在第j个要素的贡献总量;pij表示匹配区域中第i个位置在第j个要素的贡献度;εL为实际导航要求的经度允许误差指标,ελ为实际导航要求的纬度允许误差指标;ΔL为地磁图经度方向网格大小,Δλ为地磁图纬度方向网格大小,K′ij表示Kij与Kj *序列之间的绝对差;Kij,j=1,2,...,6为总强度、磁倾角、磁偏角、北向强度、东向强度和垂直强度六幅地磁参考图中位置点(Li,λi)对应的地磁要素值,Kj *为第j个特性要素下的实测地磁值;num表示匹配区域中包含的候选匹配位置点总个数。
6.根据权利要求1所述的基于匹配度的地磁辅助导航方法,其特征在于:所述步骤(4)中匹配度ηi的计算方法为:
式中,aj表示第j要素权重在权重序列wj,j=1,2,...,6中的排序数,bj表示第j要素关联系数在关联系数序列ξi(j),j=1,2,...,6中排序数,εL为实际导航要求的经度允许误差指标,ελ为实际导航要求的纬度允许误差指标;ΔL为地磁图经度方向网格大小,Δλ为地磁图纬度方向网格大小。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2008101199695A CN101354253B (zh) | 2008-09-19 | 2008-09-19 | 一种基于匹配度的地磁辅助导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2008101199695A CN101354253B (zh) | 2008-09-19 | 2008-09-19 | 一种基于匹配度的地磁辅助导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101354253A CN101354253A (zh) | 2009-01-28 |
CN101354253B true CN101354253B (zh) | 2010-09-01 |
Family
ID=40307174
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2008101199695A Expired - Fee Related CN101354253B (zh) | 2008-09-19 | 2008-09-19 | 一种基于匹配度的地磁辅助导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101354253B (zh) |
Families Citing this family (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102168979B (zh) * | 2010-12-08 | 2013-01-02 | 北京航空航天大学 | 一种基于三角形约束模型的无源导航的等值线匹配方法 |
JP5741115B2 (ja) * | 2011-03-25 | 2015-07-01 | ソニー株式会社 | 測位装置、測位方法、プログラム、及び記録媒体 |
CN102445201B (zh) * | 2011-09-28 | 2013-12-25 | 东北林业大学 | 用于水下载体的地磁异常特征点匹配导航方法 |
KR101833217B1 (ko) * | 2011-12-07 | 2018-03-05 | 삼성전자주식회사 | 자기장 지도 기반 측위 시스템에서 이용되는 이동 단말 및 이를 이용한 위치 추정 방법 |
CN103115624B (zh) * | 2013-01-24 | 2014-12-10 | 南京航空航天大学 | 一种基于地磁匹配的地磁日变修正方法 |
CN104105067B (zh) * | 2013-04-09 | 2017-10-20 | 广东美晨通讯有限公司 | 基于地磁信息的实时定位系统及方法 |
CN103900564A (zh) * | 2014-03-03 | 2014-07-02 | 哈尔滨工程大学 | 一种潜深辅助地磁异常反演测速/水下连续定位方法 |
CN104390646B (zh) * | 2014-09-15 | 2017-06-16 | 东南大学 | 水下潜器地形辅助惯性导航系统的位置匹配方法 |
CN105451329B (zh) | 2014-09-25 | 2019-04-05 | 华为技术有限公司 | 一种定位方法及电子设备 |
CN104897154B (zh) * | 2015-04-29 | 2018-05-01 | 中测高科(北京)测绘工程技术有限责任公司 | 基于手机的室内地磁导航方法及装置 |
CN105043387A (zh) * | 2015-06-26 | 2015-11-11 | 武汉科技大学 | 基于惯导辅助地磁的个人室内定位系统 |
CN107063237A (zh) * | 2016-12-14 | 2017-08-18 | 歌尔股份有限公司 | 一种测量物体姿态角的方法和装置 |
CN107328416B (zh) * | 2017-05-19 | 2019-09-03 | 南京邮电大学 | 一种基于地磁的智能手机实时定位方法 |
CN107504965B (zh) * | 2017-08-15 | 2020-07-31 | 华北理工大学 | 基于磁特征参量联合距离的井下定位方法 |
CN107543541B (zh) * | 2017-08-25 | 2019-11-08 | 北京麦钉艾特科技有限公司 | 一种适合室内自由运动载体的地磁定位方法 |
CN107816988B (zh) * | 2017-10-31 | 2020-01-17 | 北京臻迪科技股份有限公司 | 一种水下无人感知设备的流体内动态自稳定位方法及设备 |
CN108519084B (zh) * | 2018-02-02 | 2020-09-08 | 中国科学院光电研究院 | 一种行人航位推算辅助的行人地磁定位方法及系统 |
CN109084752B (zh) * | 2018-10-18 | 2022-04-08 | 西北工业大学 | 一种基于全连通约束的地磁导航定位方法 |
CN109341723B (zh) * | 2018-11-22 | 2020-07-14 | 东南大学 | 一种基于地磁信息熵和相似性度量的综合地磁匹配方法 |
CN110687770A (zh) * | 2019-10-25 | 2020-01-14 | 天王电子(深圳)有限公司 | 一种基于手表的自动切换时区的控制方法及控制系统 |
CN117931881B (zh) * | 2024-03-15 | 2024-05-24 | 四川鑫正工程项目管理咨询有限公司 | 一种工程造价查询管理方法 |
-
2008
- 2008-09-19 CN CN2008101199695A patent/CN101354253B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN101354253A (zh) | 2009-01-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101354253B (zh) | 一种基于匹配度的地磁辅助导航方法 | |
CN109324330B (zh) | 基于混合无导数扩展卡尔曼滤波的usbl/sins紧组合导航定位方法 | |
CN110057354B (zh) | 一种基于磁偏角修正的地磁匹配导航方法 | |
CN104215259B (zh) | 一种基于地磁模量梯度和粒子滤波的惯导误差校正方法 | |
CN102829777B (zh) | 自主式水下机器人组合导航系统及方法 | |
CN105760811B (zh) | 全局地图闭环匹配方法及装置 | |
CN108896040B (zh) | 天空海一体化水下潜器惯性/重力组合导航方法和系统 | |
CN104390646B (zh) | 水下潜器地形辅助惯性导航系统的位置匹配方法 | |
CN106324620A (zh) | 一种不依赖地表气象数据实时测量的对流层天顶延迟方法 | |
CN111595345B (zh) | 一种基于多维重力梯度灯塔的潜艇导航方法及系统 | |
US11835344B2 (en) | Contour line matching method based on sliding window data backtracking | |
CN101354252B (zh) | 一种基于多尺度估计的地磁辅助导航算法 | |
CN109059964A (zh) | 一种基于重力峰的惯性导航与重力测量双校准方法 | |
CN113739795A (zh) | 一种基于偏振光/惯性/视觉组合导航的水下同步定位与建图方法 | |
CN110031001A (zh) | 一种重力辅助惯性导航的适配区选取方法 | |
CN104613966A (zh) | 一种地籍测量事后数据处理方法 | |
CN110207721B (zh) | 一种考虑残差分布的无效地形匹配结果识别方法 | |
Deng et al. | Underwater map-matching aided inertial navigation system based on multi-geophysical information | |
KR100510835B1 (ko) | 실시간 측량 시스템을 이용하여 제작된 수치지도를적용하는 gis의 구축방법 | |
CN113819904B (zh) | 一种基于天顶点矢量的偏振/vio三维姿态确定方法 | |
CN104567802A (zh) | 集成船载重力和gnss的测线式陆海高程传递方法 | |
Zhuangsheng et al. | Study on initial gravity map matching technique based on triangle constraint model | |
CN113900069A (zh) | 一种基于干涉成像高度计的垂线偏差计算方法及其系统 | |
Groves et al. | Enhancing micro air vehicle navigation in dense urban areas using 3D mapping aided GNSS | |
CN114025320A (zh) | 一种基于5g信号的室内定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20100901 Termination date: 20210919 |
|
CF01 | Termination of patent right due to non-payment of annual fee |