CN113884087A - 一种基于组网测距三角形辅助的地磁定位方法及系统 - Google Patents

一种基于组网测距三角形辅助的地磁定位方法及系统 Download PDF

Info

Publication number
CN113884087A
CN113884087A CN202111266105.8A CN202111266105A CN113884087A CN 113884087 A CN113884087 A CN 113884087A CN 202111266105 A CN202111266105 A CN 202111266105A CN 113884087 A CN113884087 A CN 113884087A
Authority
CN
China
Prior art keywords
triangle
matched
indication
matching
geomagnetic
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
Application number
CN202111266105.8A
Other languages
English (en)
Other versions
CN113884087B (zh
Inventor
朱正辉
董佩超
朱洪亮
韩彤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Tianbing Technology Co ltd
Original Assignee
Beijing Tianbing Technology Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Tianbing Technology Co ltd filed Critical Beijing Tianbing Technology Co ltd
Priority to CN202111266105.8A priority Critical patent/CN113884087B/zh
Publication of CN113884087A publication Critical patent/CN113884087A/zh
Application granted granted Critical
Publication of CN113884087B publication Critical patent/CN113884087B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/04Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
    • G01C21/08Navigation; 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)
  • Life Sciences & Earth Sciences (AREA)
  • Environmental & Geological Engineering (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Geology (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

本发明涉及一种基于组网测距三角形辅助的地磁定位方法及系统。三个组网移动物体的地磁参数以及两两之间的距离;基于地磁参数获取待匹配区域;基于两两之间的距离得到指示三角形;由的待匹配区域分别选取顶点,形成多个待匹配三角形,计算各个待匹配三角形与指示三角形的最大覆盖面积;选择匹配度最高的待匹配三角形作为最佳匹配三角形;最佳匹配三角形各个顶点的位置作为三个移动物体的位置。本发明对组网群内移动物体两两进行测距,得到匹配三角形辅助地磁定位,提高算法实时性,误差不会随时间增加。

Description

一种基于组网测距三角形辅助的地磁定位方法及系统
技术领域
本发明涉及地磁匹配技术领域,尤其涉及一种基于组网测距三角形辅助的地磁定位方法及系统。
背景技术
目前主流的导航方法有惯性导航、卫星导航、天文导航、景像匹配导航、地磁导航、组合导航等。其中惯性导航自主性强,但其导航精度主要取决于陀螺的精度,其位置与速度误差会随时间积累而增大,而且单纯地依靠提高惯性仪表精度来提高导航精度是较为困难的。天文导航、景像匹配导航、卫星导航和地磁导航的优点为测量是离散的、误差不积累,但天文测量受到天体能见度的限制;景像匹配在地面信息内容(图像信息或地形信息)不丰富或根本无地面信息可利用的地区,无法通过景像匹配实现精确制导;卫星导航由于卫星信号易于受到遮挡和电磁干扰,其应用也受到限制;而地磁场具有全天时、全天候和全地域存在的特点,且是自主的、无长期积累误差且具有较强抗干扰能力的导航定位技术,同时,高精度低成本弱磁测量仪器(磁通门传感器、磁阻传感器)的出现,也为采用地磁匹配来实现导航提供了硬件基础。
现有技术使用惯性导航信息得到指示三角形,由惯性导航系统位置的估计误差来确定搜索范围,根据相似性准则选择最佳三角形。该方法存在较长延时,且误差随时间增加的问题。
发明内容
针对现有技术存在的问题,本发明提供一种基于组网测距三角形辅助的地磁定位方法及系统,对移动物体组网群两两进行测距,得到匹配三角形辅助地磁定位,提高算法实时性,误差不会随时间增加。
为达到上述目的,本发明提供了一种基于组网测距三角形辅助的地磁定位方法,包括:
三个组网移动物体A1,B1,C1的地磁参数以及两两之间的距离;
基于地磁参数获取三个移动物体A1,B1,C1的待匹配区域;基于两两之间的距离得到指示三角形ΔABC;
由A1,B1,C1的待匹配区域分别选取顶点,形成多个待匹配三角形,计算各个待匹配三角形与指示三角形的最大覆盖面积;
基于各个待匹配三角形中与指示三角形的最大覆盖面积,选择匹配度最高的待匹配三角形作为最佳匹配三角形;
最佳匹配三角形各个顶点的位置作为三个移动物体的位置。
进一步地,每个移动物体配置磁感应器检测地磁参数,配置激光雷达进行两两测距。
进一步地,基于地磁参数获取三个移动物体A1,B1,C1的待匹配区域,包括:利用地磁场模值搜索数据库中所述地磁参数对应的等值线,基于测量误差选取所述等值线的一段为待匹配区域。
进一步地,形成的待匹配三角形满足以下约束条件:
Figure BDA0003327039150000021
其中A1i、B1i、C1i为第i组三个移动物体A1,B1,C1的待匹配区满足约束条件的点,A1iB1i,B1iC1i,C1iA1i的边长分别为
Figure BDA0003327039150000022
A1iB1iC1i构成一个待匹配三角形,R代表搜索范围。
进一步地,计算各个待匹配三角形与指示三角形的最大覆盖面积,包括:
(1)将指示三角形ΔABC和待匹配三角形ΔA1iB1iC1i置于一个直角坐标系中;将指示三角形ΔABC各顶点坐标为:
A(0,0),B(cos∠A·lAB,sin∠A·lAB),C(lAC,0);
其中
Figure BDA0003327039150000031
待匹配三角形ΔA1iB1iC1i各顶点坐标为:
Figure BDA0003327039150000032
其中
Figure BDA0003327039150000033
(2)计算ΔABC的质心
Figure BDA0003327039150000034
计算ΔA1iB1iC1i的质心
Figure BDA0003327039150000035
(3)对待匹配三角形ΔA1iB1iC1i平移(tx,ty),满足
Figure BDA0003327039150000036
使其与ΔABC的质心重合,得到新的三角形Δ′A1iB1iC1i
(4)对Δ′A1iB1iC1i进行旋转得到的三角形与ΔABC覆盖面积最大,通过最优问题求解覆盖面积最大对应的旋转角度θ;
(5)计算旋转角度θ对应的覆盖面积作为待匹配三角形与指示三角形的最大覆盖面积。
进一步地,选择匹配度最高的待匹配三角形作为最佳匹配三角形,包括:
(1)计算各个待匹配三角形面积Si 匹配以及指示三角形面积S指示
Figure BDA0003327039150000038
Figure BDA0003327039150000039
其中
Figure BDA00033270391500000310
分别为A1iB1i,B1iC1i,C1iA1i的边长,lAB,lBC,lAC分别为AB、BC、AC三条边长;
(2)查找各个待匹配三角形面积Si 匹配与指示三角形面积S指示中的较大值作为Si max
(3)计算第i个待匹配三角形与指示三角形的匹配度:
Figure BDA0003327039150000041
Si 覆盖为第i个待匹配三角形与指示三角形的最大覆盖面积。
(4)选择匹配度最高的待匹配三角形作为最佳匹配三角形。
第二方面提供一种基于组网测距三角形辅助的地磁定位系统,包括:
获取模块,获取三个组网移动物体A1,B1,C1的地磁参数以及两两之间的距离;
待匹配区域生成模块,基于地磁参数获取三个移动物体A1,B1,C1的待匹配区域;
指示三角生成模块,基于两两之间的距离得到指示三角形ΔABC;
最大覆盖面积计算模块,由A1,B1,C1的待匹配区域分别选取顶点,形成多个待匹配三角形,计算各个待匹配三角形与指示三角形的最大覆盖面积;
最佳匹配三角形选择模块,基于各个待匹配三角形中与指示三角形的最大覆盖面积,选择匹配度最高的待匹配三角形作为最佳匹配三角形;
位置输出模块,将最佳匹配三角形各个顶点的位置作为三个移动物体的位置。
进一步地,所述获取模块获取各个移动物体配置磁感应器检测地磁参数以及配置的激光雷达进行两两测距的距离;
进一步地,所述待匹配区域生成模块,利用地磁场模值搜索数据库中所述地磁参数对应的等值线,基于测量误差选取所述等值线的一段为待匹配区域。
进一步地,最大覆盖面积计算模块,形成的待匹配三角形满足以下约束条件:
Figure BDA0003327039150000051
其中A1i、B1i、C1i为第i组三个移动物体A1,B1,C1的待匹配区满足约束条件的点,A1iB1i,B1iC1i,C1iA1i的边长分别为
Figure BDA0003327039150000052
ΔA1iB1iC1i构成一个待匹配三角形,R代表搜索范围;
进一步地,最大覆盖面积计算模块,包括:
坐标生成单元,将指示三角形ΔABC和待匹配三角形ΔA1iB1iC1i置于一个直角坐标系中;将指示三角形ΔABC各顶点坐标为:
A(0,0),B(cos∠A·lAB,sin∠A·lAB),C(lAC,0);
其中
Figure BDA0003327039150000053
待匹配三角形ΔA1iB1iC1i各顶点坐标为:
Figure BDA0003327039150000054
其中
Figure BDA0003327039150000055
计算ΔABC的质心
Figure BDA0003327039150000056
计算ΔA1iB1iC1i的质心
Figure BDA0003327039150000057
平移单元,对待匹配三角形ΔA1iB1iC1i平移(tx,ty),满足
Figure BDA0003327039150000058
使其与ΔABC的质心重合,得到新的三角形Δ′A1iB1iC1i
旋转单元,对Δ′A1iB1iC1i进行旋转得到的三角形与ΔABC覆盖面积最大,通过最优问题求解覆盖面积最大对应的旋转角度θ;
输出单元,计算旋转角度θ对应的覆盖面积作为待匹配三角形与指示三角形的最大覆盖面积。
进一步地,最佳匹配三角形选择模块,包括:
面积计算单元,计算各个待匹配三角形面积Si 匹配以及指示三角形面积S指示
Figure BDA0003327039150000061
Figure BDA0003327039150000062
其中
Figure BDA0003327039150000063
分别为A1iB1i,B1iC1i,C1iA1i的边长,lAB,lBC,lAC分别为AB、BC、AC三条边长;
最大面积提取单元,查找各个待匹配三角形面积Si 匹配与指示三角形面积S指示中的较大值作为Si max
匹配度计算单元,计算第i个待匹配三角形与指示三角形的匹配度:
Figure BDA0003327039150000064
Si 覆盖为第i个待匹配三角形与指示三角形的最大覆盖面积;
选择单元,选择匹配度最高的待匹配三角形作为最佳匹配三角形。
本发明的上述技术方案具有如下有益的技术效果:
本发明提供的基于组网测距三角形辅助的地磁定位方法,可以解决传统基于三角形匹配的地磁定位使用惯性导航信息得到匹配三角形存在较长延时,且误差随时间增加的问题。本发明对组网群内移动物体两两进行测距,得到匹配三角形辅助地磁定位,提高算法实时性,误差不会随时间增加。
附图说明
图1是地磁定位流程示意图;
图2为待匹配区域示意图;
图3为待匹配三角形和指示三角形示意图;
图4为指示三角形ΔABC和待匹配三角形ΔA1iB1iC1i置于一个直角坐标系示意图;
图5为地磁定位系统组成示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明了,下面结合具体实施方式并参照附图,对本发明进一步详细说明。应该理解,这些描述只是示例性的,而并非要限制本发明的范围。此外,在以下说明中,省略了对公知结构和技术的描述,以避免不必要地混淆本发明的概念。
提供一种基于组网测距三角形辅助的地磁定位方法,结合图1,包括如下步骤:
步骤一,三个组网移动物体A1,B1,C1的地磁参数以及两两之间的距离。
在一个实施例中,移动物体为三个飞行器,三个飞行器组成飞行器群,每个飞行器配有测量磁场强度的传感器和测量距离的激光雷达。磁感应器检测地磁参数,激光雷达进行两两测距。
步骤二,基于地磁参数获取三个移动物体A1,B1,C1的待匹配区域;基于两两之间的距离得到指示三角形ΔABC。
通过磁感应器测取当地的地磁参数信息,利用地磁场模值搜索数据库中对应的等值线,利用测量误差选取等值线某一段为待匹配区。待匹配区半径和磁感应器的测量精度有关,可以提前设置好。结合图2,虚框内为选取等值线某一段为待匹配区,该区域覆盖了真实位置。
检测的地磁参数为:磁场模值和磁场矢量。测量地磁场矢量,误差相对较大,但是可以与模值结合得到一个点,与真实的位置比较可以得到位置误差大小。事先标定好误差大小,从而设定出待匹配区域Q的半径。
对三个飞行器(A1,B1,C1)分别选择待匹配区,可以得到三个待匹配区域Q1,Q2,Q3。对飞行器群两两进行测距可以得到指示三角形ΔABC,AB、BC、AC三条边长分别为lAB,lBC,lAC,结合图3。
步骤三,由A1,B1,C1的待匹配区域分别选取顶点,形成多个待匹配三角形,计算各个待匹配三角形与指示三角形的最大覆盖面积。
待匹配三角形满足以下约束条件:
Figure BDA0003327039150000081
其中A1i、B1i、C1i为三个待匹配区满足约束条件的点,A1iB1i,B1iC1i,C1iA1i的边长分别为
Figure BDA0003327039150000082
ΔA1iB1iC1i构成一个待匹配三角形,R代表搜索范围和定位精度相关。
计算待匹配三角形Si 匹配与指示三角形S指示的最大覆盖面积,过程如下。
将指示三角形ΔABC和待匹配三角形ΔA1iB1iC1i置于一个直角坐标系中,如图4所示,各坐标如下:
A(0,0),B(cos∠A·lAB,sin∠A·lAB),C(lAC,0);
其中
Figure BDA0003327039150000083
Figure BDA0003327039150000084
其中
Figure BDA0003327039150000085
Figure BDA0003327039150000086
为ΔABC的质心,
Figure BDA0003327039150000087
为ΔA1iB1iC1i的质心。
对待匹配三角形ΔA1iB1iC1i进行平移(tx,ty),满足
Figure BDA0003327039150000091
使其与ΔABC的质心重合,得到新的三角形记为Δ′A1iB1iC1i,对Δ′A1iB1iC1i旋转θ使三角形Δ″A1iB1iC1i与ΔABC覆盖面积最大,θ可以通过最优问题进行求解。
步骤四,基于各个待匹配三角形中与指示三角形的最大覆盖面积,选择匹配度最高的待匹配三角形作为最佳匹配三角形。
第i个匹配三角形与指示三角形的匹配度由下式求取:
Figure BDA0003327039150000092
其中ε为匹配度,越接近于1,匹配三角形与指示三角形的匹配程度越高,Smax为S匹配和S指示中较大值,Si 匹配和S指示分别按如下公式求取:
Figure BDA0003327039150000093
Figure BDA0003327039150000094
取εmax=max{ε12...εn},则εmax对应的三角形ΔA1iB1iC1i即为所求。
计算第i个匹配三角形与指示三角形的匹配度时,采用最大覆盖面积除以第i个匹配三角形与指示三角形中面积较大的那一个Smax,而不是所有三角形中面积最大的。
步骤五,最佳匹配三角形各个顶点的位置作为三个移动物体的位置。
对三个移动物体两两进行测距,得到匹配三角形辅助地磁定位。最终获得了三个移动物体的位置,定位准确,计算效率高,定位实时性好。
另一方面提供一种基于组网测距三角形辅助的地磁定位系统,实时进行三个组网移动物体的定位。结合图5,包括获取模块、待匹配区域生成模块、指示三角生成模块、最大覆盖面积计算模块、最佳匹配三角形选择模块以及位置输出模块。
获取模块,获取三个组网移动物体A1,B1,C1的地磁参数以及两两之间的距离。通过通讯,获取各个移动物体配置磁感应器检测地磁参数以及配置的激光雷达进行两两测距的距离。
待匹配区域生成模块,基于地磁参数获取三个移动物体A1,B1,C1的待匹配区域。利用地磁场模值搜索数据库中所述地磁参数对应的等值线,基于测量误差选取所述等值线的一段为待匹配区域。
指示三角生成模块,基于两两之间的距离得到指示三角形ΔABC。
最大覆盖面积计算模块,由A1,B1,C1的待匹配区域分别选取顶点,形成多个待匹配三角形,计算各个待匹配三角形与指示三角形的最大覆盖面积。
最大覆盖面积计算模块,包括待匹配三角形生成单元、坐标生成单元、平移单元、旋转单元以及输出单元。
待匹配三角形生成单元,形成的待匹配三角形满足以下约束条件:
Figure BDA0003327039150000101
其中A1i、B1i、C1i为第i组三个移动物体A1,B1,C1的待匹配区满足约束条件的点,A1iB1i,B1iC1i,C1iA1i的边长分别为
Figure BDA0003327039150000102
ΔA1iB1iC1i构成一个待匹配三角形,R代表搜索范围。
坐标生成单元,将指示三角形ΔABC和待匹配三角形ΔA1iB1iC1i置于一个直角坐标系中;将指示三角形ΔABC各顶点坐标为:
A(0,0),B(cos∠A·lAB,sin∠A·lAB),C(lAC,0);
其中
Figure BDA0003327039150000103
待匹配三角形ΔA1iB1iC1i各顶点坐标为:
Figure BDA0003327039150000104
其中
Figure BDA0003327039150000111
计算ΔABC的质心
Figure BDA0003327039150000112
计算ΔA1iB1iC1i的质心
Figure BDA0003327039150000113
平移单元,对待匹配三角形ΔA1iB1iC1i平移(tx,ty),满足
Figure BDA0003327039150000114
使其与ΔABC的质心重合,得到新的三角形Δ′A1iB1iC1i
旋转单元,对Δ′A1iB1iC1i进行旋转得到的三角形与ΔABC覆盖面积最大,通过最优问题求解覆盖面积最大对应的旋转角度θ;
输出单元,计算旋转角度θ对应的覆盖面积作为待匹配三角形与指示三角形的最大覆盖面积。
最佳匹配三角形选择模块,基于各个待匹配三角形中与指示三角形的最大覆盖面积,选择匹配度最高的待匹配三角形作为最佳匹配三角形。
最佳匹配三角形选择模块,包括面积计算单元、最大面积提取单元、匹配度计算单元以及选择单元。
面积计算单元,计算各个待匹配三角形面积Si 匹配以及指示三角形面积S指示
Figure BDA0003327039150000115
Figure BDA0003327039150000116
其中
Figure BDA0003327039150000117
分别为A1iB1i,B1iC1i,C1iA1i的边长,lAB,lBC,lAC分别为AB、BC、AC三条边长;
最大面积提取单元,查找各个待匹配三角形面积Si 匹配与指示三角形面积S指示中的较大值作为Si max
匹配度计算单元,计算第i个待匹配三角形与指示三角形的匹配度:
Figure BDA0003327039150000121
Si 覆盖为第i个待匹配三角形与指示三角形的最大覆盖面积;
选择单元,选择匹配度最高的待匹配三角形作为最佳匹配三角形。
位置输出模块,将最佳匹配三角形各个顶点的位置作为三个移动物体的位置。
综上所述,本发明涉及一种基于组网测距三角形辅助的地磁定位方法及系统。三个组网移动物体的地磁参数以及两两之间的距离;基于地磁参数获取待匹配区域;基于两两之间的距离得到指示三角形;由的待匹配区域分别选取顶点,形成多个待匹配三角形,计算各个待匹配三角形与指示三角形的最大覆盖面积;选择匹配度最高的待匹配三角形作为最佳匹配三角形;最佳匹配三角形各个顶点的位置作为三个移动物体的位置。本发明对组网群内移动物体两两进行测距,得到匹配三角形辅助地磁定位,提高算法实时性,误差不会随时间增加。
应当理解的是,本发明的上述具体实施方式仅仅用于示例性说明或解释本发明的原理,而不构成对本发明的限制。因此,在不偏离本发明的精神和范围的情况下所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。此外,本发明所附权利要求旨在涵盖落入所附权利要求范围和边界、或者这种范围和边界的等同形式内的全部变化和修改例。

Claims (10)

1.一种基于组网测距三角形辅助的地磁定位方法,其特征在于,包括:
三个组网移动物体A1,B1,C1的地磁参数以及两两之间的距离;
基于地磁参数获取三个移动物体A1,B1,C1的待匹配区域;基于两两之间的距离得到指示三角形ΔABC;
由A1,B1,C1的待匹配区域分别选取顶点,形成多个待匹配三角形,计算各个待匹配三角形与指示三角形的最大覆盖面积;
基于各个待匹配三角形中与指示三角形的最大覆盖面积,选择匹配度最高的待匹配三角形作为最佳匹配三角形;
最佳匹配三角形各个顶点的位置作为三个移动物体的位置。
2.根据权利要求1所述的基于组网测距三角形辅助的地磁定位方法,其特征在于,每个移动物体配置磁感应器检测地磁参数,配置激光雷达进行两两测距。
3.根据权利要求1或2所述的基于组网测距三角形辅助的地磁定位方法,其特征在于,基于地磁参数获取三个移动物体A1,B1,C1的待匹配区域,包括:利用地磁场模值搜索数据库中所述地磁参数对应的等值线,基于测量误差选取所述等值线的一段为待匹配区域。
4.根据权利要求3所述的基于组网测距三角形辅助的地磁定位方法,其特征在于,形成的待匹配三角形满足以下约束条件:
Figure FDA0003327039140000011
其中A1i、B1i、C1i为第i组三个移动物体A1,B1,C1的待匹配区满足约束条件的点,A1iB1i,B1iC1i,C1iA1i的边长分别为
Figure FDA0003327039140000012
ΔA1iB1iC1i构成一个待匹配三角形,R代表搜索范围。
5.根据权利要求4所述的基于组网测距三角形辅助的地磁定位方法,其特征在于,计算各个待匹配三角形与指示三角形的最大覆盖面积,包括:
(1)将指示三角形ΔABC和待匹配三角形ΔA1iB1iC1i置于一个直角坐标系中;将指示三角形ΔABC各顶点坐标为:
A(0,0),B(cos∠A·lAB,sin∠A·lAB),C(lAC,0);
其中
Figure FDA0003327039140000021
待匹配三角形ΔA1iB1iC1i各顶点坐标为:
Figure FDA0003327039140000022
其中
Figure FDA0003327039140000023
(2)计算ΔABC的质心
Figure FDA0003327039140000024
计算ΔA1iB1iC1i的质心
Figure FDA0003327039140000025
(3)对待匹配三角形ΔA1iB1iC1i平移(tx,ty),满足
Figure FDA0003327039140000026
使其与ΔABC的质心重合,得到新的三角形Δ′A1iB1iC1i
(4)对Δ′A1iB1iC1i进行旋转得到的三角形与ΔABC覆盖面积最大,通过最优问题求解覆盖面积最大对应的旋转角度θ;
(5)计算旋转角度θ对应的覆盖面积作为待匹配三角形与指示三角形的最大覆盖面积。
6.根据权利要求5所述的基于组网测距三角形辅助的地磁定位方法,其特征在于,选择匹配度最高的待匹配三角形作为最佳匹配三角形,包括:
(1)计算各个待匹配三角形面积Si 匹配以及指示三角形面积S指示
Figure FDA0003327039140000031
Figure FDA0003327039140000032
其中lA1iB1i,lB1iC1i,lA1iC1i分别为A1iB1i,B1iC1i,C1iA1i的边长,lAB,lBC,lAC分别为AB、BC、AC三条边长;
(2)查找各个待匹配三角形面积Si 匹配与指示三角形面积S指示中的较大值作为Si max
(3)计算第i个待匹配三角形与指示三角形的匹配度:
Figure FDA0003327039140000033
Si 覆盖为第i个待匹配三角形与指示三角形的最大覆盖面积。
(4)选择匹配度最高的待匹配三角形作为最佳匹配三角形。
7.一种基于组网测距三角形辅助的地磁定位系统,其特征在于,包括:
获取模块,获取三个组网移动物体A1,B1,C1的地磁参数以及两两之间的距离;
待匹配区域生成模块,基于地磁参数获取三个移动物体A1,B1,C1的待匹配区域;
指示三角生成模块,基于两两之间的距离得到指示三角形ΔABC;
最大覆盖面积计算模块,由A1,B1,C1的待匹配区域分别选取顶点,形成多个待匹配三角形,计算各个待匹配三角形与指示三角形的最大覆盖面积;
最佳匹配三角形选择模块,基于各个待匹配三角形中与指示三角形的最大覆盖面积,选择匹配度最高的待匹配三角形作为最佳匹配三角形;
位置输出模块,将最佳匹配三角形各个顶点的位置作为三个移动物体的位置。
8.根据权利要求7所述的基于组网测距三角形辅助的地磁定位系统,其特征在于,所述获取模块获取各个移动物体配置磁感应器检测地磁参数以及配置的激光雷达进行两两测距的距离;
进一步地,所述待匹配区域生成模块,利用地磁场模值搜索数据库中所述地磁参数对应的等值线,基于测量误差选取所述等值线的一段为待匹配区域。
9.根据权利要求8所述的基于组网测距三角形辅助的地磁定位系统,其特征在于,最大覆盖面积计算模块,形成的待匹配三角形满足以下约束条件:
Figure FDA0003327039140000041
其中A1i、B1i、C1i为第i组三个移动物体A1,B1,C1的待匹配区满足约束条件的点,A1iB1i,B1iC1i,C1iA1i的边长分别为
Figure FDA0003327039140000042
ΔA1iB1iC1i构成一个待匹配三角形,R代表搜索范围;
进一步地,最大覆盖面积计算模块,包括:
坐标生成单元,将指示三角形ΔABC和待匹配三角形ΔA1iB1iC1i置于一个直角坐标系中;将指示三角形ΔABC各顶点坐标为:
A(0,0),B(cos∠A·lAB,sin∠A·lAB),C(lAC,0);
其中
Figure FDA0003327039140000043
待匹配三角形ΔA1iB1iC1i各顶点坐标为:
Figure FDA0003327039140000044
其中
Figure FDA0003327039140000045
计算ΔABC的质心
Figure FDA0003327039140000046
计算ΔA1iB1iC1i的质心
Figure FDA0003327039140000051
平移单元,对待匹配三角形ΔA1iB1iC1i平移(tx,ty),满足
Figure FDA0003327039140000052
使其与ΔABC的质心重合,得到新的三角形Δ′A1iB1iC1i
旋转单元,对Δ′A1iB1iC1i进行旋转得到的三角形与ΔABC覆盖面积最大,通过最优问题求解覆盖面积最大对应的旋转角度θ;
输出单元,计算旋转角度θ对应的覆盖面积作为待匹配三角形与指示三角形的最大覆盖面积。
10.根据权利要求9所述的基于组网测距三角形辅助的地磁定位系统,其特征在于,最佳匹配三角形选择模块,包括:
面积计算单元,计算各个待匹配三角形面积Si 匹配以及指示三角形面积S指示
Figure FDA0003327039140000053
Figure FDA0003327039140000054
其中
Figure FDA0003327039140000055
分别为A1iB1i,B1iC1i,C1iA1i的边长,lAB,lBC,lAC分别为AB、BC、AC三条边长;
最大面积提取单元,查找各个待匹配三角形面积Si 匹配与指示三角形面积S指示中的较大值作为Si max
匹配度计算单元,计算第i个待匹配三角形与指示三角形的匹配度:
Figure FDA0003327039140000061
Si 覆盖为第i个待匹配三角形与指示三角形的最大覆盖面积;
选择单元,选择匹配度最高的待匹配三角形作为最佳匹配三角形。
CN202111266105.8A 2021-10-28 2021-10-28 一种基于组网测距三角形辅助的地磁定位方法及系统 Active CN113884087B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111266105.8A CN113884087B (zh) 2021-10-28 2021-10-28 一种基于组网测距三角形辅助的地磁定位方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111266105.8A CN113884087B (zh) 2021-10-28 2021-10-28 一种基于组网测距三角形辅助的地磁定位方法及系统

Publications (2)

Publication Number Publication Date
CN113884087A true CN113884087A (zh) 2022-01-04
CN113884087B CN113884087B (zh) 2024-05-17

Family

ID=79014170

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111266105.8A Active CN113884087B (zh) 2021-10-28 2021-10-28 一种基于组网测距三角形辅助的地磁定位方法及系统

Country Status (1)

Country Link
CN (1) CN113884087B (zh)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104363650A (zh) * 2014-09-19 2015-02-18 西北大学 一种野外条件下无线传感器网络定位优化方法
CN105025572A (zh) * 2015-07-01 2015-11-04 太原科技大学 一种基于rssi测距的井下人员定位的改进方法
CN105636198A (zh) * 2015-12-16 2016-06-01 吉林大学 一种基于apit测试的无线传感器网络定位算法
US9764472B1 (en) * 2014-07-18 2017-09-19 Bobsweep Inc. Methods and systems for automated robotic movement
EP3438873A1 (en) * 2017-08-01 2019-02-06 LG Electronics Inc. Mobile terminal

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9764472B1 (en) * 2014-07-18 2017-09-19 Bobsweep Inc. Methods and systems for automated robotic movement
CN104363650A (zh) * 2014-09-19 2015-02-18 西北大学 一种野外条件下无线传感器网络定位优化方法
CN105025572A (zh) * 2015-07-01 2015-11-04 太原科技大学 一种基于rssi测距的井下人员定位的改进方法
CN105636198A (zh) * 2015-12-16 2016-06-01 吉林大学 一种基于apit测试的无线传感器网络定位算法
EP3438873A1 (en) * 2017-08-01 2019-02-06 LG Electronics Inc. Mobile terminal

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
相卫华;贾超;王华奎;孙高峰;: "无线传感器网络三维APIT网格化算法", 传感技术学报, no. 05, 15 May 2012 (2012-05-15), pages 639 - 643 *
赵军;裴庆祺;徐展琦;: "无线传感器网络近似三角形内点测试定位算法", 计算机工程, no. 05, 5 March 2007 (2007-03-05), pages 109 - 111 *

Also Published As

Publication number Publication date
CN113884087B (zh) 2024-05-17

Similar Documents

Publication Publication Date Title
CN108362281B (zh) 一种长基线水下潜艇匹配导航方法及系统
Wang et al. Intelligent vehicle self-localization based on double-layer features and multilayer LIDAR
US9037314B2 (en) UAV power line position and load parameter estimation
CN107451593B (zh) 一种基于图像特征点的高精度gps定位方法
CN106500674B (zh) 一种基于市政工程的测绘方法
US11543530B1 (en) Indoor SLAM method based on 3D lidar and UWB
CN102128625B (zh) 重力辅助惯性导航系统中重力图匹配的初始匹配方法
CN103791902B (zh) 适用于高机动载体的星敏感器自主导航方法
CN111426320B (zh) 一种基于图像匹配/惯导/里程计的车辆自主导航方法
CN110057354A (zh) 一种基于磁偏角修正的地磁匹配导航方法
CN202209953U (zh) 用于水下载体的地磁辅助惯性导航系统
CN102901485B (zh) 一种光电经纬仪快速自主定向的方法
CN104655135A (zh) 一种基于地标识别的飞行器视觉导航方法
CN114061591A (zh) 一种基于滑动窗数据回溯的等值线匹配方法
CN109459030A (zh) 一种基于地标的行人定位修正方法及系统
RU2571300C2 (ru) Способ дистанционного определения абсолютного азимута целевой точки
Wang et al. Land vehicle navigation using odometry/INS/vision integrated system
CN115930977A (zh) 特征退化场景的定位方法、系统、电子设备和可读存介质
Yan et al. A novel in-motion alignment method based on trajectory matching for autonomous vehicles
Yuan et al. Improved SITAN algorithm in the application of aided inertial navigation
Deng et al. Underwater map-matching aided inertial navigation system based on multi-geophysical information
WO2024120269A1 (zh) 一种融合点云地图、运动模型和局部特征的位置识别方法
CN113884087A (zh) 一种基于组网测距三角形辅助的地磁定位方法及系统
CN105204049A (zh) 一种基于三维转一维的载波相位整周模糊度搜索的定位方法
CN110531397B (zh) 基于gps与微波的室外巡检机器人定位系统及方法

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