CN110986923B - 一种地磁航向误差修正方法 - Google Patents
一种地磁航向误差修正方法 Download PDFInfo
- Publication number
- CN110986923B CN110986923B CN201911186599.1A CN201911186599A CN110986923B CN 110986923 B CN110986923 B CN 110986923B CN 201911186599 A CN201911186599 A CN 201911186599A CN 110986923 B CN110986923 B CN 110986923B
- Authority
- CN
- China
- Prior art keywords
- geomagnetic
- heading
- geomagnetic heading
- error correction
- error table
- 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
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/06—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving measuring of drift angle; involving correction for drift
-
- 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
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Navigation (AREA)
Abstract
本发明提供了一种地磁航向误差修正方法,所述方法包括:利用地磁传感器获取地磁航向ψM;建立地磁航向误差表,地磁航向误差表分为360段,分别与地磁航向ψM的0‑360°一一对应;在卫星导航接收机定向标志字有效的情况下,对地磁航向误差表进行更新,得到更新后的地磁航向误差表δψMi(i=1...360);对更新后的地磁航向误差表δψMi(i=1...360)进行平滑处理,得到平滑后的地磁航向误差表在卫星导航接收机定向标志字无效的情况下,基于平滑后的地磁航向误差表和地磁航向ψM获取修正后的地磁航向ψ。本发明的技术方案在卫星导航接收机定向标志字有效时对地磁航向误差进行建模,在卫星导航接收机定向标志字无效时利用所建立的地磁航向误差模型对地磁航向进行修正,从而保证航向精度。
Description
技术领域
本发明涉及组合导航技术领域,尤其涉及一种地磁航向误差修正方法。
背景技术
地磁航向传感器以其无累积误差的优点,成为低成本、低精度微机电惯导系统航向通道常用的辅助手段。为了克服周围磁场环境对地磁传感器的影响,通常需要对地磁传感器进行标定。然而,地磁传感器标定过程中的磁场分布与应用环境中的分布有明显差异,导致地磁传感器通常无法满足航向高精度要求。
发明内容
本发明提供了一种地磁航向误差修正方法,以解决地磁传感器无法满足航向高精度要求的技术问题。
为解决上述技术问题,本发明提出如下技术方案:
一种地磁航向误差修正方法,所述方法包括:
利用地磁传感器获取地磁航向ψM;
建立地磁航向误差表,地磁航向误差表分为360段,分别与地磁航向ψM的0-360°一一对应;
在卫星导航接收机定向标志字有效的情况下,对地磁航向误差表进行更新,得到更新后的地磁航向误差表δψMi(i=1...360);
优选的,所述对地磁航向误差表进行更新,得到更新后的地磁航向误差表δψMi(i=1...360)包括:
利用卫星导航接收机获取卫星航向ψG;
基于地磁航向ψM和卫星航向ψG获取地磁航向误差δψM;
确定地磁航向误差表中与地磁航向ψM对应的段数;
基于地磁航向ψM对应的段数获取上一时刻的地磁航向误差修正值δψMj,k-1;
基于地磁航向误差δψM和上一时刻的地磁航向误差修正值δψMj,k-1获取当前时刻的地磁航向误差修正值δψMj,k;
将当前时刻的地磁航向误差修正值δψMj,k更新到地磁航向误差表中,得到更新后的地磁航向误差表δψMi(i=1...360)。
优选的,通过下式获取当前时刻的地磁航向误差修正值δψMj,k:
δψMj,k=αδψMj,k-1+(1-α)δψM,
式中,α为滤波器平滑系数。
优选的,通过下式获取修正后的地磁航向ψ:
优选的,通过下式获取地磁航向误差δψM:
δψM=ψG-ψM。
式中,n为平滑窗口。
应用本发明的技术方案,在卫星导航接收机定向标志字有效时对地磁航向误差进行建模,在卫星导航接收机定向标志字无效时利用所建立的地磁航向误差模型对地磁航向进行修正,从而保证航向精度。
附图说明
所包括的附图用来提供对本发明实施例的进一步的理解,其构成了说明书的一部分,用于例示本发明的实施例,并与文字描述一起来阐释本发明的原理。显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1示出了根据本发明的实施例提供的地磁航向误差修正方法的流程示意图。
具体实施方式
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。以下对至少一个示例性实施例的描述实际上仅仅是说明性的,决不作为对本发明及其应用或使用的任何限制。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要注意的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本申请的示例性实施方式。如在这里所使用的,除非上下文另外明确指出,否则单数形式也意图包括复数形式,此外,还应当理解的是,当在本说明书中使用术语“包含”和/或“包括”时,其指明存在特征、步骤、操作、器件、组件和/或它们的组合。
除非另外具体说明,否则在这些实施例中阐述的部件和步骤的相对布置、数字表达式和数值不限制本发明的范围。同时,应当明白,为了便于描述,附图中所示出的各个部分的尺寸并不是按照实际的比例关系绘制的。对于相关领域普通技术人员已知的技术、方法和设备可能不作详细讨论,但在适当情况下,所述技术、方法和设备应当被视为授权说明书的一部分。在这里示出和讨论的所有示例中,任何具体值应被解释为仅仅是示例性的,而不是作为限制。因此,示例性实施例的其它示例可以具有不同的值。应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步讨论。
图1示出了根据本发明的实施例提供的地磁航向误差修正方法的流程示意图。
如图1所示,本发明实施例提供了一种地磁航向误差修正方法,所述方法包括:
S1、利用地磁传感器获取地磁航向ψM;
S2、建立地磁航向误差表,地磁航向误差表分为360段,分别与地磁航向ψM的0-360°一一对应;
S3、在卫星导航接收机定向标志字有效的情况下,对地磁航向误差表进行更新,得到更新后的地磁航向误差表δψMi(i=1...360);
本发明实施例中提供的地磁航向误差修正方法在卫星导航接收机定向标志字有效时对地磁航向误差进行建模,在卫星导航接收机定向标志字无效时利用所建立的地磁航向误差模型对地磁航向进行修正,从而保证航向精度。
本发明一种实施例所述的对地磁航向误差表进行更新,得到更新后的地磁航向误差表δψMi(i=1...360)包括:
S31、利用卫星导航接收机获取卫星航向ψG;
S32、基于地磁航向ψM和卫星航向ψG获取地磁航向误差δψM;
S33、确定地磁航向误差表中与地磁航向ψM对应的段数;
S34、基于地磁航向ψM对应的段数获取上一时刻的地磁航向误差修正值δψMj,k-1;
S35、基于地磁航向误差δψM和上一时刻的地磁航向误差修正值δψMj,k-1获取当前时刻的地磁航向误差修正值δψMj,k;
S36、将当前时刻的地磁航向误差修正值δψMj,k更新到地磁航向误差表中,得到更新后的地磁航向误差表δψMi(i=1...360)。
其中,地磁航向误差表中与地磁航向ψM对应的每一段有一个地磁航向误差修正值,上电初始时刻的地磁航向误差表中每一个地磁航向误差修正值均为0。通过对地磁航向ψM向下取整来确定地磁航向误差表中与地磁航向ψM对应的段数。
本发明一种实施例所述的S32中,通过下式获取地磁航向误差δψM:
δψM=ψG-ψM。
本发明一种实施例所述的地磁航向误差表更新过程中通过采用αβ滤波器来抑制瞬间测量噪声的影响,通过下式获取当前时刻的地磁航向误差修正值δψMj,k:
δψMj,k=αδψMj,k-1+(1-α)δψM,
式中,α为滤波器平滑系数。
式中,n为平滑窗口。
本发明一种实施例所述的S53中,通过下式获取修正后的地磁航向ψ:
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.一种地磁航向误差修正方法,其特征在于,所述方法包括:
利用地磁传感器获取地磁航向ψM;
建立地磁航向误差表,地磁航向误差表分为360段,分别与地磁航向ψM的0-360°一一对应;
在卫星导航接收机定向标志字有效的情况下,对地磁航向误差表进行更新,得到更新后的地磁航向误差表δψMi,i=1...360;
其中,所述对地磁航向误差表进行更新,得到更新后的地磁航向误差表δψMi,i=1...360包括:
利用卫星导航接收机获取卫星航向ψG;
基于地磁航向ψM和卫星航向ψG获取地磁航向误差δψM;
确定地磁航向误差表中与地磁航向ψM对应的段数;
基于地磁航向ψM对应的段数获取上一时刻的地磁航向误差修正值δψMj,k-1;
基于地磁航向误差δψM和上一时刻的地磁航向误差修正值δψMj,k-1获取当前时刻的地磁航向误差修正值δψMj,k;
将当前时刻的地磁航向误差修正值δψMj,k更新到地磁航向误差表中,得到更新后的地磁航向误差表δψMi,i=1...360;
式中,n为平滑窗口。
2.根据权利要求1所述的一种地磁航向误差修正方法,其特征在于,通过下式获取当前时刻的地磁航向误差修正值δψMj,k:
δψMj,k=αδψMj,k-1+(1-α)δψM,
式中,α为滤波器平滑系数。
5.根据权利要求1所述的一种地磁航向误差修正方法,其特征在于,通过下式获取地磁航向误差δψM:
δψM=ψG-ψM。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911186599.1A CN110986923B (zh) | 2019-11-28 | 2019-11-28 | 一种地磁航向误差修正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911186599.1A CN110986923B (zh) | 2019-11-28 | 2019-11-28 | 一种地磁航向误差修正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110986923A CN110986923A (zh) | 2020-04-10 |
CN110986923B true CN110986923B (zh) | 2023-06-13 |
Family
ID=70087641
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911186599.1A Active CN110986923B (zh) | 2019-11-28 | 2019-11-28 | 一种地磁航向误差修正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110986923B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112630807A (zh) * | 2020-11-24 | 2021-04-09 | 洛阳师范学院 | 一种地磁效应及卫星导航失灵时的自修正导航方法 |
CN112630808A (zh) * | 2020-11-26 | 2021-04-09 | 洛阳师范学院 | 一种用于地磁效应及卫星导航失灵时的修正导航系统 |
CN113985885B (zh) * | 2021-11-02 | 2024-01-19 | 珠海格力电器股份有限公司 | 设备作业控制方法、装置、计算机设备和存储介质 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1998048292A2 (en) * | 1997-01-31 | 1998-10-29 | Greenfield Enterprises, Inc. | Navigation system and method |
US8838403B2 (en) * | 2011-03-21 | 2014-09-16 | Broadcom Corporation | Method and system for a self-calibrated multi-magnetometer platform |
CN105651307A (zh) * | 2014-11-14 | 2016-06-08 | 中国航空工业第六八研究所 | 一种改善航姿系统航向精度和动态特性的方法 |
CN104913790B (zh) * | 2015-05-28 | 2017-11-28 | 北京航天控制仪器研究所 | 一种应用于动中通的惯导系统航向漂移误差闭环补偿方法 |
CN108957496A (zh) * | 2018-04-18 | 2018-12-07 | 广州市中海达测绘仪器有限公司 | Uav抗gnss失效定位定向接收机及其应用方法 |
-
2019
- 2019-11-28 CN CN201911186599.1A patent/CN110986923B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110986923A (zh) | 2020-04-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110986923B (zh) | 一种地磁航向误差修正方法 | |
RU2662460C1 (ru) | Способ обновления углового положения сельскохозяйственной машины, основанный на девятиосевом датчике на основе мэмс | |
CN108507568B (zh) | 补偿温度漂移误差的方法、装置和组合导航系统 | |
JP2009098125A (ja) | 動的に較正されるセンサデータと、ナビゲーションシステム内の繰り返し拡張カルマンフィルタとを使用する、ジャイロコンパスの整合用のシステム及び方法 | |
TW201411096A (zh) | 用於一三軸磁力計及一三軸加速度計之資料融合之方法及設備 | |
KR101698682B1 (ko) | 지자기 센서의 출력값을 보정하는 방법 및 장치 | |
CN107870001A (zh) | 一种基于椭球拟合的磁力计校正方法 | |
CN107339987B (zh) | 一种基于函数迭代积分的刚体姿态解算方法 | |
JP2013181985A (ja) | 転送アライメントの間、マスターナビゲーション・システム・リセットを組み込むシステム及び方法 | |
US9534926B2 (en) | Method for the autonomous calibration of an inertial rig used in static mode | |
CN109470266A (zh) | 一种处理乘性噪声的星敏感器陀螺组合定姿方法 | |
CN114858189A (zh) | 捷联惯导系统陀螺漂移等效补偿方法 | |
CN116817896B (zh) | 一种基于扩展卡尔曼滤波的姿态解算方法 | |
KR101741076B1 (ko) | 관성항법시스템의 시간지연 보상 장치 및 그 방법 | |
CN108955671A (zh) | 一种基于磁偏角、磁倾角的卡尔曼滤波导航方法 | |
CN111307114B (zh) | 基于运动参考单元的水面舰船水平姿态测量方法 | |
CN113916222A (zh) | 基于卡尔曼滤波估计方差约束的组合导航方法 | |
Gheorghe | Calibration for tilt-compensated electronic compasses with alignment between the magnetometer and accelerometer sensor reference frames | |
CN105509703B (zh) | 用于旋转弹的横滚角的计算方法 | |
CN113375693B (zh) | 一种地磁航向误差修正方法 | |
WO2015057074A1 (en) | Adjusted navigation | |
CN108692727B (zh) | 一种带有非线性补偿滤波器的捷联惯导系统 | |
CN111457913B (zh) | 交通工具导航数据融合方法、装置和系统 | |
CN114994352B (zh) | 一种高速旋转制导炮弹转速测量方法 | |
CN116399368A (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 |