CN107631723B - 一种电磁罗经自动消磁补偿的方法 - Google Patents
一种电磁罗经自动消磁补偿的方法 Download PDFInfo
- Publication number
- CN107631723B CN107631723B CN201710860131.0A CN201710860131A CN107631723B CN 107631723 B CN107631723 B CN 107631723B CN 201710860131 A CN201710860131 A CN 201710860131A CN 107631723 B CN107631723 B CN 107631723B
- Authority
- CN
- China
- Prior art keywords
- self
- error
- electromagnetic compass
- compensation
- parameter
- 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
Abstract
本发明公开了一种电磁罗经自动消磁补偿的方法,包括如下步骤:1)电磁罗经开机,系统初始化;2)电磁罗经根据输入控制信号,判断是否进行自差补偿;3)自差补偿,判断船体是否处于消磁状态;自差补偿完成后,进入4)航向解算;4)航向解算,根据Z轴磁通量N,判断是否|N|>=XC:是,提取非消磁状态的自差补偿误差参数L2,b2,进行自差校正,输出航向;否,提取消磁状态的自差补偿误差参数L1,b1,进行自差校正,输出航向。本发明能够自动识别船体消磁状态,无需依赖任何外部消磁补偿设备,设备独立性好,操作简单。
Description
技术领域
本发明涉及船用导航技术领域,尤其涉及一种电磁罗经自动消磁补偿的方法。
背景技术
由于地磁场具有长期稳定的优点,利用磁通门原理测量地磁分量,通过解算得到载体航向的设备,相比利用各型陀螺仪作为核心测量单元的航向设备来说,具有高稳定、高可靠、无漂移、低成本的优点,适用于载体航向备份和应急处理。在船体开启和不开启消磁系统时,硬磁环境发生较大变化,对电磁罗经精度影响较大,导致电磁罗经输出航向有较大的不准确性。因而如何消除消磁对磁罗经的干扰问题是电磁罗经的关键技术。
传统电磁罗经硬磁补偿采用磁棒的方式来调试消除船体的硬磁干扰,保证电磁罗经的精度,此方法无法应对船体消磁系统开启时保证电磁罗经精度不受影响的问题,且操作复杂;或利用消磁系统的消磁补偿单元提供的电信号,设备独立性差,成本高,且算法复杂。
发明内容
针对现有技术存在的上述不足,本发明的目的在于提供一种电磁罗经自动消磁补偿的方法,能够自动识别船体消磁状态,无需依赖任何外部消磁补偿设备,设备独立性好,操作简单。
为了解决上述技术问题,本发明采用的技术方案是这样的:一种电磁罗经自动消磁补偿的方法,其特征在于:包括如下步骤:
1)电磁罗经开机,系统初始化;
2)电磁罗经根据输入控制信号,判断是否进行自差补偿:是,进入3)自差补偿;否,进入4)航向解算;
3)自差补偿,电磁罗经根据输入控制信号判断船体是否处于消磁状态;
是,初始化消磁状态下的自差参数L1=0,b1=0,重新采集电磁罗经原始数据,解算电磁罗经的自差补偿参数L1,b1,并记录电磁罗经Z轴磁通量N1,更新存储参数L1、b1、N1;
否,初始化非消磁状态下的自差参数L2=0,b2=0,重新采集电磁罗经原始数据,解算电磁罗经的自差补偿参数L2,b2,并记录电磁罗经Z轴磁通量N2,更新存储参数L2、b2、N2;
然后,计算平均磁通量XC=|(N1+N2)/2|,并更新XC;
自差补偿完成后,进入4)航向解算;
4)航向解算,根据Z轴磁通量N,判断是否|N| >=XC:
是,提取非消磁状态的自差补偿误差参数L2,b2,进行自差校正,输出航向;
否,提取消磁状态的自差补偿误差参数L1,b1,进行自差校正,输出航向。
进一步地,所述自差校正过程如下:
首先,通过电磁罗经检测在水平面圆周上均布的16个位置的航向角ψ(i),i=1…16;
然后,将航向角ψ(i)与真值比较,提取自差补偿误差参数b1[7]或b2[7],解算航向误差zc:
zc(i)=b11+b12sinψ(i)+b13cosψ(i)+b14sin2ψ(i)+b15cos2ψ(i)
+0.3b16sin4ψ(i)+0.3b17cos4ψ(i);
或者:
zc(i)=b21+b22sinψ(i)+b23cosψ(i)+b24sin2ψ(i)+b25cos2ψ(i)
+0.3b26sin4ψ(i)+0.3b27cos4ψ(i);
最后,根据航向误差zc解算载体磁航向angle:
angle(i) = ψ(i)+ zc(i)。
本发明主要从两个方面解决自动消除船体消磁影响的问题,一是船体消磁状态和非消磁状态对电磁罗经的影响主要表征为垂直磁场的变化,也即硬磁干扰的变化,在两种状态下垂直磁场磁通量有很明显变化,因此本技术方案通过电磁罗经自带的Z轴(与船体甲板平面垂直,感应垂直磁场)磁通量大小来自动判断船体是否为消磁状态;二是基于船体消磁或非消磁状态为同一时间段的恒态;在相同的状态下,垂直磁场是恒定不变的,也即硬磁环境恒定,此时硬磁对地磁影响是可标定可控制的。因此本方案通过在两种状态下分别进行自差补偿的方式,保证电磁罗经在船体消磁和非消磁两种状态下保证精度;并通过Z轴(与船体甲板平面垂直,感应垂直磁场)磁通量大小来自动选择自差补偿参数。
与现有技术相比,本发明具有如下优点:1.自动识别船体消磁状态,无需依赖任何外部消磁补偿设备,设备独立性好。2.采用软件方式自动进行消磁补偿,不增加任何设备,便于设备小型化,降低设备成本,且操作简单,使用方便。
附图说明
图1为本发明的工作流程图。
具体实施方式
下面将结合附图及实施例对本发明作进一步说明。
实施例:参见图1,一种电磁罗经自动消磁补偿的方法,包括如下步骤:
1)电磁罗经开机,系统初始化。
2)电磁罗经根据输入控制信号,判断是否进行自差补偿:是,进入3)自差补偿;否,进入4)航向解算。
3)自差补偿,电磁罗经根据输入控制信号判断船体是否处于消磁状态;
是,初始化消磁状态下的自差参数L1=0,b1=0,重新采集电磁罗经原始数据,解算电磁罗经的自差补偿参数L1,b1,并记录电磁罗经Z轴磁通量N1,更新存储参数L1、b1、N1。
否,初始化非消磁状态下的自差参数L2=0,b2=0,重新采集电磁罗经原始数据,解算电磁罗经的自差补偿参数L2,b2,并记录电磁罗经Z轴磁通量N2,更新存储参数L2、b2、N2。
然后,计算平均磁通量XC=|(N1+N2)/2|,并更新XC;
自差补偿完成后,进入4)航向解算。
4)航向解算,根据Z轴磁通量N,判断是否|N| >=XC:
是,提取非消磁状态的自差补偿误差参数L2,b2,进行自差校正,输出航向;
否,提取消磁状态的自差补偿误差参数L1,b1,进行自差校正,输出航向。
其中,所述自差校正过程如下:
首先,通过电磁罗经检测在水平面圆周上均布的16个位置的航向角ψ(i),i=1…16;
然后,将航向角ψ(i)与真值比较,提取自差补偿误差参数b1[7]或b2[7],解算航向误差zc:
zc(i)=b11+b12sinψ(i)+b13cosψ(i)+b14sin2ψ(i)+b15cos2ψ(i)
+0.3b16sin4ψ(i)+0.3b17cos4ψ(i);
或者:
zc(i)=b21+b22sinψ(i)+b23cosψ(i)+b24sin2ψ(i)+b25cos2ψ(i)
+0.3b26sin4ψ(i)+0.3b27cos4ψ(i);
最后,根据航向误差zc解算载体磁航向angle:
angle(i) = ψ(i)+ zc(i)。
最后需要说明的是,以上实施例仅用以说明本发明的技术方案而非限制技术方案,本领域的普通技术人员应当理解,那些对本发明的技术方案进行修改或者等同替换,而不脱离本技术方案的宗旨和范围,均应涵盖在本发明的权利要求范围当中。
Claims (2)
1.一种电磁罗经自动消磁补偿的方法,包括如下步骤:
1)电磁罗经开机,系统初始化;
2)电磁罗经根据输入控制信号,判断是否进行自差补偿:是,进入3)自差补偿;否,进入4)航向解算;其特征在于:
3)自差补偿,电磁罗经根据输入控制信号判断船体是否处于消磁状态;
是,初始化消磁状态下的自差参数L1=0,b1=0,重新采集电磁罗经原始数据,解算电磁罗经的自差补偿参数L1,b1,并记录电磁罗经Z轴磁通量N1,更新存储参数L1、b1、N1;
否,初始化非消磁状态下的自差参数L2=0,b2=0,重新采集电磁罗经原始数据,解算电磁罗经的自差补偿参数L2,b2,并记录电磁罗经Z轴磁通量N2,更新存储参数L2、b2、N2;
然后,计算平均磁通量XC=|(N1+N2)/2|,并更新XC;
自差补偿完成后,进入4)航向解算;
4)航向解算,根据Z轴磁通量N,判断是否|N| >=XC:
是,提取非消磁状态的自差补偿误差参数L2,b2,进行自差校正,输出航向;
否,提取消磁状态的自差补偿误差参数L1,b1,进行自差校正,输出航向。
2.根据权利要求1所述的一种电磁罗经自动消磁补偿的方法,其特征在于:所述自差校正过程如下:
首先,通过电磁罗经检测在水平面圆周上均布的16个位置的航向角ψ(i),i=1…16;
然后,将航向角ψ(i)与真值比较,提取自差补偿误差参数b1[7]或b2[7],解算航向误差zc:
zc(i)=b11+b12sinψ(i)+b13cosψ(i)+b14sin2ψ(i)+b15cos2ψ(i)
+0.3b16sin4ψ(i)+0.3b17cos4ψ(i);
或者:
zc(i)=b21+b22sinψ(i)+b23cosψ(i)+b24sin2ψ(i)+b25cos2ψ(i)
+0.3b26sin4ψ(i)+0.3b27cos4ψ(i);
最后,根据航向误差zc解算载体磁航向angle:
angle(i) = ψ(i)+ zc(i)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710860131.0A CN107631723B (zh) | 2017-09-21 | 2017-09-21 | 一种电磁罗经自动消磁补偿的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710860131.0A CN107631723B (zh) | 2017-09-21 | 2017-09-21 | 一种电磁罗经自动消磁补偿的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107631723A CN107631723A (zh) | 2018-01-26 |
CN107631723B true CN107631723B (zh) | 2020-01-03 |
Family
ID=61103147
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710860131.0A Expired - Fee Related CN107631723B (zh) | 2017-09-21 | 2017-09-21 | 一种电磁罗经自动消磁补偿的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107631723B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109059960B (zh) * | 2018-07-18 | 2021-08-31 | 福州大学 | 一种三维电子指南针的校准方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013117442A (ja) * | 2011-12-02 | 2013-06-13 | Fujikura Ltd | 方位誤差補償装置、方位誤差補償方法、方位誤差補償プログラム、誤差角度補償装置、3軸磁気センサ及びセンサモジュール |
CN104296776A (zh) * | 2013-07-15 | 2015-01-21 | 霍尼韦尔国际公司 | 用于磁力计校准和补偿的系统和方法 |
CN105091872A (zh) * | 2014-05-12 | 2015-11-25 | 中兴通讯股份有限公司 | 一种电子指南针消除干扰方法及装置 |
-
2017
- 2017-09-21 CN CN201710860131.0A patent/CN107631723B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013117442A (ja) * | 2011-12-02 | 2013-06-13 | Fujikura Ltd | 方位誤差補償装置、方位誤差補償方法、方位誤差補償プログラム、誤差角度補償装置、3軸磁気センサ及びセンサモジュール |
CN104296776A (zh) * | 2013-07-15 | 2015-01-21 | 霍尼韦尔国际公司 | 用于磁力计校准和补偿的系统和方法 |
CN105091872A (zh) * | 2014-05-12 | 2015-11-25 | 中兴通讯股份有限公司 | 一种电子指南针消除干扰方法及装置 |
Non-Patent Citations (2)
Title |
---|
测量船磁罗经自差校正技术研究;杨洋 等;《船海工程》;20150228;第44卷(第1期);第131-133页 * |
磁罗经自差自动测定和补偿系统的研制;关政军 等;《大连海事大学学报》;20041130;第30卷(第4期);第14-15页 * |
Also Published As
Publication number | Publication date |
---|---|
CN107631723A (zh) | 2018-01-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR102029823B1 (ko) | 지자기 센서 오차 보정 장치 및 지자기 센서 오차 보정 방법 | |
TWI584157B (zh) | 移動設備及求取移動設備姿態之方法 | |
US9025856B2 (en) | Robot control information | |
CN106814753B (zh) | 一种目标位置矫正方法、装置及系统 | |
CN103299247B (zh) | 用于磁近场的动态追踪及补偿的设备和方法 | |
JP2005164564A (ja) | 電子コンパスの自動補正方法 | |
US10746819B2 (en) | Correcting field distortion in electromagnetic position tracking systems | |
CN107167131B (zh) | 一种微惯性测量信息的深度融合与实时补偿的方法及系统 | |
WO2018233601A1 (zh) | 方位角校准方法、装置、存储介质和计算机设备 | |
CN106918352A (zh) | 一种手持式mems磁力计的航向校正方法 | |
CN112762965B (zh) | 一种磁力计校准方法以及装置 | |
CN109470239B (zh) | 磁场补偿方法,相关装置及计算机程序 | |
CN104767927A (zh) | 一种对云台摄像设备进行方位控制的方法和装置 | |
CN107631723B (zh) | 一种电磁罗经自动消磁补偿的方法 | |
JP2008128649A (ja) | 方位センサおよび記録媒体 | |
US20160349078A1 (en) | Gyroscope stabilizer filter | |
JP2007163388A (ja) | 方位センサおよび記録媒体 | |
CN106092140B (zh) | 一种陀螺仪零偏估计方法 | |
KR101752724B1 (ko) | 관성항법장치의 정렬 방법 | |
CN104236533A (zh) | 一种陀螺仪数据融合方法 | |
CN106643705B (zh) | 基于磁-陀螺航向梯度空间辅助的室内行人转弯辨识方法 | |
CN108240807B (zh) | 估计空间占据的方法 | |
CN109990776B (zh) | 一种姿态测量方法及装置 | |
CN111982155B (zh) | 磁传感器的标定方法、装置、电子设备和计算机存储介质 | |
CN108111173A (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200103 |