CN112050804A - 一种基于地磁梯度的近场磁图构建方法 - Google Patents
一种基于地磁梯度的近场磁图构建方法 Download PDFInfo
- Publication number
- CN112050804A CN112050804A CN202010760896.9A CN202010760896A CN112050804A CN 112050804 A CN112050804 A CN 112050804A CN 202010760896 A CN202010760896 A CN 202010760896A CN 112050804 A CN112050804 A CN 112050804A
- Authority
- CN
- China
- Prior art keywords
- geomagnetic
- gradient
- information
- grad
- field magnetic
- 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
- 238000010276 construction Methods 0.000 title claims abstract description 12
- 238000000034 method Methods 0.000 claims abstract description 14
- 238000004364 calculation method Methods 0.000 claims abstract description 12
- 238000005070 sampling Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 2
- 230000002441 reversible effect Effects 0.000 claims description 2
- 230000005358 geomagnetic field Effects 0.000 description 5
- 230000000875 corresponding effect Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000002596 correlated effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
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/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
-
- 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)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Navigation (AREA)
Abstract
一种基于地磁梯度的近场磁图构建策略,包括以下步骤:步骤1:测量起始位置处的地磁信息,使潜航器根据任意两个不同的航向角的正常行进,分别测量两点的地磁信息,利用地磁梯度计算中对应信息;步骤2:结合当前点地磁信息,通过地磁参量预测公式构建近场磁图;步骤3:根据不同导航要求,选取合适的航向角进行前进,到达下一个位置后,测量该位置处的地磁信息;步骤4:根据当前点地磁信息,结合先前两点的地磁信息,利用地磁梯度计算,完成梯度的更新;步骤5:循环进行步骤2至步骤4,直到潜航器完成导航目的。本申请方法通过借助历史信息计算地磁梯度并实时更新,从而构建近场磁图,具有计算量小,实时性和可靠性高的特点。
Description
技术领域
本发明属于无先验磁图导航领域,涉及一种基于地磁梯度的近场磁图构建方法。
背景技术
目前地磁导航中,磁图匹配技术发展得相对成熟,但该技术需要有准确的地磁图作为参考,地磁场环境的时变性导致了地磁图的信息缺乏一定的准确性。同时,地磁图的构建需要大量的测量点及数据,这为每一次地磁图的更新带来了极大的挑战。因此,大量研究者开始研究无先验磁图下的地磁导航技术。该技术只需要给定目的地磁场矢量,不需要完整磁图,即可使潜航器到达目的地。由于潜航器只能采样到当前位置的地磁信息,因此需要借助磁梯度实时构建近场磁图,就能够准确预测下一个位置的地磁信息,从而完成最优航向角的计算,引导潜航器快速到达目的地。目前仅有安振昌通过高斯理论和地磁场模型给出了地磁梯度的理论计算公式,由于地球磁场的多变性,该理论计算公式难以应用于实际导航中,如果根据历史信息计算地磁梯度并实时更新则可以得到最新的地磁情况,则可以更加准确的进行相应的导航。
发明内容
针对以上问题,本发明提供一种基于地磁梯度的近场磁图构建方法,在无先验地磁导航中,潜航器只能检测到当前位置的磁信息,而难以提前获得下一个位置的磁信息。该方法通过借助历史信息计算地磁梯度并实时更新,从而构建近场磁图,具有计算量小,实时性和可靠性高的特点,且不会产生累计误差,可应用于实际地磁导航中,相对误差趋近于0,本专利提供一种基于地磁梯度的近场磁图构建策略,包括以下步骤:
步骤1:测量起始位置处的地磁信息(D0 I0),使潜航器根据任意两个不同的航向角θ1,θ2的正常行进,两个航向角大小必须不一致,保证地磁梯度的计算公式中矩阵可逆,分别测量两点的地磁信息为(D1 I1),(D2 I2),利用地磁梯度计算出 grad(D(x1,y1)),grad(I(x1,y1));
步骤3:根据不同导航要求,选取合适的航向角进行前进,到达下一个位置后,测量该位置处的地磁信息(D3 I3);
步骤4:根据当前点地磁信息(D3 I3),结合先前两点的地磁信息(D2 I2),(D1 I1),利用地磁梯度计算grad(D(x2,y2)),grad(I(x2,y2)),完成梯度的更新,更新地磁梯度时,不再参考之前的地磁梯度,避免了累计误差的产生;
步骤5:循环进行步骤2至步骤4,直到潜航器完成导航目的,每次循环必须保留近2次的航向角和地磁参量值,用于步骤4中的梯度更新。
作为本发明进一步改进,步骤一中地磁参量的预测公式为:
Mk+1=Mk+dMk=Mk+grad(M(xk,yk))(cosθk sinθk)×λ
地磁梯度的计算与更新公式为:
其中,M为任意的地磁参量,grad(M(xk,yk)),grad(M(xk+1,yk+1))分别为地磁参量M在k和 k+1位置处的梯度,Mk+2,Mk+1,Mk分别为在k、k+1、k+2位置处地磁参量M的值,θk,θk+1分别为在k和k+1位置处的行进航向角,xk,yk对应位置处的经纬度坐标值,λ为步长,实际中可由潜航器的速度与采样周期相乘计算得到。
本发明与现有技术相比的优点在于:当前的梯度计算公式是通过高斯理论和地磁场模型给出的,无法应对地球磁场的多变性,难以应用于实际导航中,使得研究大多停留在仿真中。本发明通过借助历史信息计算地磁梯度并实时更新,从而构建近场磁图,辅助最优航向角的计算,引导潜航器快速到达目的地。本发明提供的梯度计算更新公式具有计算量小,能够满足系统的实时性,在地磁场多变的情况下,也可准确测量出当前位置的磁场梯度,可靠性高。基于以上优点,本发明可较好地应用于实时地磁导航中。
附图说明
图1为不更新梯度的前提下,3000次的地磁预测值与实际值的对比图;
图2为不更新梯度的前提下,图1在第2900至3000次的局部放大图;
图3为不更新梯度的前提下,3000次地磁预测值与实际值的相对误差绝对值曲线图;
图4为更新梯度的前提下,3000次的地磁预测值与实际值的对比图;
图5为更新梯度的前提下,图4在第2900至3000次的局部放大图;
图6为更新梯度的前提下,3000次地磁预测值与实际值的相对误差绝对值曲线图。
具体实施方式
下面结合附图与具体实施方式对本发明作进一步详细描述:
本发明提供一种基于地磁梯度的近场磁图构建方法,在无先验地磁导航中,潜航器只能检测到当前位置的磁信息,而难以提前获得下一个位置的磁信息。该方法通过借助历史信息计算地磁梯度并实时更新,从而构建近场磁图,具有计算量小,实时性和可靠性高的特点,且不会产生累计误差,可应用于实际地磁导航中,相对误差趋近于0。
本发明提供一种基于地磁梯度的近场磁图构建方法,主要选取地磁参量磁偏角D和磁倾角I作为导航参量进行分析。
其中地磁参量的预测如下;
首先给出磁偏角D和磁倾角I的全微分形式如下:
当潜航器步长较小时,地磁梯度几乎无变化,给定任意航向角θ,结合当前位置k的地磁信息Dk和Ik,通过以下地磁参量预测公式,可以对该航向角所对应的下一个位置k+1的地磁信息Dk+1和Ik+1进行预测,即可得到近场磁图:
Dk+1=Dk+dDk=Dk+grad(D(xk,yk))(cosθk sinθk)×λ
Ik+1=Ik+dIk=Ik+grad(I(xk,yk))(cosθk sinθk)×λ
其中,λ为潜航器的运动步长,实际中可由潜航器的速度与采样周期相乘计算得到。
地磁梯度的计算与更新如下;
假设初始位置的地磁参量为D0,使潜航器根据两个不同的航向角θ1,θ2进行前行,分别测得途径两点位置的地磁参量为D1,D2,由于步长较小时,地磁梯度基本无变化,可知
grad(D(x0,y0))≈grad(D(x1,y1))
结合地磁参量预测公式可以得到:
D1=D0+dD0=D0+grad(D(x0,y0))·(cosθ1 sinθ1)×λ
D2=D1+dD0=D1+grad(D(x1,y1))·(cosθ2 sinθ2)×λ
由于航向角θ1,θ2不同,则上述两个方程为线性非相关,能够很容易求出地磁梯度
同理可以计算出
本申请具体流程实施方式如下;
步骤1:给定初始位置坐标x0=2°E,y0=2°N,步长设置为λ=0.01,两个不同的航向角θ1=40°,θ2=50°,迭代次数设置为3000,测得初始位置磁偏角D0,根据θ1行进至下一个位置,测得磁偏角D1,根据θ1行进至下一个位置,测得磁偏角D2,将θ1,θ2,D0,D1,D2代入地磁参量预测公式,可以计算出grad(D(x1,y1));
步骤2:令grad(D(x2,y2))=grad(D(x1,y1)),结合当前点地磁信息D2,通过地磁参量预测公式构建近场磁图;
步骤3:随机选取0~90°的航向角进行,到达下一个位置后,测量该位置处的地磁信息D3;
步骤4:根据当前点地磁信息D3,结合先前两个位置的地磁信息D1,D2,利用地磁参量预测公式计算grad(D(x2,y2)),完成梯度的更新;
步骤5:循环进行步骤2至步骤4,直到循环次数满3000为止。
通过仿真结果可以得出,使用该方法进行3000次梯度更新及地磁参量预测后,地磁参量的预测值与实际值之间的标准差为:标准差为:6.172e-07,相对误差绝对值的最大值为: 0.92961%,结果展示为图1~6。仿真结果证明,该方法产生的误差较小,且不会产生累积误差。而实际情况下的步长系数远远小于0.01,因此在实际应用中该方法产生的误差可忽略不计。
以上所述,仅是本发明的较佳实施例而已,并非是对本发明作任何其他形式的限制,而依据本发明的技术实质所作的任何修改或等同变化,仍属于本发明所要求保护的范围。
Claims (2)
1.一种基于地磁梯度的近场磁图构建策略,其特征在于:包括以下步骤:
步骤1:测量起始位置处的地磁信息(D0 I0),使潜航器根据任意两个不同的航向角θ1,θ2的正常行进,两个航向角大小必须不一致,保证地磁梯度的计算公式中矩阵可逆,分别测量两点的地磁信息为(D1 I1),(D2 I2);
利用地磁梯度计算出grad(D(x1,y1)),grad(I(x1,y1));
步骤3:根据不同导航要求,选取合适的航向角进行前进,到达下一个位置后,测量该位置处的地磁信息(D3 I3);
步骤4:根据当前点地磁信息(D3 I3),结合先前两点的地磁信息(D2 I2),(D1 I1),利用地磁梯度计算grad(D(x2,y2)),grad(I(x2,y2)),完成梯度的更新,更新地磁梯度时,不再参考之前的地磁梯度,避免了累计误差的产生;
步骤5:循环进行步骤2至步骤4,直到潜航器完成导航目的,每次循环必须保留近2次的航向角和地磁参量值,用于步骤4中的梯度更新。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010760896.9A CN112050804B (zh) | 2020-07-31 | 2020-07-31 | 一种基于地磁梯度的近场磁图构建方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010760896.9A CN112050804B (zh) | 2020-07-31 | 2020-07-31 | 一种基于地磁梯度的近场磁图构建方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112050804A true CN112050804A (zh) | 2020-12-08 |
CN112050804B CN112050804B (zh) | 2022-04-08 |
Family
ID=73602019
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010760896.9A Active CN112050804B (zh) | 2020-07-31 | 2020-07-31 | 一种基于地磁梯度的近场磁图构建方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112050804B (zh) |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003065792A (ja) * | 2001-08-24 | 2003-03-05 | Japan Science & Technology Corp | 地磁気式進行方向決定方法、地磁気式移動体移動方法及び地磁気式進行方向決定装置 |
CN104019813A (zh) * | 2014-06-19 | 2014-09-03 | 无锡知谷网络科技有限公司 | 目标即时定位和构建地图的方法与系统 |
CN104697523A (zh) * | 2015-03-31 | 2015-06-10 | 哈尔滨工业大学 | 基于迭代计算的惯性/地磁匹配定位方法 |
CN105716610A (zh) * | 2016-01-28 | 2016-06-29 | 北京航空航天大学 | 一种地磁场模型辅助的载体姿态和航向计算方法和系统 |
CN106370189A (zh) * | 2016-12-02 | 2017-02-01 | 华中科技大学 | 一种基于多传感器融合的室内导航装置及方法 |
CN109341723A (zh) * | 2018-11-22 | 2019-02-15 | 东南大学 | 一种基于地磁信息熵和相似性度量的综合地磁匹配方法 |
CN109387196A (zh) * | 2018-09-12 | 2019-02-26 | 河海大学常州校区 | 一种远距离水下地磁仿生导航方法 |
CN109724592A (zh) * | 2019-03-03 | 2019-05-07 | 西北工业大学 | 一种基于进化梯度搜索的auv地磁仿生导航方法 |
CN109813304A (zh) * | 2019-03-25 | 2019-05-28 | 西北工业大学 | 一种基于进化策略的分段搜索地磁仿生导航方法 |
CN110196045A (zh) * | 2019-06-23 | 2019-09-03 | 西北工业大学 | 一种基于栅格特征的梯度下降地磁导航方法 |
CN110849355A (zh) * | 2019-10-25 | 2020-02-28 | 东南大学 | 一种地磁多参量多目标快速收敛的仿生导航方法 |
CN111307143A (zh) * | 2020-02-17 | 2020-06-19 | 东南大学 | 基于地磁梯度辅助的多目标进化搜索的仿生导航算法 |
-
2020
- 2020-07-31 CN CN202010760896.9A patent/CN112050804B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003065792A (ja) * | 2001-08-24 | 2003-03-05 | Japan Science & Technology Corp | 地磁気式進行方向決定方法、地磁気式移動体移動方法及び地磁気式進行方向決定装置 |
CN104019813A (zh) * | 2014-06-19 | 2014-09-03 | 无锡知谷网络科技有限公司 | 目标即时定位和构建地图的方法与系统 |
CN104697523A (zh) * | 2015-03-31 | 2015-06-10 | 哈尔滨工业大学 | 基于迭代计算的惯性/地磁匹配定位方法 |
CN105716610A (zh) * | 2016-01-28 | 2016-06-29 | 北京航空航天大学 | 一种地磁场模型辅助的载体姿态和航向计算方法和系统 |
CN106370189A (zh) * | 2016-12-02 | 2017-02-01 | 华中科技大学 | 一种基于多传感器融合的室内导航装置及方法 |
CN109387196A (zh) * | 2018-09-12 | 2019-02-26 | 河海大学常州校区 | 一种远距离水下地磁仿生导航方法 |
CN109341723A (zh) * | 2018-11-22 | 2019-02-15 | 东南大学 | 一种基于地磁信息熵和相似性度量的综合地磁匹配方法 |
CN109724592A (zh) * | 2019-03-03 | 2019-05-07 | 西北工业大学 | 一种基于进化梯度搜索的auv地磁仿生导航方法 |
CN109813304A (zh) * | 2019-03-25 | 2019-05-28 | 西北工业大学 | 一种基于进化策略的分段搜索地磁仿生导航方法 |
CN110196045A (zh) * | 2019-06-23 | 2019-09-03 | 西北工业大学 | 一种基于栅格特征的梯度下降地磁导航方法 |
CN110849355A (zh) * | 2019-10-25 | 2020-02-28 | 东南大学 | 一种地磁多参量多目标快速收敛的仿生导航方法 |
CN111307143A (zh) * | 2020-02-17 | 2020-06-19 | 东南大学 | 基于地磁梯度辅助的多目标进化搜索的仿生导航算法 |
Non-Patent Citations (1)
Title |
---|
刘明雍等: "基于时序进化搜索策略的地磁仿生导航研究", 《西北工业大学学报》 * |
Also Published As
Publication number | Publication date |
---|---|
CN112050804B (zh) | 2022-04-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Kim et al. | Indoor positioning system using geomagnetic anomalies for smartphones | |
CN106979780B (zh) | 一种无人车实时姿态测量方法 | |
CN104019813B (zh) | 目标即时定位和构建地图的方法与系统 | |
CN104061932B (zh) | 一种利用引力矢量和梯度张量进行导航定位的方法 | |
CN103369466B (zh) | 一种地图匹配辅助室内定位方法 | |
CN104697523B (zh) | 基于迭代计算的惯性/地磁匹配定位方法 | |
CN105823480A (zh) | 基于单信标的水下移动目标定位算法 | |
CN110208792A (zh) | 同时估计目标状态和轨迹参数的任意直线约束跟踪方法 | |
CN105091907B (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
CN103344260B (zh) | 基于rbckf的捷联惯导系统大方位失准角初始对准方法 | |
CN109059964B (zh) | 一种基于“重力峰”的惯性导航与重力测量双校准方法 | |
CN109556631A (zh) | 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法 | |
CN109507706B (zh) | 一种gps信号丢失的预测定位方法 | |
CN103869379A (zh) | 基于遗传算法优化改进bp神经网络的磁力计校正方法 | |
CN104535080B (zh) | 大方位失准角下基于误差四元数的传递对准方法 | |
CN114061591B (zh) | 一种基于滑动窗数据回溯的等值线匹配方法 | |
CN108020813A (zh) | 定位方法、定位装置和电子设备 | |
CN111397599A (zh) | 基于三角形匹配算法改进的iccp水下地磁匹配方法 | |
CN109945895A (zh) | 基于渐消平滑变结构滤波的惯性导航初始对准方法 | |
CN111121758B (zh) | 室内磁地图的快速建模与可信定位方法 | |
CN110736484B (zh) | 基于陀螺仪及磁传感器融合的背景磁场标定方法 | |
CN109855623A (zh) | 基于Legendre多项式和BP神经网络的地磁模型在线逼近方法 | |
CN112729332B (zh) | 一种基于旋转调制的对准方法 | |
CN112050804B (zh) | 一种基于地磁梯度的近场磁图构建方法 | |
CN109387196B (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 |