CN117537792B - 电子罗盘自适应方位角矫正方法 - Google Patents
电子罗盘自适应方位角矫正方法 Download PDFInfo
- Publication number
- CN117537792B CN117537792B CN202410006208.8A CN202410006208A CN117537792B CN 117537792 B CN117537792 B CN 117537792B CN 202410006208 A CN202410006208 A CN 202410006208A CN 117537792 B CN117537792 B CN 117537792B
- Authority
- CN
- China
- Prior art keywords
- magnetic field
- calibration
- axis
- value
- angle
- 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
- 238000000034 method Methods 0.000 title claims abstract description 40
- 238000012937 correction Methods 0.000 title claims abstract description 22
- 230000005291 magnetic effect Effects 0.000 claims abstract description 261
- 238000004364 calculation method Methods 0.000 claims abstract description 34
- 230000007613 environmental effect Effects 0.000 claims abstract description 28
- 238000009434 installation Methods 0.000 claims description 33
- 230000001133 acceleration Effects 0.000 claims description 28
- 230000008859 change Effects 0.000 claims description 17
- 239000011159 matrix material Substances 0.000 claims description 12
- 230000002452 interceptive effect Effects 0.000 claims description 10
- 238000005259 measurement Methods 0.000 claims description 7
- 230000003044 adaptive effect Effects 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 4
- 238000002474 experimental method Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000008030 elimination Effects 0.000 abstract description 2
- 238000003379 elimination reaction Methods 0.000 abstract description 2
- 238000004458 analytical method Methods 0.000 description 10
- 230000005294 ferromagnetic effect Effects 0.000 description 8
- 230000009471 action Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000002829 reductive effect Effects 0.000 description 3
- 239000000126 substance Substances 0.000 description 3
- 238000001514 detection method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000005358 geomagnetic field Effects 0.000 description 1
- 230000000670 limiting effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000002441 reversible effect Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
- 230000003313 weakening effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C17/00—Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
- G01C17/38—Testing, calibrating, or compensating of compasses
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/30—Assessment of water resources
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Measuring Magnetic Variables (AREA)
Abstract
本发明公开了一种电子罗盘自适应方位角矫正方法，包括电子罗盘在校准地对三轴磁传感器和三轴加速度计进行温度校准、正交性校准、倾角解算以及倾斜补偿校准；在校准地搭建一标准磁场环境进行参数计算，包括对校准地的环境磁场校准、构造电子罗盘的方位角计算式α、磁北锁定并解算此时的方位角标记为到α 0；在应用场所对电子罗盘进行自适应校准。本发明既能实现对磁干扰进行识别并实现自动干扰剔除，也能不依靠同时移动罗盘和安装载体的校准方式来提升校准精度，降低环境磁场校准时对安装载体移动的要求，达到对罗盘输出方位角矫正的目的，增加了罗盘在应用端的适应能力。使用了本方法后，电子罗盘校准得到了简化，且方位角精度得到了提升。
Description
技术领域
本发明涉及一种电子罗盘校正方法，尤其涉及一种电子罗盘自适应方位角矫正方法。
背景技术
电子罗盘也称为数字指南针，其原理是基于地球磁场在罗盘三轴载体坐标系下磁场强度变化来实现对罗盘方位角进行解算的，当三轴磁场强度值发生变化，方位角也随即发生变化。地球磁场均匀且稳定，强度仅大约50000nT左右，十分容易受到罗盘安装载体附近的铁磁物质干扰，从而影响罗盘方位角精度。罗盘安装要求里明确对安装位置进行了指导说明，尽可能远离铁磁性物质、电机、大电流线缆等可能干扰地球磁场的环境，但实际工程环境条件几乎不可能达到无磁干扰环境，因此工程应用时务必要对磁干扰进行剔除，以提高罗盘输出方位角精度。传统的环境磁场校准方法，一般基于三轴传感器在安装位置附件磁场环境下按照一定运行轨迹所采集到的磁场数据，依据无磁干扰环境下理论上最优磁场数据进行反向拟合求解补偿因子，例如椭圆校准、椭球拟合校准。
以椭球拟合校准为例，该方法具有运算量小、实时性高、实用性强等特点。当无干扰时罗盘在原地旋转一圈其在水平面的磁场数据应该是一个标准圆，但由于磁场干扰的引入，导致最终测得磁场数据为一个椭圆，故可利用椭圆的标准方程拟合逼近求解变换因子，将椭圆变换回圆，从而实现对干扰磁场的校准。其校准流程：先利用倾角补偿算法补偿罗盘在水平面内的二维磁场数据，在对二维磁场数据进行外界干扰磁场补偿，从而解算得到正确的方位角。但其在实施校准时需要将罗盘完成一次水平旋转，采集实时磁场数据。在一般定向应用中，罗盘工作时会随载体一起旋转并实时输出载体方位角变化。当安装载体是铁磁性物质时，此时的铁磁干扰已经影响了地球磁场分布，为了达到较好的校准效果，理论上可以将罗盘和载体一起旋转来避免。但当安装载体巨大且无法移动时，直接单独旋转罗盘进行校准会引入误差，不能达到理想的校准效果。其次，载具上使用罗盘除了自身载体干扰外，还有使用过程中其它突发铁磁干扰，如车载应用里载具周围短期出现的铁磁干扰。传统的环境磁场校准方法无法对这类干扰进行有效识别和剔除，也就是说，在面临短暂出现的铁磁干扰并不会做出判断，当突发磁干扰发生时，罗盘处于失效状态，限制了罗盘应用。
发明内容
本发明的目的就在于提供一种解决上述问题，既能实现对突发磁干扰进行识别并实现自动干扰剔除，也能不依靠同时移动罗盘和安装载体的校准方式来提升校准精度，降低环境磁场校准时对安装载体移动的要求，达到对罗盘输出方位角矫正的，电子罗盘自适应方位角矫正方法。
为了实现上述目的，本发明采用的技术方案是这样的：一种电子罗盘自适应方位角矫正方法，包括以下步骤：
（1）电子罗盘置于校准地，对电子罗盘的三轴磁传感器和三轴加速度计进行温度校准，得到三轴磁传感器和三轴加速度计对应的温度校准参数矩阵T jm 和T jg ；
（2）对三轴磁传感器和三轴加速度计进行正交性校准，得到三轴磁传感器对应的正交误差矩阵A pm 、零偏误差矩阵B pm ，三轴加速度计对应的正交误差矩阵A pg 、零偏误差矩阵B pg ；
（3）对电子罗盘进行倾角解算以及倾斜补偿校准，得到俯仰角η、横滚角γ、倾斜补偿后的X轴磁场值M Ix 、倾斜补偿后的Y轴磁场值M Iy ；
（4）在校准地搭建一标准磁场环境，完成参数计算与记录，包括步骤（41）~（43）；
（41）在标准磁场环境下，用椭圆校准方法对校准地的环境磁场校准，并构造电子罗盘的方位角计算式；
（1），
式中，α为方位角，M ’ Ix 、M ’ Iy 分别为旋转偏置角θ后的X轴磁场值和Y轴磁场值，B cx 为椭圆校准后X轴偏移量、B cy 为椭圆校准后Y轴偏移量、M Cx 为环境磁场补偿后的X轴磁场、M Cy 为环境磁场补偿后的Y轴磁场；
（42）查询校准地的地磁偏角φ 0 、根据地理北极和φ 0 确定校准地的地球磁北方向M0，使电子罗盘北向指向M0，完成校准地的磁北锁定；
（43）获取此时环境磁场补偿后的X轴磁场M Cx0，环境磁场补偿后的Y轴磁场M Cy0、俯仰角η 0、横滚角γ 0、正交性校准后的三轴磁场值M Pxyz0 ，代入方位角计算式解算α，解算结果标记为α 0；
（5）在应用场所对电子罗盘进行自适应校准，包括步骤（51）~（56）；
（51）确定电子罗盘在应用场所的安装位置，查询安装位置的地磁偏角φ1，与φ0比对，当差值≤0.5°时，直接进入下一步，否则在安装位置搭建一标准磁场环境，重复步骤（4）更新α 0后再进入下一步；
（52）根据地理北极和φ 1确定安装位置的地球磁北方向M1，使电子罗盘北向指向M1，完成安装位置的磁北锁定；
（53）获取此时环境磁场补偿后的X轴磁场M Cx1，环境磁场补偿后的Y轴磁场M Cy1、俯仰角η 1、横滚角γ 1 、正交性校准后的三轴磁场值M Pxyz1，代入方位角计算式解算α，解算结果标记为θ1；
（54）根据下式进行干扰磁场存在检测；
若|M Pz1－M Pz0 |≤ΔM Pz ，安装位置无磁场干扰，方位角为θ1，无需矫正；
若|M Pz1－M Pz0|＞ΔM Pz ，安装位置存在磁场干扰，进入步骤（55）；
式中，M Pz1为M Pxyz1中的Z轴磁场值，M Pz0 为M Pxyz0中的Z轴磁场值，ΔM Pz 为Z轴磁场变化阈值，通过实验测得；
（55）在安装位置，旋转电子罗盘至任一位置2，按步骤（53）方法解算此时的α，解算结果标记为θ2，计算自适应方位角ε2，ε2=θ1-θ2；
（56）根据下式对自适应方位角进行补偿，得到补偿后方位角α’；
（2），
（3），
公式（2）中，k1为方位角补偿置信因子，为补偿方位角；
公式（3）中，ω为标准磁场与干扰磁场矢量夹角，为位置2处干扰磁场下方位角，k2为补偿比例系数，/>为补偿方位角修正量。
作为优选，k1根据下式得到；
（4）。
作为优选，ω、、/>根据下式得到；
（5），
（6），
（7），
（8），
公式（6）中，M Cx2、M Cy2分别为位置2处，环境磁场补偿后的X轴磁场、环境磁场补偿后的Y轴磁场；
公式（8）中，为俯仰角变化量，/>为横滚角变化量，M ’ Px0 、M ’ Py0 、M ’ Pz0 分别为X轴、Y轴、Z轴的位置变化计算值，∆α=θ1 -α 0为方位角变化量。
作为优选，步骤（1）中，T jg 和T jm 根据下式得到：
（9），
式中，M xyz 为三轴磁传感器测量值，G xyz 为三轴加速度测量值；M Txyz 为温度校准后磁场值，G Txyz 为温度校准后加速度值。
作为优选，步骤（2）中，A pm 、B pm 、A pg 、B pg 满足下式：
（10），
式中，M Txyz 为温度校准后磁场值，M Pxyz 为正交校准后磁场值，G Txyz 为温度校准后加速度值，G Pxyz 为正交校准后加速度值。
作为优选，步骤（3）中，η、γ、M Ix 、M Iy 通过下式得到；
（11），
（12），
式中，g为重力加速度，G Px 、G Py 、G Pz 分别为正交校准后加速度值G Pxyz 中的x轴加速度、y轴加速度、z轴加速度；M Px 、M Py 、M Pz 分别为正交校准后磁场值M Pxyz 中的x轴磁场值、y轴磁场值、z轴磁场值。
作为优选，步骤（41）中，用椭圆校准方法得到椭圆校准参数，包括椭圆圆心坐标（x 0，y 0）、长短轴（a，b）、偏置角θ，并根据下式计算得到M ’ Ix 、M ’ Iy 、B cx 、B cy ；
（13），
（14）。
本发明的原理分析如下：
原理分析（1）：标准磁场环境下磁场分布与角度关系分析：
在干净地磁环境下，经过倾角补偿后的电子罗盘XY平面磁场分布与罗盘角度关系如图2所示，图2中，N为地理北极、M为地球磁北(也称标准磁场方向)、E为地理东，圆圈中心的长方形区域指电子罗盘，长方形区域的箭头指向，为电子罗盘的Y轴方向（也称为罗盘北），与罗盘北垂直且标记M x 的方向，为电子罗盘的X轴方向。M x 、M y 为本发明M xyz 中X轴与Y轴的测量值，也是地磁磁场在电子罗盘水平面的磁场大小，φ为地理北极与地球磁北的夹角，该值一般为固定常数，当坐标位置发生较大改变时会改变，ε为地球磁北与罗盘北向的夹角。
原理分析（2）：干扰磁场环境下的磁场分布与角度关系分析：
干扰物会产生干扰磁场，受干扰磁场影响，磁场在XY平面的分布已经发生改变，此时罗盘角度关系与XY平面磁场分布如图3所示。图中，I为干扰磁场矢量，Ix与Iy分别为干扰磁场经过倾角补偿后在XY平面内X轴与Y轴的磁场分量，其中β 1为干扰磁场作用下的方位角，在图3中为罗盘北与I之间的夹角。ε 1为标准磁场作用下的方位角，在图3中为M与罗盘北的夹角。Mtotal为标准磁场与干扰磁场构成的合磁场，Mtotal作用下的罗盘方位角为θ1，其值满足关系式：arctanθ1=(Mx+Ix)/(My+Iy)。图中存在以下两个固定角度关系：
关系1：由于只讨论静磁干扰，故标准磁场与干扰磁场的矢量和夹角ω大小不变，其值满足关系ω=ε1+β1。图3中，ω为M方向和I方向之间的夹角。
关系2：因为只讨论静磁干扰，故标准磁场与合磁场方向不会改变，两者磁场夹角δ保持不变，即δ=ε1+θ1的值保持不变。
原理分析（3）：干扰磁场下罗盘旋转后磁场分布与角度关系分析：
假设在图3中得到的标准磁场方位角为ε1，合磁场方位角为θ1。旋转到新位置后，在图4中合磁场方位角θ2，可由关系式arctanθ2=(Mx+Ix)/(My+Iy)计算得到。由于图4在图3基础上，只旋转了电子罗盘，标准磁场和干扰磁场未改变，故上述关系2中δ不变，在图4中，δ=ε2+θ2，就可以知道新位置处的标准磁场方位角为ε2=δ-θ2=ε1+θ1-θ2。
原理分析（4）：干扰磁场下罗盘旋转后方位角矫正补偿分析：
在图5中，以罗盘中心为原点，若已知标准磁场M的矢量坐标为（Mx，My），合磁场Mtotal的矢量坐标为（M tx ，Mty）,则可得到干扰磁场I的矢量坐标为（Ix，Iy），即（Mtx-Mx，Mty-My）。根据平面内矢量夹角关系，矢量a与矢量b的夹角∠aob应满足cos∠aob=（a×b）/(|a|×|b|)，则可以求得各磁场之间的夹角。假设图3中标准磁场方位角为ε1，干扰磁场下的方位角为β 1，两个磁场的夹角和根据关系1可知，二者夹角和不变并满足ω=ε1+β1。若旋转后新位置处的干扰磁场方位角为β2，则根据关系1，可以得到标准磁场下的方位角ε2=ε1+β1-β2=ω-β2。则可以通过这个关系，同样求得一个方位角ε2。该值与原理分析（3）中通过关系2得到的ε2表示的是同一个角度，但两者计算途径不同，故可以用这2个值进行矫正补偿。
原理分析（5）：干扰磁场检测原理分析
如图6所示，在罗盘静止无干扰时，电子罗盘在Z轴方向的测量数值是地球磁场在Z轴方向的投影分量，记为Mz，此时，即使在平面内旋转罗盘，由于地磁线与Z轴的夹角不变，Mz值也不会变化。当干扰物出现时，干扰物在在Z轴方向也会产生投影分量记为Iz，故电子罗盘在Z轴方向的测量数值是地球磁场与干扰磁场在Z轴方向投影分量的矢量和Ztotal。干扰物固定不变的前提条件下，Ztotal的值基本保持不变，当干扰物移除时，该值恢复到Mz。由此通过软件设置一个Z轴磁场变化阈值即可检测干扰源是否存在。
与现有技术相比，本发明的优点在于：针对电子罗盘常规校准方法在用户端应用受限制、校准效果不理想、以及无法自动识别干扰且干扰存在时罗盘输出失效的情况，在现有传统的校准方法基础上整合了自适应校准算法，既能实现对磁干扰进行识别并实现自动干扰剔除，也能不依靠同时移动罗盘和安装载体的校准方式来提升校准精度，降低环境磁场校准时对安装载体移动的要求，达到对罗盘输出方位角矫正的目的，增加了罗盘在应用端的适应能力。
附图说明
图1为本发明流程图；
图2为标准磁场环境下XY平面内磁场分布图；
图3为干扰磁场环境下XY平面内磁场分布与角度关系；
图4为干扰磁场环境下电子罗盘旋转后磁场分布与角度关系；
图5为干扰磁场环境下罗盘旋转后方位角补偿示意图；
图6为干扰磁场检测示意图。
具体实施方式
下面将结合附图对本发明作进一步说明。
实施例1：参见图1到图6，一种电子罗盘自适应方位角矫正方法，包括以下步骤：
（1）电子罗盘置于校准地，对电子罗盘的三轴磁传感器和三轴加速度计进行温度校准，得到三轴磁传感器和三轴加速度计对应的温度校准参数矩阵T jm 和T jg ；
（2）对三轴磁传感器和三轴加速度计进行正交性校准，得到三轴磁传感器对应的正交误差矩阵A pm 、零偏误差矩阵B pm ，三轴加速度计对应的正交误差矩阵A pg 、零偏误差矩阵B pg ；
（3）对电子罗盘进行倾角解算以及倾斜补偿校准，得到俯仰角η、横滚角γ、倾斜补偿后的X轴磁场值M Ix 、倾斜补偿后的Y轴磁场值M Iy ；
（4）在校准地搭建一标准磁场环境，完成参数计算与记录，包括步骤（41）~（43）；
（41）在标准磁场环境下，用椭圆校准方法对校准地的环境磁场校准，并构造电子罗盘的方位角计算式；
（1），
式中，α为方位角，M ’ Ix 、M ’ Iy 分别为旋转偏置角θ后的X轴磁场值和Y轴磁场值，B cx 为椭圆校准后X轴偏移量、B cy 为椭圆校准后Y轴偏移量、M Cx 为环境磁场补偿后的X轴磁场、M Cy 为环境磁场补偿后的Y轴磁场；
（42）查询校准地的地磁偏角φ 0 、根据地理北极和φ 0 确定校准地的地球磁北方向M0，使电子罗盘北向指向M0，完成校准地的磁北锁定；
（43）获取此时环境磁场补偿后的X轴磁场M Cx0，环境磁场补偿后的Y轴磁场M Cy0、俯仰角η 0、横滚角γ 0、正交性校准后的三轴磁场值M Pxyz0 ，代入方位角计算式解算α，解算结果标记为α 0；
（5）在应用场所对电子罗盘进行自适应校准，包括步骤（51）~（56）；
（51）确定电子罗盘在应用场所的安装位置，查询安装位置的地磁偏角φ1，与φ0比对，当差值≤0.5°时，直接进入下一步，否则在安装位置搭建一标准磁场环境，重复步骤（4）更新α 0后再进入下一步；
（52）根据地理北极和φ 1确定安装位置的地球磁北方向M1，使电子罗盘北向指向M1，完成安装位置的磁北锁定；
（53）获取此时环境磁场补偿后的X轴磁场M Cx1，环境磁场补偿后的Y轴磁场M Cy1、俯仰角η 1、横滚角γ 1 、正交性校准后的三轴磁场值M Pxyz1，代入方位角计算式解算α，解算结果标记为θ1；
（54）根据下式进行干扰磁场存在检测；
若|M Pz1－M Pz0 |≤ΔM Pz ，安装位置无磁场干扰，方位角为θ1，无需矫正；
若|M Pz1－M Pz0|＞ΔM Pz ，安装位置存在磁场干扰，进入步骤（55）；
式中，M Pz1为M Pxyz1中的Z轴磁场值，M Pz0 为M Pxyz0中的Z轴磁场值，ΔM Pz 为Z轴磁场变化阈值，通过实验测得；
（55）在安装位置，旋转电子罗盘至任一位置2，按步骤（53）方法解算此时的α，解算结果标记为θ2，计算自适应方位角ε2，ε2=θ1-θ2；
（56）根据下式对自适应方位角进行补偿，得到补偿后方位角α’；
（2），
（3），
公式（2）中，k1为方位角补偿置信因子，为补偿方位角；
公式（3）中，ω为标准磁场与干扰磁场矢量夹角，为位置2处干扰磁场下方位角，k2为补偿比例系数，/>为补偿方位角修正量。
k1根据下式得到；
（4）。
ω、、/>根据下式得到；
（5），
（6），
（7），
（8），
公式（6）中，M Cx2、M Cy2分别为位置2处，环境磁场补偿后的X轴磁场、环境磁场补偿后的Y轴磁场；
公式（8）中，为俯仰角变化量，/>为横滚角变化量，M ’ Px0 、M ’ Py0 、M ’ Pz0 分别为X轴、Y轴、Z轴的位置变化计算值，∆α=θ1 -α 0为方位角变化量。
另外：步骤（1）中，T jg 和T jm 根据下式得到：
（9），
式中，M xyz 为三轴磁传感器测量值，G xyz 为三轴加速度测量值；M Txyz 为温度校准后磁场值，G Txyz 为温度校准后加速度值。
步骤（2）中，A pm 、B pm 、A pg 、B pg 满足下式：
（10），
式中，M Txyz 为温度校准后磁场值，M Pxyz 为正交校准后磁场值，G Txyz 为温度校准后加速度值，G Pxyz 为正交校准后加速度值。
步骤（3）中，η、γ、M Ix 、M Iy 通过下式得到；
（11），
（12），
式中，g为重力加速度，G Px 、G Py 、G Pz 分别为正交校准后加速度值G Pxyz 中的x轴加速度、y轴加速度、z轴加速度；M Px 、M Py 、M Pz 分别为正交校准后磁场值M Pxyz 中的x轴磁场值、y轴磁场值、z轴磁场值。
步骤（41）中，用椭圆校准方法得到椭圆校准参数，包括椭圆圆心坐标（x 0，y 0）、长短轴（a，b）、偏置角θ，并根据下式计算得到M ’ Ix 、M ’ Iy 、B cx 、B cy ；
（13），
（14）。
本实施例中，公式（2）-（8）就是根据本发明原理分析中的关系1和关系2得到的2个角度互相补偿。
关于步骤（1）的温度校准，主要完成工作温度范围内传感器输出漂移校准，确保温度范围内传感器始终输出一致，减少温飘对姿态角精度的影响。所述姿态角，是指罗盘输出的方位角、俯仰角和横滚角。所述传感器，指三轴加速度计和三轴磁传感器。
步骤（2）的正交性校准，主要是完成三轴加速度计和三轴磁传感器的正交性校准，减弱传感器自身制造误差和安装误差的影响。
步骤（3）的倾角解算以及倾斜补偿校准，主要是利用校准后的加速度数据完成罗盘俯仰角和横滚角解算，并利用解算出的倾角完成磁传感器的倾角补偿，减弱安装水平误差或者带倾角安装的倾斜误差影响。
完成步骤（1）-（3）后，罗盘就可以进入常规工作模式，常规工作模式是指常规罗盘输出模式。在此模式下，罗盘已经能输出俯仰、横滚、方位角等信息，罗盘测姿定向功能已具备。
本发明所述的磁北锁定，是指利用地理北极与地球磁北的地磁偏角关系来锁定使用地区地球磁北的方向，其中地磁偏角可以利用地磁图或者实地测量查询，通过外部输入并存储在电子罗盘中。当电子罗盘应用地点发生较大变化后，需及时更改，减弱地磁偏角引入的磁偏误差影响。
另外，本发明是电子罗盘工作过程中的一个方位角矫正方法，目的是提高电子罗盘输出的方位角的精度，故可以在电子罗盘的常规工作模式中，增加本发明功能，并通过一模式切换的软开关进行切换。
实施例2：在实施例1的基础上，我们利用静磁屏蔽室搭建校准地的环境磁场，在静磁屏蔽室产生一标准磁场环境，完成步骤（1）~步骤（4）校准操作。然后将一铁磁干扰物放入标准磁场内，构建有静磁干扰磁场环境，按本发明步骤（5）进行自适应校准，得到实测实验数据如表1所示。
表1自适应校准测试实验结果表
由表1数据可知，无干扰时罗盘方位角偏差最大0.34°；干扰存在后，不做自适应校准，罗盘方位角偏差最大9.35°；使用关系1完成自适补偿方位角后，方位角偏差最大1.09°；在关系1的基础上，使用关系2做矫正后，自适应方位角偏差最大1.01。因此，使用了本方法后，罗盘校准得到了简化，且方位角精度得到了提升。
以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。
Claims (6)
1.一种电子罗盘自适应方位角矫正方法，其特征在于，包括以下步骤：
（1）电子罗盘置于校准地，对电子罗盘的三轴磁传感器和三轴加速度计进行温度校准，得到三轴磁传感器和三轴加速度计对应的温度校准参数矩阵T jm 和T jg ；
（2）对三轴磁传感器和三轴加速度计进行正交性校准，得到三轴磁传感器对应的正交误差矩阵A pm 、零偏误差矩阵B pm ，三轴加速度计对应的正交误差矩阵A pg 、零偏误差矩阵B pg ；
（3）对电子罗盘进行倾角解算以及倾斜补偿校准，得到俯仰角η、横滚角γ、倾斜补偿后的X轴磁场值M Ix 、倾斜补偿后的Y轴磁场值M Iy ；
（4）在校准地搭建一标准磁场环境，完成参数计算与记录，包括步骤41）~43）；
41）在标准磁场环境下，用椭圆校准方法对校准地的环境磁场校准，并构造电子罗盘的方位角计算式；
（1），
式中，α为方位角，M ’ Ix 、M ’ Iy 分别为旋转偏置角θ后的X轴磁场值和Y轴磁场值，B cx 为椭圆校准后X轴偏移量、B cy 为椭圆校准后Y轴偏移量、M Cx 为环境磁场补偿后的X轴磁场、M Cy 为环境磁场补偿后的Y轴磁场；
42）查询校准地的地磁偏角φ 0 、根据地理北极和φ 0 确定校准地的地球磁北方向M0，使电子罗盘北向指向M0，完成校准地的磁北锁定；
43）获取此时环境磁场补偿后的X轴磁场M Cx0，环境磁场补偿后的Y轴磁场M Cy0、俯仰角η 0、横滚角γ 0、正交性校准后的三轴磁场值M Pxyz0 ，代入方位角计算式解算α，解算结果标记为α 0；
（5）在应用场所对电子罗盘进行自适应校准，包括步骤51）~56）；
51）确定电子罗盘在应用场所的安装位置，查询安装位置的地磁偏角φ 1，与φ 0比对，当差值≤0.5°时，直接进入下一步，否则在安装位置搭建一标准磁场环境，重复步骤（4）更新α 0后再进入下一步；
52）根据地理北极和φ 1确定安装位置的地球磁北方向M1，使电子罗盘北向指向M1，完成安装位置的磁北锁定；
53）获取此时环境磁场补偿后的X轴磁场M Cx1，环境磁场补偿后的Y轴磁场M Cy1、俯仰角η 1、横滚角γ 1 、正交性校准后的三轴磁场值M Pxyz1，代入方位角计算式解算α，解算结果标记为θ1；
54）根据下式进行干扰磁场存在检测；
若|M Pz1－M Pz0 |≤ΔM Pz ，安装位置无磁场干扰，方位角为θ1，无需矫正；
若|M Pz1－M Pz0|＞ΔM Pz ，安装位置存在磁场干扰，进入步骤55）；
式中，M Pz1为M Pxyz1中的Z轴磁场值，M Pz0 为M Pxyz0中的Z轴磁场值，ΔM Pz 为Z轴磁场变化阈值，通过实验测得；
55）在安装位置，旋转电子罗盘至任一位置2，按步骤53）方法解算此时的α，解算结果标记为θ2，计算自适应方位角ε2，ε2=θ1-θ2；
56）根据下式对自适应方位角进行补偿，得到补偿后方位角α’；
（2），
（3），
公式（2）中，k1为方位角补偿置信因子，为补偿方位角；
公式（3）中，ω为标准磁场与干扰磁场矢量夹角，为位置2处干扰磁场下方位角，k2为补偿比例系数，/>为补偿方位角修正量；
步骤（2）中，A pm 、B pm 、A pg 、B pg 满足下式：
（10），
式中，M Txyz 为温度校准后磁场值，M Pxyz 为正交校准后磁场值，G Txyz 为温度校准后加速度值，G Pxyz 为正交校准后加速度值。
2.根据权利要求1所述的电子罗盘自适应方位角矫正方法，其特征在于， k1根据下式得到；
（4）。
3.根据权利要求1所述的电子罗盘自适应方位角矫正方法，其特征在于，ω、、/>根据下式得到；
（5），
（6），
（7），
（8），
公式（6）中，M Cx2、M Cy2分别为位置2处，环境磁场补偿后的X轴磁场、环境磁场补偿后的Y轴磁场；
公式（7）中，M Px1、M Py1分别为M Pxyz1中的X轴磁场值和Y轴磁场值；
公式（8）中，为俯仰角变化量，/>为横滚角变化量，M’ Px0 、M’ Py0 、M’ Pz0 分别为X轴、Y轴、Z轴的位置变化计算值，∆α=θ1 -α 0为方位角变化量。
4.根据权利要求1所述的电子罗盘自适应方位角矫正方法，其特征在于，步骤（1）中，T jg 和T jm 根据下式得到：
（9），
式中，M xyz 为三轴磁传感器测量值，G xyz 为三轴加速度测量值；M Txyz 为温度校准后磁场值，G Txyz 为温度校准后加速度值。
5.根据权利要求1所述的电子罗盘自适应方位角矫正方法，其特征在于，步骤（3）中，η、γ、M Ix 、M Iy 通过下式得到；
（11），
（12），
式中，为重力加速度，G Px 、G Py 、G Pz 分别为正交校准后加速度值G Pxyz 中的x轴加速度、y轴加速度、z轴加速度；M Px 、M Py 、M Pz 分别为正交校准后磁场值M Pxyz 中的x轴磁场值、y轴磁场值、z轴磁场值。
6.根据权利要求1所述的电子罗盘自适应方位角矫正方法，其特征在于，步骤41）中，用椭圆校准方法得到椭圆校准参数，包括椭圆圆心坐标（x 0，y 0）、长短轴（a，b）、偏置角θ，并根据下式计算得到M ’ Ix 、M ’ Iy 、B cx 、B cy ；
（13），
（14）。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202410006208.8A CN117537792B (zh) | 2024-01-03 | 2024-01-03 | 电子罗盘自适应方位角矫正方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202410006208.8A CN117537792B (zh) | 2024-01-03 | 2024-01-03 | 电子罗盘自适应方位角矫正方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN117537792A CN117537792A (zh) | 2024-02-09 |
| CN117537792B true CN117537792B (zh) | 2024-04-30 |
Family
ID=89788366
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202410006208.8A Active CN117537792B (zh) | 2024-01-03 | 2024-01-03 | 电子罗盘自适应方位角矫正方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN117537792B (zh) |
Citations (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| AU7140181A (en) * | 1980-06-05 | 1981-12-10 | Crouzet S.A. | Compensating the magnetic disturbance in determination of magnetic heading |
| JPH10160506A (ja) * | 1996-11-28 | 1998-06-19 | Murata Mfg Co Ltd | 角度計測装置 |
| CN101241009A (zh) * | 2007-12-28 | 2008-08-13 | 北京科技大学 | 一种磁电子罗盘误差补偿方法 |
| CN102197277A (zh) * | 2008-10-21 | 2011-09-21 | 罗伯特·博世有限公司 | 电子罗盘 |
| EP2520903A1 (en) * | 2011-02-28 | 2012-11-07 | Research In Motion Limited | Portable electronic device adapted to compensate for gyroscope bias |
| CN103308039A (zh) * | 2013-05-14 | 2013-09-18 | 深圳市通创通信有限公司 | 一种数字磁罗盘及其校准补偿方法、系统 |
| CN104931028A (zh) * | 2015-06-30 | 2015-09-23 | 北京联合大学 | 一种基于深度学习的三轴磁电子罗盘误差补偿方法 |
| EP2930466A1 (de) * | 2014-04-09 | 2015-10-14 | Vectronix AG | Handhaltbares Beobachtungsgerät mit einem digitalen Magnetkompass |
| CN108507553A (zh) * | 2018-04-26 | 2018-09-07 | 西南应用磁学研究所 | 电子罗盘的校正方法 |
| CN108548520A (zh) * | 2018-02-25 | 2018-09-18 | 中国电信股份有限公司盐城分公司 | 一种基于nb-iot的天线姿态远程数据采集系统 |
| EP3563337A1 (en) * | 2016-12-28 | 2019-11-06 | Ricoh Company, Ltd. | Image processing apparatus, image processing system, image capturing system, image processing method, and recording medium |
| CN110954080A (zh) * | 2019-12-25 | 2020-04-03 | 中国船舶重工集团有限公司第七一0研究所 | 一种消除载体磁干扰的磁罗盘校准方法 |
| CN111272158A (zh) * | 2019-12-18 | 2020-06-12 | 无锡北微传感科技有限公司 | 复杂磁扰动场景mems电子罗盘的动态方位角解算方法 |
| CN111765879A (zh) * | 2019-11-29 | 2020-10-13 | 深圳市瑞芬科技有限公司 | 一种三维电子罗盘装置及实用校准方法 |
| CN115046539A (zh) * | 2021-03-09 | 2022-09-13 | 北京大学 | Mems电子罗盘动态校准方法 |
| CN115727874A (zh) * | 2022-11-15 | 2023-03-03 | 西南应用磁学研究所(中国电子科技集团公司第九研究所) | 电子罗盘传感器温度误差一体化标定与补偿方法 |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6539639B2 (en) * | 2000-12-06 | 2003-04-01 | Honeywell International Inc. | Monitoring accuracy of an electronic compass |
| US6543146B2 (en) * | 2000-12-06 | 2003-04-08 | Honeywell International, Inc. | Electronic compass and compensation of large magnetic errors for operation over all orientations |
| EP2824421B1 (en) * | 2013-07-08 | 2016-06-29 | Vectronix AG | Digital Magnetic Compass Compensation |
-
2024
- 2024-01-03 CN CN202410006208.8A patent/CN117537792B/zh active Active
Patent Citations (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| AU7140181A (en) * | 1980-06-05 | 1981-12-10 | Crouzet S.A. | Compensating the magnetic disturbance in determination of magnetic heading |
| JPH10160506A (ja) * | 1996-11-28 | 1998-06-19 | Murata Mfg Co Ltd | 角度計測装置 |
| CN101241009A (zh) * | 2007-12-28 | 2008-08-13 | 北京科技大学 | 一种磁电子罗盘误差补偿方法 |
| CN102197277A (zh) * | 2008-10-21 | 2011-09-21 | 罗伯特·博世有限公司 | 电子罗盘 |
| EP2520903A1 (en) * | 2011-02-28 | 2012-11-07 | Research In Motion Limited | Portable electronic device adapted to compensate for gyroscope bias |
| CN103308039A (zh) * | 2013-05-14 | 2013-09-18 | 深圳市通创通信有限公司 | 一种数字磁罗盘及其校准补偿方法、系统 |
| EP2930466A1 (de) * | 2014-04-09 | 2015-10-14 | Vectronix AG | Handhaltbares Beobachtungsgerät mit einem digitalen Magnetkompass |
| CN104931028A (zh) * | 2015-06-30 | 2015-09-23 | 北京联合大学 | 一种基于深度学习的三轴磁电子罗盘误差补偿方法 |
| EP3563337A1 (en) * | 2016-12-28 | 2019-11-06 | Ricoh Company, Ltd. | Image processing apparatus, image processing system, image capturing system, image processing method, and recording medium |
| CN108548520A (zh) * | 2018-02-25 | 2018-09-18 | 中国电信股份有限公司盐城分公司 | 一种基于nb-iot的天线姿态远程数据采集系统 |
| CN108507553A (zh) * | 2018-04-26 | 2018-09-07 | 西南应用磁学研究所 | 电子罗盘的校正方法 |
| CN111765879A (zh) * | 2019-11-29 | 2020-10-13 | 深圳市瑞芬科技有限公司 | 一种三维电子罗盘装置及实用校准方法 |
| CN111272158A (zh) * | 2019-12-18 | 2020-06-12 | 无锡北微传感科技有限公司 | 复杂磁扰动场景mems电子罗盘的动态方位角解算方法 |
| CN110954080A (zh) * | 2019-12-25 | 2020-04-03 | 中国船舶重工集团有限公司第七一0研究所 | 一种消除载体磁干扰的磁罗盘校准方法 |
| CN115046539A (zh) * | 2021-03-09 | 2022-09-13 | 北京大学 | Mems电子罗盘动态校准方法 |
| CN115727874A (zh) * | 2022-11-15 | 2023-03-03 | 西南应用磁学研究所(中国电子科技集团公司第九研究所) | 电子罗盘传感器温度误差一体化标定与补偿方法 |
Non-Patent Citations (5)
| Title |
|---|
| Design of the new electronic magnetic compass;Ma Wan-ming et al;《Journal of Xidian University》;20080601;第35卷(第3期);495-8 * |
| 一种基于抗差M估计的电子罗盘航向误差补偿算法;路辉等;《测绘与空间地理信息》;20230924;第46卷(第9期);51-55+59 * |
| 基于MEMS工艺的平行激励磁通门原理及仿真设计;王梦佳等;《磁性材料及器件》;20231231;第54卷(第5期);51-56 * |
| 基于椭球拟合的磁力计误差校正方法研究;孙伟等;《传感技术学报》;20200915;第31卷(第9期);1373-1376 * |
| 基于磁电阻传感器的电子罗盘研制;白雪等;《磁性材料及器件》;20221231;第53卷(第3期);86-91 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN117537792A (zh) | 2024-02-09 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107121707B (zh) | 一种三轴磁传感器测量基准与结构基准的误差校正方法 | |
| CN107270893B (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
| US6009629A (en) | Process for determining the direction of the earth's magnetic field | |
| CN110006460B (zh) | 星敏感器与磁强计相对标定方法及系统 | |
| US20060066295A1 (en) | Control method of controlling magnetic-field sensor, control device, and mobile terminal device | |
| EP1876417A1 (en) | Inclination sensor and direction finding device using the same | |
| EP1340042A2 (en) | Monitoring accuracy of an electronic compass | |
| CN109059960B (zh) | 一种三维电子指南针的校准方法 | |
| CN114674301B (zh) | 一种强磁干扰环境下电子罗盘主动补偿方法及系统 | |
| CN112129322B (zh) | 一种捷联惯组与三轴转台的安装误差检测方法及校正方法 | |
| CN111829503B (zh) | 一种光纤陀螺阈值测试方法及装置 | |
| CN115046539A (zh) | Mems电子罗盘动态校准方法 | |
| Xu et al. | Dual-band infrared and geomagnetic fusion attitude estimation algorithm based on IMMEKF | |
| CN117537792B (zh) | 电子罗盘自适应方位角矫正方法 | |
| KR100799536B1 (ko) | 2축 지자계 센서의 경사각 오차를 보상하기 위한 가상축 지자계 데이터 추정 장치 및 그 방법과, 그를 이용한 방위각 산출 시스템 | |
| CN116222618B (zh) | 一种极地环境下的双惯导协同标定方法 | |
| CN114779144B (zh) | 一种测量三轴磁强计安装矩阵的方法、芯片和装置 | |
| CN116465432A (zh) | 一种基于航向误差的四位置水平陀螺零偏残差补偿方法 | |
| Zhang et al. | A novel auto-calibration method of the vector magnetometer | |
| CN114543746B (zh) | 一种基于高精度北斗定位的光电转台姿态测量方法 | |
| Jing et al. | Calibration and data processing technology of gyroscope in dual axis rotational inertial navigation system | |
| CN113776560A (zh) | 一种基于高精度三轴转台的陀螺标度因数测试方法 | |
| Gao et al. | Integrated calibration of a 3D attitude sensor in large-scale metrology | |
| Zhang et al. | A novel magnetic compass calibration method based on improved ellipse model | |
| CN113341350B (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 |