CN113640726B - 一种双轴磁强计的多方位椭圆拟合标定方法及系统 - Google Patents

一种双轴磁强计的多方位椭圆拟合标定方法及系统 Download PDF

Info

Publication number
CN113640726B
CN113640726B CN202111212477.2A CN202111212477A CN113640726B CN 113640726 B CN113640726 B CN 113640726B CN 202111212477 A CN202111212477 A CN 202111212477A CN 113640726 B CN113640726 B CN 113640726B
Authority
CN
China
Prior art keywords
ellipse
azimuth
equation
azimuth angle
error
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
Application number
CN202111212477.2A
Other languages
English (en)
Other versions
CN113640726A (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.)
QINGDAO JARI AUTOMATION CO Ltd
Original Assignee
QINGDAO JARI AUTOMATION 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 QINGDAO JARI AUTOMATION CO Ltd filed Critical QINGDAO JARI AUTOMATION CO Ltd
Priority to CN202111212477.2A priority Critical patent/CN113640726B/zh
Publication of CN113640726A publication Critical patent/CN113640726A/zh
Application granted granted Critical
Publication of CN113640726B publication Critical patent/CN113640726B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01R—MEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
    • G01R35/00—Testing or calibrating of apparatus covered by the other groups of this subclass
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
    • G01V13/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices covered by groups G01V1/00 – G01V11/00
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10—Complex mathematical operations
    • G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10—Complex mathematical operations
    • G06F17/18—Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Data Mining & Analysis (AREA)
  • Mathematical Physics (AREA)
  • Theoretical Computer Science (AREA)
  • Computational Mathematics (AREA)
  • Mathematical Analysis (AREA)
  • Mathematical Optimization (AREA)
  • Pure & Applied Mathematics (AREA)
  • Software Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Operations Research (AREA)
  • Algebra (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Databases & Information Systems (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Geophysics (AREA)
  • Manufacturing & Machinery (AREA)
  • Bioinformatics & Cheminformatics (AREA)
  • Bioinformatics & Computational Biology (AREA)
  • Evolutionary Biology (AREA)
  • Probability & Statistics with Applications (AREA)
  • Measuring Magnetic Variables (AREA)

Abstract

本发明公开了一种双轴磁强计的多方位椭圆拟合标定方法及系统，将多个方位角的采集数据分别进行椭圆拟合，获得椭圆方程，根据每个椭圆方程的系数计算椭圆的中心点坐标；根据计算出的椭圆的中心点坐标与最优估计值的均方差最小原则，求出最优估计值；将每个方位角的采集数据拟合出的椭圆的中心点坐标减去最优估计值，获得每个方位角的采集数据的随机平移误差；将每个方位角的采集数据去除随机平移误差，得到优化数据；将每个方位角的优化数据分别进行椭圆拟合，获得优化的椭圆方程，计算每个方位角的补偿系数和零偏误差；计算所有方位角的补偿系数的平均值，获得补偿系数；计算所有方位角的零偏误差的平均值，获得零偏误差；本发明提高了标定效果。

Description

一种双轴磁强计的多方位椭圆拟合标定方法及系统
技术领域
本发明属于传感器测量技术领域，具体地说，是涉及一种双轴磁强计的多方位椭圆拟合标定方法及系统。
背景技术
随着载体智能化的不断发展，滚转角的测量技术已经成为旋转载体测姿、导航与控制的关键技术之一。由于地磁测姿具有无源、自主、覆盖面广、可靠性高、稳定性好等优势，同时，磁强计具有成本低、强自主性、高灵敏度、小体积、低功耗以及误差不随时间累积等特点，采用磁强计测量滚转角已经成为旋转载体姿态测量的重要手段之一。但是由于地磁场属于弱磁场，磁强计信号极易受到周围干扰磁场的影响，铁磁性载体因长时间放置在地磁场而带有铁磁性，因此为了获得高精度的地磁信息，就必须对磁强计进行有效的误差标定与补偿。
目前，双轴磁强计（双轴地磁传感器）的传统标定方法包括多传感器融合、给定基准法和椭圆拟合法等。多传感器融合和给定基准法都需要其他传感器或者外部姿态的辅助，标定过程比较复杂。而最常用的标定方法是椭圆拟合标定方法，因其简单、易实现的特点在工程中得到广泛应用。但是，传统的椭圆拟合标定方法都是基于某一个角度的采集数据，然后进行椭圆系数拟合，难免会因为单一角度实验的随机性太强而产生误差，进而影响标定效果。
发明内容
本发明提供了一种双轴磁强计的多方位椭圆拟合标定方法，提高了标定效果。
为解决上述技术问题，本发明采用下述技术方案予以实现：
一种双轴磁强计的多方位椭圆拟合标定方法，包括：
（1）建立双轴磁强计的标定方程；
Figure DEST_PATH_IMAGE002
；
其中，
Figure DEST_PATH_IMAGE004
为地磁的真实值；
Figure DEST_PATH_IMAGE006
为双轴磁强计的实测值；
Figure DEST_PATH_IMAGE008
为双轴磁强计的零偏误差；
Figure DEST_PATH_IMAGE010
为补偿系数；
（2）求解
Figure DEST_PATH_IMAGE010A
和
Figure DEST_PATH_IMAGE008A
：
（21）获取双轴磁强计在多个方位角的采集数据；
（22）将获取的每个方位角的采集数据分别进行椭圆拟合，获得椭圆方程，根据每个椭圆方程的系数计算每个椭圆的中心点坐标；
（23）根据计算出的椭圆的中心点坐标与椭圆中心点坐标最优估计值的均方差最小原则，求解出椭圆中心点坐标最优估计值；
（24）将每个方位角的采集数据拟合出的椭圆的中心点坐标减去椭圆中心点坐标最优估计值，获得每个方位角的采集数据拟合出的椭圆的随机平移误差；
（25）将每个方位角的采集数据去除随机平移误差，得到优化数据；
（26）将每个方位角的优化数据分别进行椭圆拟合，获得优化的椭圆方程，然后根据获得的每个优化的椭圆方程计算每个方位角的补偿系数和零偏误差；
（27）计算所有方位角的补偿系数的平均值，获得补偿系数
Figure DEST_PATH_IMAGE010AA
；计算所有方位角的零偏误差的平均值，获得零偏误差
Figure DEST_PATH_IMAGE008AA
。
进一步的，在步骤（22）中，将每个方位角的采集数据分别进行基于最小二乘法的椭圆拟合，获得椭圆方程。
又进一步的，在步骤（26）中，将每个方位角的优化数据分别进行基于最小二乘法的椭圆拟合，获得优化的椭圆方程。
更进一步的，在步骤（26）中，所述根据获得的每个优化的椭圆方程计算每个方位角的补偿系数和零偏误差，具体包括下述步骤：
（26-1）由第
Figure DEST_PATH_IMAGE012
个方位角的优化数据拟合出的优化的椭圆方程为：
Figure DEST_PATH_IMAGE014
；
（26-2）
Figure DEST_PATH_IMAGE016
，
Figure DEST_PATH_IMAGE018
，
Figure DEST_PATH_IMAGE020
；
Figure DEST_PATH_IMAGE022
；
Figure DEST_PATH_IMAGE024
；
（26-3）第
Figure DEST_PATH_IMAGE012A
个方位角的零偏误差
Figure DEST_PATH_IMAGE026
为：
Figure DEST_PATH_IMAGE028
；
（26-4）矩阵
Figure DEST_PATH_IMAGE030
；
将
Figure DEST_PATH_IMAGE032
进行奇异值分解，可得
Figure DEST_PATH_IMAGE034
；其中，
Figure DEST_PATH_IMAGE036
为由特征值(
Figure DEST_PATH_IMAGE038
、
Figure DEST_PATH_IMAGE040
)组成的对角矩阵，
Figure DEST_PATH_IMAGE042
为特征向量矩阵；
第
Figure 100002_DEST_PATH_IMAGE012AA
个方位角的补偿系数
Figure DEST_PATH_IMAGE044
为：
Figure DEST_PATH_IMAGE046
。
一种双轴磁强计的多方位椭圆拟合标定系统，包括：
方程建立模块，用于建立双轴磁强计的标定方程；
Figure DEST_PATH_IMAGE002A
；
其中，
Figure DEST_PATH_IMAGE004A
为地磁的真实值；
Figure DEST_PATH_IMAGE006A
为双轴磁强计的实测值；
Figure DEST_PATH_IMAGE008AAA
为双轴磁强计的零偏误差；
Figure DEST_PATH_IMAGE010AAA
为补偿系数；
求解模块，用于求解
Figure DEST_PATH_IMAGE010AAAA
和
Figure DEST_PATH_IMAGE008AAAA
，具体包括：
获取单元，用于获取双轴磁强计在多个方位角的采集数据；
第一拟合计算单元，用于将获取的每个方位角的采集数据分别进行椭圆拟合，获得椭圆方程，根据每个椭圆方程的系数计算每个椭圆的中心点坐标；
最优估计值求解单元，用于根据计算出的椭圆的中心点坐标与椭圆中心点坐标最优估计值的均方差最小原则，求解出椭圆中心点坐标最优估计值；
随机平移误差计算单元，用于将每个方位角的采集数据拟合出的椭圆的中心点坐标减去椭圆中心点坐标最优估计值，获得每个方位角的采集数据拟合出的椭圆的随机平移误差；
优化数据计算单元，用于将每个方位角的采集数据去除随机平移误差，得到优化数据；
第二拟合计算单元，用于将每个方位角的优化数据分别进行椭圆拟合，获得优化的椭圆方程，然后根据获得的每个优化的椭圆方程计算每个方位角的补偿系数和零偏误差；
计算单元，用于计算所有方位角的补偿系数的平均值，获得补偿系数
Figure DEST_PATH_IMAGE010_5A
；计算所有方位角的零偏误差的平均值，获得零偏误差
Figure DEST_PATH_IMAGE008_5A
。
进一步的，所述第一拟合计算单元，具体用于将每个方位角的采集数据分别进行基于最小二乘法的椭圆拟合，获得椭圆方程。
又进一步的，所述第二拟合计算单元，具体用于将每个方位角的优化数据分别进行基于最小二乘法的椭圆拟合，获得优化的椭圆方程。
更进一步的，所述第二拟合计算单元，具体用于：
（26-1）由第
Figure 100002_DEST_PATH_IMAGE012AAA
个方位角的优化数据拟合出的优化的椭圆方程为：
Figure DEST_PATH_IMAGE014A
；
（26-2）
Figure DEST_PATH_IMAGE016A
，
Figure DEST_PATH_IMAGE018A
，
Figure DEST_PATH_IMAGE020A
；
Figure DEST_PATH_IMAGE022A
；
Figure DEST_PATH_IMAGE024A
；
（26-3）第
Figure 100002_DEST_PATH_IMAGE012AAAA
个方位角的零偏误差
Figure DEST_PATH_IMAGE026A
为：
Figure DEST_PATH_IMAGE028A
；
（26-4）矩阵
Figure DEST_PATH_IMAGE030A
；
将
Figure DEST_PATH_IMAGE032A
进行奇异值分解，可得
Figure DEST_PATH_IMAGE034A
；其中，
Figure DEST_PATH_IMAGE036A
为由特征值(
Figure DEST_PATH_IMAGE038A
、
Figure DEST_PATH_IMAGE040A
)组成的对角矩阵，
Figure DEST_PATH_IMAGE042A
为特征向量矩阵；
第
Figure 100002_DEST_PATH_IMAGE012_5A
个方位角的补偿系数
Figure DEST_PATH_IMAGE044A
为：
Figure 100002_DEST_PATH_IMAGE046A
。
与现有技术相比，本发明的优点和积极效果是：本发明的双轴磁强计的多方位椭圆拟合标定方法及系统，通过获取双轴磁强计在多个方位角的采集数据，将获取的每个方位角的采集数据分别进行椭圆拟合，获得椭圆方程，根据每个椭圆方程的系数计算每个椭圆的中心点坐标；根据计算出的椭圆的中心点坐标与椭圆中心点坐标最优估计值的均方差最小原则，求解出椭圆中心点坐标最优估计值；将每个方位角的采集数据拟合出的椭圆的中心点坐标减去椭圆中心点坐标最优估计值，获得每个方位角的采集数据拟合出的椭圆的随机平移误差；将每个方位角的采集数据去除随机平移误差，得到优化数据；将每个方位角的优化数据分别进行椭圆拟合，获得优化的椭圆方程，然后根据获得的每个优化的椭圆方程计算每个方位角的补偿系数和零偏误差；计算所有方位角的补偿系数的平均值，获得补偿系数
Figure 100002_DEST_PATH_IMAGE010_6A
；计算所有方位角的零偏误差的平均值，获得零偏误差
Figure 100002_DEST_PATH_IMAGE008_6A
；本实施例的双轴磁强计的多方位椭圆拟合标定方法，消除了随机误差，提高了标定效果。
结合附图阅读本发明的具体实施方式后，本发明的其他特点和优点将变得更加清楚。
附图说明
图1是双轴磁强计的安装示意图；
图2是本发明提出的双轴磁强计的多方位椭圆拟合标定方法的一个实施例的流程图；
图3是原始采集数据；
图4是传统标定方法效果图；
图5是对采集的测量数据进行椭圆中心估计和中心平移处理的结果；
图6是本发明标定方法的标定结果；
图7是本发明提出的双轴磁强计的多方位椭圆拟合标定系统的一个实施例的结构示意图。
具体实施方式
针对目前标定方法误差大、效果差的问题，本发明提出了一种双轴磁强计的多方位椭圆拟合标定方法及系统，提高了标定效果。为了使本发明的目的、技术方案及优点更加清楚明白，下面结合附图和实施例，对本发明的双轴磁强计的多方位椭圆拟合标定方法及系统进行详细说明。
本发明提出了一种基于MSE(Mean Squared Error)中心平移的多方位椭圆拟合标定方法。首先分析了双轴正交磁强计的误差源，根据误差影响效果建立了误差模型，介绍了基于最小二乘法的传统椭圆标定原理，然后从实际工程应用出发，提出了基于MSE中心平移的多方位椭圆拟合标定方法。主要原理：在360度范围内采集多个方位的实验数据，针对多个方位的采集数据，采用MSE的方法估计出最优椭圆中心和测量数据的随机误差，再采用中心平移的方法来消除测量数据的随机误差，然后再进行基于最小二乘法的多方位椭圆拟合标定。最后通过实地标定实验，证明了本发明方法的标定效果更优。
一、双轴磁强计的误差源分析和误差模型的建立。
由于磁强计本身存在工艺制造等误差，而且测量目标也会因为长时间放置在地磁场中而带有磁性，最终会导致整个系统存在测量误差。因此，在进行测量之前，需要对磁强计的输出进行标定补偿。
双轴磁强计安装在旋转载体之上，双轴磁强计的
Figure DEST_PATH_IMAGE048
轴和
Figure DEST_PATH_IMAGE050
轴垂直于载体纵轴（即载体的中轴线，旋转轴），且相互垂直，安装示意图如图1所示。
（1）误差源分析。
整个双轴磁强计的误差源可以总结为三个方面：
（a）磁强计组件的自身误差。磁强计组件的自身误差指的是由于磁强计制造及安装过程中产生的工艺误差和安装误差，可以分为灵敏度误差、非正交误差和零位误差。灵敏度误差是指由于磁强计各个敏感轴的灵敏度以及材质问题所引起的误差，可以用对角矩阵来表示；非正交误差是指由于磁强计敏感轴无法正交引起的误差，可以用矩阵的耦合项来表示；零位误差则是指当外部磁强度为零时磁强计输出不为零的误差，可以用一维矩阵来表示。
（b）外部环境的影响误差，主要是指铁磁性载体对磁强计的影响误差。由于载体是铁磁性物质，会引起磁强计输出偏离地磁强度真值。这种影响根据引起误差的材料不同可以分为硬磁和软磁影响。在描述误差模型时，此类误差可以与磁强计组件的自身误差一起总结为灵敏度误差、非正交误差和零位误差。
（c）温度漂移误差，主要是指磁强计上电之后的因温度变化引起的漂移误差。由于磁强计的生产材料会受温度的影响，磁强计输出电压就会随温度变化而产生变化，进而导致磁强计输出会随温度变化而产生漂移。相较于其他误差，温度漂移误差比较小，温度变化不大的时候可以忽略不计。
（2）误差模型
根据误差的影响效果，可以总结为三类误差：灵敏度误差、耦合效应误差和零偏误差。针对双轴磁强计的误差源和安装模型，建立误差标定模型：
Figure DEST_PATH_IMAGE052
（1）
或
Figure DEST_PATH_IMAGE054
（2）
其中，
Figure DEST_PATH_IMAGE056
，
Figure DEST_PATH_IMAGE058
为地磁在双轴磁强计的
Figure DEST_PATH_IMAGE060
轴、
Figure DEST_PATH_IMAGE062
轴方向的真实值；
Figure DEST_PATH_IMAGE064
，
Figure DEST_PATH_IMAGE066
为双轴磁强计的
Figure DEST_PATH_IMAGE060A
轴、
Figure DEST_PATH_IMAGE062A
轴实测值；
Figure DEST_PATH_IMAGE068
，
Figure DEST_PATH_IMAGE070
为双轴磁强计的
Figure DEST_PATH_IMAGE060AA
轴、
Figure DEST_PATH_IMAGE062AA
轴零偏误差；
Figure DEST_PATH_IMAGE072
，为双轴磁强计的灵敏度误差和耦合误差。
二、基于最小二乘法的椭圆拟合标定原理
由公式（1）可以得到双轴磁强计的标定方程为：
Figure 100002_DEST_PATH_IMAGE002AA
（3）
其中，
Figure DEST_PATH_IMAGE074
，
Figure DEST_PATH_IMAGE058A
为地磁在双轴磁强计的
Figure DEST_PATH_IMAGE060AAA
轴、
Figure DEST_PATH_IMAGE062AAA
轴方向的真实值；
Figure DEST_PATH_IMAGE076
，
Figure DEST_PATH_IMAGE066A
为双轴磁强计的
Figure DEST_PATH_IMAGE060AAAA
轴、
Figure DEST_PATH_IMAGE062AAAA
轴实测值；
Figure DEST_PATH_IMAGE078
，
Figure DEST_PATH_IMAGE070A
为双轴磁强计的
Figure DEST_PATH_IMAGE060_5A
轴、
Figure DEST_PATH_IMAGE062_5A
轴零偏误差；
Figure DEST_PATH_IMAGE080
，
Figure 100002_DEST_PATH_IMAGE010_7A
为双轴磁强计的灵敏度误差和耦合误差的补偿系数。
Figure 100002_DEST_PATH_IMAGE010_8A
是
Figure DEST_PATH_IMAGE082
的逆矩阵，
Figure DEST_PATH_IMAGE082A
为双轴磁强计的灵敏度误差和耦合误差，
Figure 100002_DEST_PATH_IMAGE010_9A
为该误差的补偿系数。
标定的过程就是求解
Figure 100002_DEST_PATH_IMAGE010_10A
和
Figure DEST_PATH_IMAGE084
的过程，工程中最有效的方法是基于椭圆的最小二乘拟合方法，主要分为两个步骤：1、对采集的磁强计测量数据进行椭圆拟合，并求出椭圆拟合系数；2、进行椭圆标定，拉圆，求解
Figure 100002_DEST_PATH_IMAGE010_11A
和
Figure DEST_PATH_IMAGE084A
。
（1）地磁测量数据的椭圆拟合
由公式(3)可得：
Figure DEST_PATH_IMAGE086
（4）
记
Figure DEST_PATH_IMAGE088
Figure DEST_PATH_IMAGE090
（5）
考虑到任何一个固定位置，绕载体纵轴旋转时，地磁场矢量
Figure 100002_DEST_PATH_IMAGE004AA
可视为一个常矢量，其磁场强度为一常量，故
Figure DEST_PATH_IMAGE092
为常数，则公式（5）为一个椭圆轨迹方程（椭圆的矩阵形式），这表明测量值被限制在一个椭圆轨迹上，利用这种特性，可以估计双轴磁强计的误差修正参数。可以利用磁强计绕载体纵轴旋转输出数据
Figure DEST_PATH_IMAGE094
，通过最小二乘法进行椭圆拟合得到方程（5）的系数
Figure DEST_PATH_IMAGE096
和
Figure DEST_PATH_IMAGE098
。
椭圆轨迹方程可表示为
Figure DEST_PATH_IMAGE100
（6）
定义椭圆系数
Figure DEST_PATH_IMAGE102
假设磁强计输出一组地磁矢量数据
Figure DEST_PATH_IMAGE104
，
Figure DEST_PATH_IMAGE106
，
Figure DEST_PATH_IMAGE108
为地磁矢量数据长度，定义测量数据矩阵
Figure DEST_PATH_IMAGE110
Figure DEST_PATH_IMAGE112
Figure DEST_PATH_IMAGE114
则可以得到
Figure DEST_PATH_IMAGE116
（7）
式(7)的最小二乘法拟合问题，即，使
Figure DEST_PATH_IMAGE118
最小化问题，即
Figure DEST_PATH_IMAGE120
（8）
由最小二乘法知识，可知
Figure DEST_PATH_IMAGE122
（9）
这样就得到了地磁测量数据的椭圆拟合系数
Figure DEST_PATH_IMAGE124
。
（2）误差补偿系数计算
得到椭圆轨迹拟合系数后，就可以进行误差补偿系数的计算。
椭圆方程（6）可以改写为下列形式：
Figure DEST_PATH_IMAGE126
（10）
其中，
Figure DEST_PATH_IMAGE128
，
Figure DEST_PATH_IMAGE130
，
Figure DEST_PATH_IMAGE132
。
式(10)进一步推导为
Figure DEST_PATH_IMAGE134
（11）
其中，可以得到
Figure DEST_PATH_IMAGE136
（12）
Figure DEST_PATH_IMAGE138
（13）
将式（5）等号左右各除以
Figure DEST_PATH_IMAGE092A
，然后对照式(11)，可得
Figure DEST_PATH_IMAGE140
（14）
Figure DEST_PATH_IMAGE142
（15）
将矩阵
Figure DEST_PATH_IMAGE144
进行奇异值分解，可得
Figure DEST_PATH_IMAGE146
（16）
其中，
Figure DEST_PATH_IMAGE148
为由特征值(
Figure DEST_PATH_IMAGE150
、
Figure DEST_PATH_IMAGE152
)组成的对角矩阵，
Figure DEST_PATH_IMAGE154
为特征向量矩阵。假设
Figure DEST_PATH_IMAGE156
，
Figure DEST_PATH_IMAGE158
则
Figure DEST_PATH_IMAGE160
（17）
由于
Figure DEST_PATH_IMAGE088A
，故有
Figure DEST_PATH_IMAGE162
（18）
到此便确定了磁强计补偿系数
Figure DEST_PATH_IMAGE010_12A
和
Figure DEST_PATH_IMAGE164
。
三、MSE方法
在实验过程中，由于随机性因素，每次采集的试验测量数据都有随机量的干扰，结果并不完全一致。因此为了尽可能的保证获得准确的标定参数，需要进行多方位多次数据采集，再对采集的多组测量数据分别进行椭圆拟合，估计理想椭圆的最优中心点，然后再进行标定补偿。本发明中将采用MSE方法对测量数据进行椭圆中心估计。
MSE（均方差）方法是一种工程中衡量“平均误差”的常用方法，简便快捷，MSE的值越小，说明预测模型描述的试验数据具有更好的准确度。MSE的值表示为
Figure DEST_PATH_IMAGE166
（19）
式中，
Figure DEST_PATH_IMAGE168
为测量数据，
Figure DEST_PATH_IMAGE170
为估计值。
实施例一、
本实施例的双轴磁强计的多方位椭圆拟合标定方法，主要包括下述步骤，参见图2所示。
步骤S1：建立双轴磁强计的标定方程。
Figure 100002_DEST_PATH_IMAGE002AAA
；
其中，
Figure 100002_DEST_PATH_IMAGE004AAA
为地磁的真实值；
Figure DEST_PATH_IMAGE006AA
为双轴磁强计的实测值；
Figure 100002_DEST_PATH_IMAGE008_7A
为双轴磁强计的零偏误差；
Figure DEST_PATH_IMAGE010_13A
为双轴磁强计的灵敏度误差和耦合误差的补偿系数。
步骤S2：求解
Figure DEST_PATH_IMAGE010_14A
和
Figure 100002_DEST_PATH_IMAGE008_8A
。
标定的过程就是求解系数
Figure DEST_PATH_IMAGE010_15A
和
Figure DEST_PATH_IMAGE084AA
的过程，具体包括下述步骤：
步骤S21：获取双轴磁强计在多个方位角的采集数据，包括
Figure DEST_PATH_IMAGE060_6A
轴采集数据和
Figure DEST_PATH_IMAGE062_6A
轴采集数据。
双轴磁强计在第
Figure 100002_DEST_PATH_IMAGE012_6A
个方位角的
Figure DEST_PATH_IMAGE060_7A
轴采集数据为
Figure DEST_PATH_IMAGE172
；
双轴磁强计在第
Figure 100002_DEST_PATH_IMAGE012_7A
个方位角的
Figure DEST_PATH_IMAGE062_7A
轴采集数据为
Figure DEST_PATH_IMAGE174
；
Figure DEST_PATH_IMAGE176
；
Figure DEST_PATH_IMAGE178
为选取的方位角数目。
Figure DEST_PATH_IMAGE172A
、
Figure DEST_PATH_IMAGE174A
为向量，是数据组。
步骤S22：将获取的每个方位角的采集数据分别进行椭圆拟合，获得椭圆方程，根据每个椭圆方程的系数计算每个椭圆的中心点坐标。
在本实施例中，将每个方位角的采集数据分别进行基于最小二乘法的椭圆拟合，可以拟合出高精度的椭圆方程，而且拟合速度快。
通过公式（6）～公式（9）部分，获得由每个方位角的采集数据拟合出的椭圆方程，即共获得n个椭圆方程。
由第
Figure DEST_PATH_IMAGE012_8A
个方位角的采集数据(
Figure DEST_PATH_IMAGE172AA
，
Figure DEST_PATH_IMAGE180
)拟合出的椭圆方程为：
Figure DEST_PATH_IMAGE182
（20）
拟合的椭圆中心点坐标为(
Figure DEST_PATH_IMAGE184
，
Figure DEST_PATH_IMAGE186
)，椭圆中心点坐标计算公式为：
Figure DEST_PATH_IMAGE188
（21）
Figure DEST_PATH_IMAGE184A
、
Figure DEST_PATH_IMAGE190
为第
Figure DEST_PATH_IMAGE012_9A
个方位角的采集数据拟合出的椭圆的中心点
Figure DEST_PATH_IMAGE060_8A
轴坐标、
Figure DEST_PATH_IMAGE062_8A
轴坐标。
步骤S23：根据计算出的椭圆的中心点坐标与椭圆中心点坐标最优估计值的均方差最小原则，求解出椭圆中心点坐标最优估计值。
由于每次采集数据时，改变了载体的方位角进行滚转操作，采集的数据会包含随机偏移量
Figure DEST_PATH_IMAGE192
(
Figure DEST_PATH_IMAGE194
，
Figure DEST_PATH_IMAGE196
),因此，选取采集数据拟合的椭圆中心点坐标作为MSE方法的优化对象。
假设优化后的理想椭圆中心点坐标为(
Figure DEST_PATH_IMAGE198
，
Figure DEST_PATH_IMAGE200
)，则可以参照公式（19）构建方程组：
Figure DEST_PATH_IMAGE202
（22）
令
Figure DEST_PATH_IMAGE204
、
Figure DEST_PATH_IMAGE206
最小，求解出理想椭圆中心点坐标的最优估计值(
Figure DEST_PATH_IMAGE198A
，
Figure DEST_PATH_IMAGE200A
)，即完成了所有的椭圆中心坐标的优化估计。
其中，
Figure DEST_PATH_IMAGE204A
、
Figure DEST_PATH_IMAGE206A
为均方差；
Figure DEST_PATH_IMAGE184AA
、
Figure DEST_PATH_IMAGE190A
为第
Figure DEST_PATH_IMAGE012_10A
个方位角的采集数据拟合出的椭圆的中心点
Figure DEST_PATH_IMAGE060_9A
轴坐标、
Figure DEST_PATH_IMAGE062_9A
轴坐标；
Figure DEST_PATH_IMAGE198AA
、
Figure DEST_PATH_IMAGE200AA
为椭圆中心点
Figure DEST_PATH_IMAGE060_10A
轴坐标、
Figure DEST_PATH_IMAGE062_10A
轴坐标的最优估计值。
步骤S24：将每个方位角的采集数据拟合出的椭圆的中心点坐标减去椭圆中心点坐标最优估计值，获得每个方位角的采集数据拟合出的椭圆的随机平移误差。
估计出椭圆中心点坐标的最优估计值(
Figure DEST_PATH_IMAGE198AAA
，
Figure DEST_PATH_IMAGE200AAA
)之后，就可以计算出由每个方位角的采集数据拟合的椭圆的中心点误差。
Figure DEST_PATH_IMAGE208
（23）
其中，
Figure DEST_PATH_IMAGE210
、
Figure DEST_PATH_IMAGE212
为由第
Figure DEST_PATH_IMAGE012_11A
个方位角的采集数据拟合出的椭圆的中心点
Figure DEST_PATH_IMAGE060_11A
轴误差、
Figure DEST_PATH_IMAGE062_11A
轴误差。
分析椭圆的一般表达式(6)和椭圆中心点的计算公式(22)可知，椭圆的中心点坐标是由测量数据拟合出的椭圆参数计算得出，即椭圆数据与椭圆的中心点坐标是一一对应的关系。因此，椭圆中心点的坐标误差即是椭圆的随机平移误差，即
Figure DEST_PATH_IMAGE214
（24）
其中，
Figure DEST_PATH_IMAGE216
、
Figure DEST_PATH_IMAGE218
为第
Figure DEST_PATH_IMAGE012_12A
个方位角的采集数据拟合出的椭圆的随机平移误差。
将测量数据中的随机平移误差去除之后就可以进行椭圆拟合和标定。
步骤S25：将每个方位角的采集数据去除随机平移误差，得到优化数据。
Figure DEST_PATH_IMAGE220
（25）
Figure DEST_PATH_IMAGE222
为第
Figure DEST_PATH_IMAGE012_13A
个方位角的采集数据
Figure DEST_PATH_IMAGE172AAA
的优化数据；
Figure DEST_PATH_IMAGE224
为第
Figure DEST_PATH_IMAGE012_14A
个方位角的采集数据
Figure DEST_PATH_IMAGE174AA
的优化数据。
步骤S26：将每个方位角的优化数据分别进行椭圆拟合，获得优化的椭圆方程，然后根据获得的每个优化的椭圆方程计算每个方位角的补偿系数和零偏误差。
在本实施例中，将每个方位角的优化数据分别进行基于最小二乘法的椭圆拟合，可以拟合出高精度的优化的椭圆方程，而且拟合速度快。
Figure 100002_DEST_PATH_IMAGE044AA
为第
Figure DEST_PATH_IMAGE012_15A
个方位角的补偿系数；
Figure 100002_DEST_PATH_IMAGE026AA
为第
Figure DEST_PATH_IMAGE012_16A
个方位角的零偏误差。
在本步骤中，根据获得的每个优化的椭圆方程计算每个方位角的补偿系数和零偏误差，具体包括下述步骤：
步骤S26-1：由第
Figure DEST_PATH_IMAGE012_17A
个方位角的优化数据（
Figure DEST_PATH_IMAGE222A
，
Figure DEST_PATH_IMAGE224A
）拟合出的优化的椭圆方程为：
Figure 100002_DEST_PATH_IMAGE014AA
（26）
Figure DEST_PATH_IMAGE226
为椭圆方程的系数。
由每个方位角的优化数据拟合出优化的椭圆方程后，再将每个优化的椭圆方程的系数代入公式（10）～（18），计算出每个方位角的补偿系数和零偏误差。
因此，参照公式（10）～（18），进行下述计算：
步骤S26-2：由第
Figure DEST_PATH_IMAGE012_18A
个方位角的优化数据拟合出的优化的椭圆方程，改写为下列形式：
Figure DEST_PATH_IMAGE228
； （27）
其中，
Figure 100002_DEST_PATH_IMAGE016AA
，
Figure 100002_DEST_PATH_IMAGE018AA
，
Figure 100002_DEST_PATH_IMAGE020AA
；
由
Figure DEST_PATH_IMAGE228A
，进一步推导为：
Figure DEST_PATH_IMAGE230
； （28）
其中，可以得到；
Figure 100002_DEST_PATH_IMAGE022AA
； （29）
Figure 100002_DEST_PATH_IMAGE024AA
； （30）
Figure 100002_DEST_PATH_IMAGE028AA
； （31）
Figure 100002_DEST_PATH_IMAGE030AA
； （32）
（26-3）因此，第
Figure DEST_PATH_IMAGE012_19A
个方位角的零偏误差
Figure 100002_DEST_PATH_IMAGE026AAA
为：
Figure 100002_DEST_PATH_IMAGE028AAA
，
Figure 100002_DEST_PATH_IMAGE022AAA
。
（26-4）将矩阵
Figure 100002_DEST_PATH_IMAGE032AA
进行奇异值分解，可得
Figure 100002_DEST_PATH_IMAGE034AA
（33）
其中，
Figure 100002_DEST_PATH_IMAGE036AA
为由特征值(
Figure 100002_DEST_PATH_IMAGE038AA
、
Figure 100002_DEST_PATH_IMAGE040AA
)组成的对角矩阵，
Figure 100002_DEST_PATH_IMAGE042AA
为特征向量矩阵。假设
Figure DEST_PATH_IMAGE232
，
Figure DEST_PATH_IMAGE234
则
Figure DEST_PATH_IMAGE236
（34）
由于
Figure DEST_PATH_IMAGE238
,故有
Figure 100002_DEST_PATH_IMAGE046AA
（35）
因此，第
Figure DEST_PATH_IMAGE012_20A
个方位角的补偿系数
Figure 100002_DEST_PATH_IMAGE044AAA
为：
Figure DEST_PATH_IMAGE046AAA
。
在本步骤中，将每个方位角的优化数据分别进行基于最小二乘法的椭圆拟合标定，得到磁强计的在每个方位角的补偿系数和零偏误差。
通过S26-1～S26-4，计算出每个方位角的补偿系数和零偏误差，方法简单快速。
步骤S27：计算所有方位角的补偿系数的平均值，获得补偿系数
Figure DEST_PATH_IMAGE010_16A
；计算所有方位角的零偏误差的平均值，获得零偏误差
Figure 100002_DEST_PATH_IMAGE008_9A
。
Figure DEST_PATH_IMAGE240
（36）
在本步骤中，通过均值法计算最终的补偿系数
Figure DEST_PATH_IMAGE010_17A
和零偏误差
Figure 100002_DEST_PATH_IMAGE008_10A
。
本实施例的双轴磁强计的多方位椭圆拟合标定方法，通过将获取的每个方位角的采集数据分别进行椭圆拟合，获得椭圆方程，根据每个椭圆方程的系数计算每个椭圆的中心点坐标；根据计算出的椭圆的中心点坐标与椭圆中心点坐标最优估计值的均方差最小原则，求解出椭圆中心点坐标最优估计值；将每个方位角的采集数据拟合出的椭圆的中心点坐标减去椭圆中心点坐标最优估计值，获得每个方位角的采集数据拟合出的椭圆的随机平移误差；将每个方位角的采集数据去除随机平移误差，得到优化数据；将每个方位角的优化数据分别进行椭圆拟合，获得优化的椭圆方程，然后根据获得的每个优化的椭圆方程计算每个方位角的补偿系数和零偏误差；计算所有方位角的补偿系数的平均值，获得补偿系数
Figure DEST_PATH_IMAGE010_18A
；计算所有方位角的零偏误差的平均值，获得零偏误差
Figure 100002_DEST_PATH_IMAGE008_11A
；本实施例的双轴磁强计的多方位椭圆拟合标定方法，消除了随机误差，提高了标定效果。
实地验证实验：
验证实验在某户外开阔地进行，附近地磁环境良好，无干扰。采用双轴磁强计构建出测量组件，然后固定在无磁转台上，保持水平。
以地磁北向为零度，东向为正，分别赋予双轴磁强计八个方位角度0°、45°、90°、135°、180°、225°、270°、315°。在每个方位角位置，绕载体自身纵轴旋转，设定计算机的采样频率为100Hz，连续记录双轴磁强计的输出信号，输出信号为数字信号，单位为AD点数。
实验之后读取数据，选择其中一个旋转周期，采集离散测量数据，如附图3所示。从图中可以看出，原始采集数据所构成椭圆的中心点比较分散，这说明实验时由于每个方位角位置的随机误差不同，导致了采集数据拟合的椭圆整体出现了不同的随机漂移。
传统方法的标定效果：
首先采用基于最小二乘法的传统椭圆拟合方法进行标定，针对每个方位角的采集数据分别进行椭圆拟合标定，然后再采用均值法求解统一的补偿系数和零偏误差，最终标定效果如附图4所示。由图4中可以看出，传统的椭圆拟合标定方法虽然达到了拉圆的效果，但是由于每个方位角位置随机误差的影响，标定后的各圆并不同心，圆心散布较大，最大相差约1400个AD点数，随机误差并没有被消除，依然存在，标定效果不理想。
本实施例的基于MSE中心平移的多方位椭圆拟合标定效果：
根据本实施例提出的MSE中心平移的方法，对采集的测量数据进行椭圆中心估计和中心平移等处理，处理结果如附图5所示。
采用MSE中心平移之后，各个方位角测量数据拟合的椭圆中心点都汇于最优椭圆中心点附近。然后再进行基于最小二乘法的椭圆拟合标定以及均值法求解补偿系数
Figure DEST_PATH_IMAGE010_19A
和
Figure DEST_PATH_IMAGE008_12A
，最终补偿标定结果（将
Figure DEST_PATH_IMAGE010_20A
和
Figure DEST_PATH_IMAGE008_13A
应用到测量数据上的效果）如附图6所示。由图6中可以看出，基于MSE中心平移的多方位椭圆拟合标定方法，可以使标定后的各圆基本同心，圆心散布很小，最大相差约25个AD点数，每个方位角位置的随机误差基本上被消除，标定效果远好于传统方法。
采用双轴磁强计测量旋转载体的滚转角，是目前工程中广泛使用的重要手段，但是传统的椭圆拟合标定方法都是基于单一方位进行数据采集，方法比较简单，受随机因素影响产生较大误差，进而影响标定效果。本实施例提出的基于MSE中心平移的多方位椭圆拟合方法，着眼于实际工程应用，可以对多个方位角度采集的测量数据进行优化，消除随机平移误差，再进行多方位椭圆拟合标定。本实施例通过完善的实际实验，证明了该方法的标定效果可以达到较高水平，可以有效的校正双轴磁强计的输出信息，为旋转载体的滚转角测量、导航制导与控制提供技术支持。该发明具有完全的自主知识产权、方法新颖，处于先进水平。
本实施例的多方位椭圆拟合标定方法，主要分为双轴磁强计的误差源分析和误差模型的建立、基于最小二乘法的椭圆拟合标定原理、基于MSE的椭圆中心估计、基于中心平移的实验数据处理方法、基于最小二乘法的多方位椭圆拟合标定方法等几个部分。同时，本实施例的双轴磁强计的多方位椭圆拟合标定方法，已经通过实地实验验证，并与传统方法进行比较，证明了该方法的标定效果更优。
本实施例的双轴磁强计的多方位椭圆拟合标定方法，有完全的自主知识产权、方法新颖，属于先进水平，所提出的基于MSE中心平移的多方位椭圆拟合标定方法可以有效的标定双轴磁强计的输出，稳定性和可靠性要高于传统方法，为双轴磁强计的标定和测量提供技术支持。
实施例二、
基于实施例一的双轴磁强计的多方位椭圆拟合标定方法的设计，本实施例提出了一种双轴磁强计的多方位椭圆拟合标定系统，包括方程建立模块和求解模块，参见图7所示。
（1）方程建立模块，用于建立双轴磁强计的标定方程；
Figure DEST_PATH_IMAGE002AAAA
；
其中，
Figure DEST_PATH_IMAGE004AAAA
为地磁的真实值；
Figure DEST_PATH_IMAGE006AAA
为双轴磁强计的实测值；
Figure DEST_PATH_IMAGE008_14A
为双轴磁强计的零偏误差；
Figure DEST_PATH_IMAGE010_21A
为补偿系数；
（2）求解模块，用于求解
Figure DEST_PATH_IMAGE010_22A
和
Figure DEST_PATH_IMAGE008_15A
，求解模块具体包括下述单元：
（21）获取单元，用于获取双轴磁强计在多个方位角的采集数据；
（22）第一拟合计算单元，用于将获取的每个方位角的采集数据分别进行椭圆拟合，获得椭圆方程，根据每个椭圆方程的系数计算每个椭圆的中心点坐标；
（23）最优估计值求解单元，用于根据计算出的椭圆的中心点坐标与椭圆中心点坐标最优估计值的均方差最小原则，求解出椭圆中心点坐标最优估计值；
（24）随机平移误差计算单元，用于将每个方位角的采集数据拟合出的椭圆的中心点坐标减去椭圆中心点坐标最优估计值，获得每个方位角的采集数据拟合出的椭圆的随机平移误差；
（25）优化数据计算单元，用于将每个方位角的采集数据去除随机平移误差，得到优化数据；
（26）第二拟合计算单元，用于将每个方位角的优化数据分别进行椭圆拟合，获得优化的椭圆方程，然后根据获得的每个优化的椭圆方程计算每个方位角的补偿系数和零偏误差；
（27）计算单元，用于计算所有方位角的补偿系数的平均值，获得补偿系数
Figure DEST_PATH_IMAGE010_23A
；计算所有方位角的零偏误差的平均值，获得零偏误差
Figure DEST_PATH_IMAGE008_16A
。
第一拟合计算单元（22），具体用于将每个方位角的采集数据分别进行基于最小二乘法的椭圆拟合，获得椭圆方程。
第二拟合计算单元（26），具体用于将每个方位角的优化数据分别进行基于最小二乘法的椭圆拟合，获得优化的椭圆方程。
第二拟合计算单元（26），具体用于：
（26-1）由第
Figure DEST_PATH_IMAGE012_21A
个方位角的优化数据拟合出的优化的椭圆方程为：
Figure 100002_DEST_PATH_IMAGE014AAA
；
（26-2）
Figure 100002_DEST_PATH_IMAGE016AAA
，
Figure 100002_DEST_PATH_IMAGE018AAA
，
Figure 100002_DEST_PATH_IMAGE020AAA
；
Figure DEST_PATH_IMAGE022AAAA
；
Figure 100002_DEST_PATH_IMAGE024AAA
；
（26-3）第
Figure DEST_PATH_IMAGE012_22A
个方位角的零偏误差
Figure DEST_PATH_IMAGE026AAAA
为：
Figure DEST_PATH_IMAGE028AAAA
；
（26-4）矩阵
Figure 100002_DEST_PATH_IMAGE030AAA
；
将
Figure 100002_DEST_PATH_IMAGE032AAA
进行奇异值分解，可得
Figure 100002_DEST_PATH_IMAGE034AAA
；其中，
Figure 100002_DEST_PATH_IMAGE036AAA
为由特征值(
Figure 100002_DEST_PATH_IMAGE038AAA
、
Figure 100002_DEST_PATH_IMAGE040AAA
)组成的对角矩阵，
Figure 100002_DEST_PATH_IMAGE042AAA
为特征向量矩阵；
第
Figure DEST_PATH_IMAGE012_23A
个方位角的补偿系数
Figure DEST_PATH_IMAGE044AAAA
为：
Figure DEST_PATH_IMAGE046AAAA
。
具体的双轴磁强计的多方位椭圆拟合标定系统的工作过程，已经在上述双轴磁强计的多方位椭圆拟合标定方法中详述，此处不予赘述。
本实施例的双轴磁强计的多方位椭圆拟合标定系统，通过将获取的每个方位角的采集数据分别进行椭圆拟合，获得椭圆方程，根据每个椭圆方程的系数计算每个椭圆的中心点坐标；根据计算出的椭圆的中心点坐标与椭圆中心点坐标最优估计值的均方差最小原则，求解出椭圆中心点坐标最优估计值；将每个方位角的采集数据拟合出的椭圆的中心点坐标减去椭圆中心点坐标最优估计值，获得每个方位角的采集数据拟合出的椭圆的随机平移误差；将每个方位角的采集数据去除随机平移误差，得到优化数据；将每个方位角的优化数据分别进行椭圆拟合，获得优化的椭圆方程，然后根据获得的每个优化的椭圆方程计算每个方位角的补偿系数和零偏误差；计算所有方位角的补偿系数的平均值，获得补偿系数
Figure DEST_PATH_IMAGE010_24A
；计算所有方位角的零偏误差的平均值，获得零偏误差
Figure DEST_PATH_IMAGE008_17A
；本实施例的双轴磁强计的多方位椭圆拟合标定系统，消除了随机误差，提高了标定效果。
当然，上述说明并非是对本发明的限制，本发明也并不仅限于上述举例，本技术领域的普通技术人员在本发明的实质范围内所做出的变化、改型、添加或替换，也应属于本发明的保护范围。

Claims (8)

1.一种双轴磁强计的多方位椭圆拟合标定方法，其特征在于：包括：
（1）建立双轴磁强计的标定方程；
Figure DEST_PATH_IMAGE002AA
；
其中，
Figure DEST_PATH_IMAGE004AA
为地磁的真实值；
Figure DEST_PATH_IMAGE006_6A
为双轴磁强计的实测值；
Figure DEST_PATH_IMAGE008_6A
为双轴磁强计的零偏误差；
Figure DEST_PATH_IMAGE010_6A
为补偿系数；
（2）求解
Figure DEST_PATH_IMAGE010_7A
和
Figure DEST_PATH_IMAGE008_7A
：
（21）获取双轴磁强计在多个方位角的采集数据；
（22）将获取的每个方位角的采集数据分别进行椭圆拟合，获得椭圆方程，根据每个椭圆方程的系数计算每个椭圆的中心点坐标；
（23）根据计算出的椭圆的中心点坐标与椭圆中心点坐标最优估计值的均方差最小原则，求解出椭圆中心点坐标最优估计值；
（24）将每个方位角的采集数据拟合出的椭圆的中心点坐标减去椭圆中心点坐标最优估计值，获得每个方位角的采集数据拟合出的椭圆的随机平移误差；
（25）将每个方位角的采集数据去除随机平移误差，得到优化数据；
（26）将每个方位角的优化数据分别进行椭圆拟合，获得优化的椭圆方程，然后根据获得的每个优化的椭圆方程计算每个方位角的补偿系数和零偏误差；
（27）计算所有方位角的补偿系数的平均值，获得补偿系数
Figure DEST_PATH_IMAGE010_8A
；计算所有方位角的零偏误差的平均值，获得零偏误差
Figure DEST_PATH_IMAGE008_8A
。
2.根据权利要求1所述的双轴磁强计的多方位椭圆拟合标定方法，其特征在于：在步骤（22）中，将每个方位角的采集数据分别进行基于最小二乘法的椭圆拟合，获得椭圆方程。
3.根据权利要求1所述的双轴磁强计的多方位椭圆拟合标定方法，其特征在于：在步骤（26）中，将每个方位角的优化数据分别进行基于最小二乘法的椭圆拟合，获得优化的椭圆方程。
4.根据权利要求1所述的双轴磁强计的多方位椭圆拟合标定方法，其特征在于：在步骤（26）中，所述根据获得的每个优化的椭圆方程计算每个方位角的补偿系数和零偏误差，具体包括下述步骤：
（26-1）由第
Figure DEST_PATH_IMAGE012AA
个方位角的优化数据拟合出的优化的椭圆方程为：
Figure DEST_PATH_IMAGE014AA
；
（26-2）
Figure DEST_PATH_IMAGE016AA
，
Figure DEST_PATH_IMAGE018AA
，
Figure DEST_PATH_IMAGE020AA
；
Figure DEST_PATH_IMAGE022AA
；
Figure DEST_PATH_IMAGE024AA
；
（26-3）第
Figure DEST_PATH_IMAGE012AAA
个方位角的零偏误差
Figure DEST_PATH_IMAGE026AA
为：
Figure DEST_PATH_IMAGE028AA
；
（26-4）矩阵
Figure DEST_PATH_IMAGE030AA
；
将
Figure DEST_PATH_IMAGE032AA
进行奇异值分解，可得
Figure DEST_PATH_IMAGE034AA
；其中，
Figure DEST_PATH_IMAGE036AA
为由特征值(
Figure DEST_PATH_IMAGE038AA
、
Figure DEST_PATH_IMAGE040AA
)组成的对角矩阵，
Figure DEST_PATH_IMAGE042AA
为特征向量矩阵；
第
Figure DEST_PATH_IMAGE012AAAA
个方位角的补偿系数
Figure DEST_PATH_IMAGE044AA
为：
Figure DEST_PATH_IMAGE046A
。
5.一种双轴磁强计的多方位椭圆拟合标定系统，其特征在于：包括：
方程建立模块，用于建立双轴磁强计的标定方程；
Figure DEST_PATH_IMAGE002AAA
；
其中，
Figure DEST_PATH_IMAGE004AAA
为地磁的真实值；
Figure DEST_PATH_IMAGE006_7A
为双轴磁强计的实测值；
Figure DEST_PATH_IMAGE008_9A
为双轴磁强计的零偏误差；
Figure DEST_PATH_IMAGE010_9A
为补偿系数；
求解模块，用于求解
Figure DEST_PATH_IMAGE010_10A
和
Figure DEST_PATH_IMAGE008_10A
，具体包括：
获取单元，用于获取双轴磁强计在多个方位角的采集数据；
第一拟合计算单元，用于将获取的每个方位角的采集数据分别进行椭圆拟合，获得椭圆方程，根据每个椭圆方程的系数计算每个椭圆的中心点坐标；
最优估计值求解单元，用于根据计算出的椭圆的中心点坐标与椭圆中心点坐标最优估计值的均方差最小原则，求解出椭圆中心点坐标最优估计值；
随机平移误差计算单元，用于将每个方位角的采集数据拟合出的椭圆的中心点坐标减去椭圆中心点坐标最优估计值，获得每个方位角的采集数据拟合出的椭圆的随机平移误差；
优化数据计算单元，用于将每个方位角的采集数据去除随机平移误差，得到优化数据；
第二拟合计算单元，用于将每个方位角的优化数据分别进行椭圆拟合，获得优化的椭圆方程，然后根据获得的每个优化的椭圆方程计算每个方位角的补偿系数和零偏误差；
计算单元，用于计算所有方位角的补偿系数的平均值，获得补偿系数
Figure DEST_PATH_IMAGE010_11A
；计算所有方位角的零偏误差的平均值，获得零偏误差
Figure DEST_PATH_IMAGE008_11A
。
6.根据权利要求5所述的双轴磁强计的多方位椭圆拟合标定系统，其特征在于：所述第一拟合计算单元，具体用于将每个方位角的采集数据分别进行基于最小二乘法的椭圆拟合，获得椭圆方程。
7.根据权利要求5所述的双轴磁强计的多方位椭圆拟合标定系统，其特征在于：所述第二拟合计算单元，具体用于将每个方位角的优化数据分别进行基于最小二乘法的椭圆拟合，获得优化的椭圆方程。
8.根据权利要求5所述的双轴磁强计的多方位椭圆拟合标定系统，其特征在于：所述第二拟合计算单元，具体用于：
（26-1）由第
Figure DEST_PATH_IMAGE012_5A
个方位角的优化数据拟合出的优化的椭圆方程为：
Figure DEST_PATH_IMAGE014AAA
；
（26-2）
Figure DEST_PATH_IMAGE016AAA
，
Figure DEST_PATH_IMAGE018AAA
，
Figure DEST_PATH_IMAGE020AAA
；
Figure DEST_PATH_IMAGE022AAA
；
Figure DEST_PATH_IMAGE024AAA
；
（26-3）第
Figure DEST_PATH_IMAGE012_6A
个方位角的零偏误差
Figure DEST_PATH_IMAGE026AAA
为：
Figure DEST_PATH_IMAGE028AAA
；
（26-4）矩阵
Figure DEST_PATH_IMAGE030AAA
；
将
Figure DEST_PATH_IMAGE032AAA
进行奇异值分解，可得
Figure DEST_PATH_IMAGE034AAA
；其中，
Figure DEST_PATH_IMAGE036AAA
为由特征值(
Figure DEST_PATH_IMAGE038AAA
、
Figure DEST_PATH_IMAGE040AAA
)组成的对角矩阵，
Figure DEST_PATH_IMAGE042AAA
为特征向量矩阵；
第
Figure DEST_PATH_IMAGE012_7A
个方位角的补偿系数
Figure DEST_PATH_IMAGE044AAA
为：
Figure DEST_PATH_IMAGE046AA
。
CN202111212477.2A 2021-10-19 2021-10-19 一种双轴磁强计的多方位椭圆拟合标定方法及系统 Active CN113640726B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111212477.2A CN113640726B (zh) 2021-10-19 2021-10-19 一种双轴磁强计的多方位椭圆拟合标定方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111212477.2A CN113640726B (zh) 2021-10-19 2021-10-19 一种双轴磁强计的多方位椭圆拟合标定方法及系统

Publications (2)

Publication Number Publication Date
CN113640726A CN113640726A (zh) 2021-11-12
CN113640726B true CN113640726B (zh) 2021-12-21

Family

ID=78427305

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111212477.2A Active CN113640726B (zh) 2021-10-19 2021-10-19 一种双轴磁强计的多方位椭圆拟合标定方法及系统

Country Status (1)

Country Link
CN (1) CN113640726B (zh)

Citations (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0907067A2 (de) * 1997-10-01 1999-04-07 Mannesmann VDO Aktiengesellschaft Verfahren zur Filterung von Messdaten eines Magnetfeldsensors
JP2004309227A (ja) * 2003-04-03 2004-11-04 Asahi Kasei Electronics Co Ltd 計測装置、方位角計測装置及びキャリブレーションプログラム、並びにキャリブレーション方法
CN1715834A (zh) * 2004-06-11 2006-01-04 雅马哈株式会社 用于测量地磁传感器磁偏的方法与装置以及便携电子装置
CN101806595A (zh) * 2010-04-19 2010-08-18 美新半导体（无锡）有限公司 一种两维电子指南针校准算法
CN102375160A (zh) * 2010-08-04 2012-03-14 美新半导体（无锡）有限公司 一种校准两轴地磁传感器软硬磁误差的方法
CN102597920A (zh) * 2009-11-04 2012-07-18 高通股份有限公司 针对偏移、灵敏度和非正交性来校准多维传感器
JP2013057552A (ja) * 2011-09-07 2013-03-28 Yamaha Corp 地磁気測定装置、地磁気測定方法、及び地磁気測定プログラム
CN104237822A (zh) * 2013-06-20 2014-12-24 意法半导体(中国)投资有限公司 用于电子磁力计传感器的补偿磁干扰
CN104482944A (zh) * 2014-12-30 2015-04-01 大连楼兰科技股份有限公司 一种基于椭圆拟合的地磁传感器动态校准方法
CN104582805A (zh) * 2012-08-17 2015-04-29 微软公司 动态磁力计校准
CN105865492A (zh) * 2016-05-31 2016-08-17 清华大学 两轴磁强计在线误差补偿方法及系统
CN106125026A (zh) * 2016-06-12 2016-11-16 哈尔滨工程大学 一种不依赖于地磁场场量的三轴磁强计全误差参数辨识与校正方法
CN107024674A (zh) * 2017-05-26 2017-08-08 北京航空航天大学 一种基于递推最小二乘法的磁强计现场快速标定方法
CN107390152A (zh) * 2017-07-14 2017-11-24 歌尔科技有限公司 一种磁力计的校准方法、装置及电子设备
CN107607899A (zh) * 2017-09-28 2018-01-19 歌尔科技有限公司 磁力计校准方法及设备
CN107870001A (zh) * 2017-11-27 2018-04-03 东南大学 一种基于椭球拟合的磁力计校正方法
EP3364153A1 (en) * 2015-10-13 2018-08-22 Shanghai Huace Navigation Technology Ltd. Method for updating all attitude angles of agricultural machine on the basis of nine-axis mems sensor
CN108453727A (zh) * 2018-01-11 2018-08-28 中国人民解放军63920部队 基于椭圆特征的机械臂末端位姿误差校正方法及系统
CN110163905A (zh) * 2019-05-08 2019-08-23 武汉惟景三维科技有限公司 一种高精度椭圆拟合方法
CN111121824A (zh) * 2020-01-03 2020-05-08 西北工业大学 一种mems传感器的标定方法
CN111780786A (zh) * 2020-08-08 2020-10-16 武汉利科夫科技有限公司 一种三轴tmr传感器在线校准方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8825426B2 (en) * 2010-04-09 2014-09-02 CSR Technology Holdings Inc. Method and apparatus for calibrating a magnetic sensor

Patent Citations (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0907067A2 (de) * 1997-10-01 1999-04-07 Mannesmann VDO Aktiengesellschaft Verfahren zur Filterung von Messdaten eines Magnetfeldsensors
JP2004309227A (ja) * 2003-04-03 2004-11-04 Asahi Kasei Electronics Co Ltd 計測装置、方位角計測装置及びキャリブレーションプログラム、並びにキャリブレーション方法
CN1715834A (zh) * 2004-06-11 2006-01-04 雅马哈株式会社 用于测量地磁传感器磁偏的方法与装置以及便携电子装置
CN102597920A (zh) * 2009-11-04 2012-07-18 高通股份有限公司 针对偏移、灵敏度和非正交性来校准多维传感器
EP2497007A1 (en) * 2009-11-04 2012-09-12 Qualcomm Incorporated Calibrating multi-dimensional sensor for offset, sensitivity, and non-orthogonality
CN101806595A (zh) * 2010-04-19 2010-08-18 美新半导体（无锡）有限公司 一种两维电子指南针校准算法
CN102375160A (zh) * 2010-08-04 2012-03-14 美新半导体（无锡）有限公司 一种校准两轴地磁传感器软硬磁误差的方法
JP2013057552A (ja) * 2011-09-07 2013-03-28 Yamaha Corp 地磁気測定装置、地磁気測定方法、及び地磁気測定プログラム
CN104582805A (zh) * 2012-08-17 2015-04-29 微软公司 动态磁力计校准
CN104237822A (zh) * 2013-06-20 2014-12-24 意法半导体(中国)投资有限公司 用于电子磁力计传感器的补偿磁干扰
CN104482944A (zh) * 2014-12-30 2015-04-01 大连楼兰科技股份有限公司 一种基于椭圆拟合的地磁传感器动态校准方法
EP3364153A1 (en) * 2015-10-13 2018-08-22 Shanghai Huace Navigation Technology Ltd. Method for updating all attitude angles of agricultural machine on the basis of nine-axis mems sensor
CN105865492A (zh) * 2016-05-31 2016-08-17 清华大学 两轴磁强计在线误差补偿方法及系统
CN106125026A (zh) * 2016-06-12 2016-11-16 哈尔滨工程大学 一种不依赖于地磁场场量的三轴磁强计全误差参数辨识与校正方法
CN107024674A (zh) * 2017-05-26 2017-08-08 北京航空航天大学 一种基于递推最小二乘法的磁强计现场快速标定方法
CN107390152A (zh) * 2017-07-14 2017-11-24 歌尔科技有限公司 一种磁力计的校准方法、装置及电子设备
CN107607899A (zh) * 2017-09-28 2018-01-19 歌尔科技有限公司 磁力计校准方法及设备
CN107870001A (zh) * 2017-11-27 2018-04-03 东南大学 一种基于椭球拟合的磁力计校正方法
CN108453727A (zh) * 2018-01-11 2018-08-28 中国人民解放军63920部队 基于椭圆特征的机械臂末端位姿误差校正方法及系统
CN110163905A (zh) * 2019-05-08 2019-08-23 武汉惟景三维科技有限公司 一种高精度椭圆拟合方法
CN111121824A (zh) * 2020-01-03 2020-05-08 西北工业大学 一种mems传感器的标定方法
CN111780786A (zh) * 2020-08-08 2020-10-16 武汉利科夫科技有限公司 一种三轴tmr传感器在线校准方法

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
NUMERICAL SIMULATIONS ON IONOSPHERIC CONTROL OF POLARIZATION OF LOW-LATITUDE GEOMAGNETIC-PULSATIONS;ITONAGA, M;《ANNALES GEOPHYSICAE-ATMOSPHERES HYDROSPHERES AND SPACE SCIENCES》;19931231;全文 *
Statistical study of geomagnetic field line resonances observed by CHAMP and on the ground;Heilig, B;《JOURNAL OF GEOPHYSICAL RESEARCH-SPACE PHYSICS》;20131231;全文 *
基于椭圆拟合的双轴磁传感器标定方法;李冰;《探测与控制学报》;20200630;全文 *
弹载三轴磁强计的椭球拟合补偿方法;安亮亮;《传感器与微系统》;20201231;全文 *
强磁干扰环境下磁航向误差补偿技术研究;袁广民;《航空工程进展》;20120531;全文 *

Also Published As

Publication number Publication date
CN113640726A (zh) 2021-11-12

Similar Documents

Publication Publication Date Title
JP4317173B2 (ja) 移動物体の方向検出方法及びそのシステム
CN107917704B (zh) 一种磁罗盘校准方法及装置、计算机可读存储介质
CN109443349A (zh) 一种姿态航向测量系统及其融合方法、存储介质
JP2008076397A (ja) 磁気の環境を考慮したコンパスセンサの較正方法，装置および媒体と、これを用いた方位角測定方法、装置および媒体
CN205333067U (zh) 一种激光摄影测量系统
CN111765879A (zh) 一种三维电子罗盘装置及实用校准方法
CN114509069B (zh) 基于蓝牙aoa和imu融合的室内导航定位系统
Hoang et al. Pre-processing technique for compass-less madgwick in heading estimation for industry 4.0
CN107561489B (zh) 基于异常检测的mls无源测向定位方法
Han et al. A novel orientation method for polarized light compass under tilted conditions
CN113640726B (zh) 一种双轴磁强计的多方位椭圆拟合标定方法及系统
CN116211278A (zh) 磁定位方法及磁定位装置
Zhao et al. Robust adaptive heading tracking fusion for polarization compass with uncertain dynamics and external disturbances
Alkhatib et al. Further results on a robust multivariate time series analysis in nonlinear models with autoregressive and t-distributed errors
CN109931956B (zh) 捷联式三分量磁测系统中三轴磁力仪与惯导安装误差校正方法
CN110375773B (zh) Mems惯导系统姿态初始化方法
CN110398702B (zh) 一种基于多传感器融合的实时在线磁校准方法
CN106092140A (zh) 一种陀螺仪零偏估计方法
CN102322845A (zh) 测量方位角的装置及方法
CN115979245A (zh) 一种自校准估计的磁感应网络定位方法
Dan et al. Application Of Strongly Tracking Kalman Filter In MEMS Gyroscope Bias Compensation
CN113503891B (zh) 一种sinsdvl对准校正方法、系统、介质及设备
CN113985494A (zh) 一种基于无迹卡尔曼算法海底地震计中电子罗盘误差补偿方法
KR20050080919A (ko) 실시간 외부자계를 자동보정하는 항법용 자기 콤파스 및이를 이용한 보정방법
CN117537792B (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
CB03 Change of inventor or designer information

Inventor after: An Liangliang

Inventor after: Ma Yinghui

Inventor after: Jiao Zhiwei

Inventor after: Dong Lin

Inventor after: Zhou Shenghong

Inventor after: Yan Shulin

Inventor after: Wei Peiping

Inventor after: Chen Xiaozhi

Inventor after: Zhang Longlong

Inventor after: Liu Hailong

Inventor after: Zhou Hang

Inventor before: An Liangliang

Inventor before: Ma Yinghui

Inventor before: Jiao Zhiwei

Inventor before: Dong Lin

Inventor before: Zhou Shenghong

Inventor before: Yan Shulin

Inventor before: Wei Peiping

Inventor before: Chen Xiaozhi

Inventor before: Zhang Longlong

Inventor before: Liu Hailong

Inventor before: Zhou Hang

CB03 Change of inventor or designer information