CN107703469A - 一种磁力计标定方法及装置 - Google Patents
一种磁力计标定方法及装置 Download PDFInfo
- Publication number
- CN107703469A CN107703469A CN201710738913.7A CN201710738913A CN107703469A CN 107703469 A CN107703469 A CN 107703469A CN 201710738913 A CN201710738913 A CN 201710738913A CN 107703469 A CN107703469 A CN 107703469A
- Authority
- CN
- China
- Prior art keywords
- coefficient
- oval
- matrix
- earth magnetism
- magnetometer
- 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.)
- Pending
Links
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
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Measuring Magnetic Variables (AREA)
Abstract
本发明涉及磁力计标定领域,公开了一种磁力计标定方法及装置,通过获取磁力计的测量的地磁场数据;将所述地磁场数据做滤波处理;对滤波处理后的地磁场数据进行温度补偿;采用约束条件下的最小二乘法对温度补偿后的地磁数据进行椭圆拟合,求出椭圆系数;根据椭圆系数计算标定系数,通过标定系数进行误差校正,以获得补偿后的真实地磁强度。本发明降低了测量误差,能有效提高磁力计输出精度。
Description
技术领域
本发明涉及磁力计标定领域,尤其涉及一种磁力计标定方法及装置。
背景技术
磁力计主要用于测量惯性系统的线磁力,按照工作原理可以分为压阻式、电容式、谐振式、伺服式以及隧道式。工作原理不同,以及加工进度的难易使得具体性能有很大差异,其中,伺服式和隧道式测量精度和信噪比好于其他方式,但是,电容式磁力计是使用最为广泛的磁力计。在使用过程中,磁力计实际输出信号包含多种误差分量,不仅有耦合性误差,也有随机性误差,如图1所示,由于各种磁场干扰的存在,整个磁力计输出都发生扭曲,MEMS磁力计测量出来的磁场,呈现一个椭球的形状。
发明内容
本发明提供一种磁力计标定方法及装置,解决现有技术中振动数据采集存在非连续性,导致重要信息丢失的技术问题。
本发明的目的是通过以下技术方案实现的:
一种磁力计标定方法,包括:
获取磁力计的测量的地磁场数据;
将所述地磁场数据做滤波处理;
对滤波处理后的地磁场数据进行温度补偿;
采用约束条件下的最小二乘法对温度补偿后的地磁数据进行椭圆拟合,求出椭圆系数;
根据椭圆系数计算标定系数,通过标定系数进行误差校正,以获得补偿后的真实地磁强度。
一种磁力计标定装置,包括:
获取模块,用于获取磁力计的测量的地磁场数据;
滤波模块,用于将所述地磁场数据做滤波处理;
温度补偿模块,用于对滤波处理后的地磁场数据进行温度补偿;
系数拟合模块,用于采用约束条件下的最小二乘法对温度补偿后的地磁数据进行椭圆拟合,求出椭圆系数;
标定模块,用于根据椭圆系数计算标定系数,通过标定系数进行误差校正,以获得补偿后的真实地磁强度。
本发明提供一种磁力计标定方法及装置,通过获取磁力计的测量的地磁场数据;将所述地磁场数据做滤波处理;对滤波处理后的地磁场数据进行温度补偿;采用约束条件下的最小二乘法对温度补偿后的地磁数据进行椭圆拟合,求出椭圆系数;根据椭圆系数计算标定系数,通过标定系数进行误差校正,以获得补偿后的真实地磁强度。本发明降低了测量误差,能有效提高磁力计输出精度。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可根据这些附图获得其他的附图。
图1为现有技术中磁力计测量出的磁场数值示意图;
图2为本发明实施例的一种磁力计标定方法的流程图;
图3为应用本发明实施例提供的一种磁力计标定方法测量出的磁场数值示意图;
图4为本发明实施例的一种磁力计标定装置的结构示意图。
具体实施方式
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
如图1所示,为一种磁力计标定方法,包括:
步骤101、获取磁力计的测量的地磁场数据;
其中,其中,通常在磁力计输出的过程中,系统误差由五类干扰源组成:量化误差Csf,耦合误差Cm,漂移误差Czb,硬磁误差Bm和软磁误差Sm,Bt为实际输出磁力矢量,Be为理论输出值,误差模型为Bt=CmCsfSm(Be+Bm)+Sm
其中,硬磁干扰Bm主要是磁力计附近一些永磁体引起的干扰,其磁力影响可以认为强度和矢量方向是永恒的,不会随着环境而改变。软磁干扰Sm主要是磁力计附近的软磁体等引起,该磁场的大小和方向随环境和时间而变化,一般认为不存在磁滞现象,可以假定软磁干扰误差为线性,简化如下所示:
Be=G×(Bt-Sm)-Bm,其中,
G为标定系数矩阵
步骤102、将所述地磁场数据做滤波处理;
步骤103、对滤波处理后的地磁场数据进行温度补偿;
步骤104、采用约束条件下的最小二乘法对温度补偿后的地磁数据进行椭圆拟合,求出椭圆系数;
步骤105、根据椭圆系数计算标定系数,通过标定系数进行误差校正,以获得补偿后的真实地磁强度。
步骤102中采用的滤波方法为卡尔曼滤波或防脉冲干扰平均滤波法。
步骤103中通过最小二乘法拟合进行温度补偿。
步骤104具体可以包括:
步骤104-1、根据三轴的地磁场数据Btx,Bty,Btz计算椭圆拟合矩阵H=Aξ,
其中, 其中,
v为奇异值分解右矩阵;
步骤104-2、在为平差准则的情况下,对矩阵[A;H]进行SVD分解,以求解ξ;
步骤104-3、根据ξ求解值、椭圆系数矩阵i及椭球中心B0,将地磁数据的椭圆拟合表达式修改为椭圆系数矩阵 其中,GTG=K×A,Bm=G(B0-Sm),G为标定系数矩阵,Bm为硬磁误差,Sm为软磁误差;
步骤105具体可以包括:
步骤105-1、对椭圆系数矩阵i进行SVD分解,其中,椭圆系数矩阵
步骤105-2、根据G=-sqrt(Si)Vi,求解标定系数矩阵。本步骤中由于磁力计的值在算法解算过程中,只是一个标量,因此可设GTG=K×A中的K=1。
如图3所示,为本发明实施例中应用一种磁力计标定方法进行标定之后,测量出的磁场数值示意图,从图中可知椭圆的大小明显减小,说明误差已经大大减小,有效提高了磁力计输出精度。
本发明提供一种磁力计标定方法,通过获取磁力计的测量的地磁场数据;将所述地磁场数据做滤波处理;对滤波处理后的地磁场数据进行温度补偿;采用约束条件下的最小二乘法对温度补偿后的地磁数据进行椭圆拟合,求出椭圆系数;根据椭圆系数计算标定系数,通过标定系数进行误差校正,以获得补偿后的真实地磁强度。本发明降低了测量误差,能有效提高磁力计输出精度。
本发明实施例还提供了一种磁力计标定装置,如图4所示,包括:
获取模块410,用于获取磁力计的测量的地磁场数据;
滤波模块420,用于将所述地磁场数据做滤波处理;
温度补偿模块430,用于对滤波处理后的地磁场数据进行温度补偿;
系数拟合模块440,用于采用约束条件下的最小二乘法对温度补偿后的地磁数据进行椭圆拟合,求出椭圆系数;
标定模块450,用于根据椭圆系数计算标定系数,通过标定系数进行误差校正,以获得补偿后的真实地磁强度。
其中,所述滤波模块420,具体用于通过卡尔曼滤波或防脉冲干扰平均滤波法对所述系统测量值做滤波处理。
温度补偿模块430具体通过最小二乘法拟合进行温度补偿。
所述系数拟合模块440包括:
第一计算模块441,用于根据三轴的地磁场数据Btx,Bty,Btz计算椭圆拟合矩阵H=Aξ,其中,
其中,
v为奇异值分解右矩阵;
第二计算模块442,用于在为平差准则的情况下,对矩阵[A;H]进行SVD分解,以求解ξ;
第三计算模块443,用于根据ξ求解值、椭圆系数矩阵i及椭球中心B0,将地磁数据的椭圆拟合表达式修改为椭圆系数矩阵其中,GTG=K×A,Bm=G(B0-Sm),G为标定系数矩阵,Bm为硬磁误差,Sm为软磁误差。
所述标定模块450包括:
分解计算模块451,用于对椭圆系数矩阵i进行SVD分解,其中,椭圆系数矩阵
系数计算模块452,用于根据G=-sqrt(Si)Vi,求解标定系数矩阵。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到本发明可借助软件加必需的硬件平台的方式来实现,当然也可以全部通过硬件来实施,但很多情况下前者是更佳的实施方式。基于这样的理解,本发明的技术方案对背景技术做出贡献的全部或者部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在存储介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例或者实施例的某些部分所述的方法。
以上对本发明进行了详细介绍,本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。
Claims (10)
1.一种磁力计标定方法,其特征在于,包括:
获取磁力计的测量的地磁场数据;
将所述地磁场数据做滤波处理;
对滤波处理后的地磁场数据进行温度补偿;
采用约束条件下的最小二乘法对温度补偿后的地磁数据进行椭圆拟合,求出椭圆系数;
根据椭圆系数计算标定系数,通过标定系数进行误差校正,以获得补偿后的真实地磁强度。
2.根据权利要求1所述的磁力计标定方法,其特征在于,所述将所述地磁场数据做滤波处理采用的滤波方法为卡尔曼滤波或防脉冲干扰平均滤波法。
3.根据权利要求1所述的磁力计标定方法,其特征在于,所述对滤波处理后的系统测量值通过最小二乘法拟合进行温度补偿。
4.根据权利要求1所述的磁力计标定方法,其特征在于,所述采用约束条件下的最小二乘法对温度补偿后的地磁数据进行椭圆拟合,求出椭圆系数的步骤包括:
根据三轴的地磁场数据Btx,Bty,Btz计算椭圆拟合矩阵H=Aξ,其中, 其中,
v为奇异值分解右矩阵;
在为平差准则的情况下,对矩阵[A;H]进行SVD分解,以求解ξ;
根据ξ求解值、椭圆系数矩阵i及椭球中心B0,将地磁数据的椭圆拟合表达式修改为椭圆系数矩阵 其中,GTG=K×A,Bm=G(B0-Sm),G为标定系数矩阵,Bm为硬磁误差,Sm为软磁误差。
5.根据权利要求1所述的磁力计标定方法,其特征在于,
对椭圆系数矩阵i进行SVD分解,其中,椭圆系数矩阵
根据G=-sqrt(Si)Vi,求解标定系数矩阵。
6.一种磁力计标定装置,其特征在于,包括:
获取模块,用于获取磁力计的测量的地磁场数据;
滤波模块,用于将所述地磁场数据做滤波处理;
温度补偿模块,用于对滤波处理后的地磁场数据进行温度补偿;
系数拟合模块,用于采用约束条件下的最小二乘法对温度补偿后的地磁数据进行椭圆拟合,求出椭圆系数;
标定模块,用于根据椭圆系数计算标定系数,通过标定系数进行误差校正,以获得补偿后的真实地磁强度。
7.根据权利要求6所述的磁力计标定装置,其特征在于,所述滤波模块,具体用于通过卡尔曼滤波或防脉冲干扰平均滤波法对所述系统测量值做滤波处理。
8.根据权利要求6所述的磁力计标定装置,其特征在于,温度补偿模块具体通过最小二乘法拟合进行温度补偿。
9.根据权利要求6所述的磁力计标定装置,其特征在于,所述系数拟合模块包括:
第一计算模块,用于根据三轴的地磁场数据Btx,Bty,Btz计算椭圆拟合矩阵H=Aξ,其中, 其中,
v为奇异值分解右矩阵;
第二计算模块,用于在为平差准则的情况下,对矩阵[A;H]进行SVD分解,以求解ξ;
第三计算模块,用于根据ξ求解值、椭圆系数矩阵i及椭球中心B0,将地磁数据的椭圆拟合表达式修改为椭圆系数矩阵 其中,GTG=K×A,Bm=G(B0-Sm),G为标定系数矩阵,Bm为硬磁误差,Sm为软磁误差。
10.根据权利要求6所述的磁力计标定装置,其特征在于,所述标定模块包括:
分解计算模块,用于对椭圆系数矩阵i进行SVD分解,其中,椭圆系数矩阵
系数计算模块,用于根据G=-sqrt(Si)Vi,求解标定系数矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710738913.7A CN107703469A (zh) | 2017-08-25 | 2017-08-25 | 一种磁力计标定方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710738913.7A CN107703469A (zh) | 2017-08-25 | 2017-08-25 | 一种磁力计标定方法及装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107703469A true CN107703469A (zh) | 2018-02-16 |
Family
ID=61170402
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710738913.7A Pending CN107703469A (zh) | 2017-08-25 | 2017-08-25 | 一种磁力计标定方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107703469A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108680874A (zh) * | 2018-04-25 | 2018-10-19 | 浙江工业大学 | 一种基于脉冲泵浦式原子磁力计的弱磁场重建方法 |
CN109146956A (zh) * | 2018-08-09 | 2019-01-04 | 厦门市计量检定测试院 | 一种视觉定位系统的线性误差修正系数获取方法 |
CN110530397A (zh) * | 2019-08-08 | 2019-12-03 | 北京首贝科技发展有限公司 | 一种基于九轴imu的磁场自动标定方法 |
CN111998848A (zh) * | 2020-08-28 | 2020-11-27 | 北京信息科技大学 | 对地滚转指向确定方法及装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1879006A (zh) * | 2004-10-07 | 2006-12-13 | 雅马哈株式会社 | 地磁传感器和地磁传感器校正方法、温度传感器和温度传感器校正方法、地磁检测装置 |
CN104482944A (zh) * | 2014-12-30 | 2015-04-01 | 大连楼兰科技股份有限公司 | 一种基于椭圆拟合的地磁传感器动态校准方法 |
US20150247739A1 (en) * | 2008-03-06 | 2015-09-03 | Texas Instruments Incorporated | Processes for more accurately calibrating and operating e-compass for tilt error, circuits, and systems |
CN106918352A (zh) * | 2017-05-02 | 2017-07-04 | 桂林电子科技大学 | 一种手持式mems磁力计的航向校正方法 |
-
2017
- 2017-08-25 CN CN201710738913.7A patent/CN107703469A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1879006A (zh) * | 2004-10-07 | 2006-12-13 | 雅马哈株式会社 | 地磁传感器和地磁传感器校正方法、温度传感器和温度传感器校正方法、地磁检测装置 |
US20150247739A1 (en) * | 2008-03-06 | 2015-09-03 | Texas Instruments Incorporated | Processes for more accurately calibrating and operating e-compass for tilt error, circuits, and systems |
CN104482944A (zh) * | 2014-12-30 | 2015-04-01 | 大连楼兰科技股份有限公司 | 一种基于椭圆拟合的地磁传感器动态校准方法 |
CN106918352A (zh) * | 2017-05-02 | 2017-07-04 | 桂林电子科技大学 | 一种手持式mems磁力计的航向校正方法 |
Non-Patent Citations (6)
Title |
---|
JIANCHENG FANG ET.AL: "A Novel Calibration Method of Magnetic Compass Based on Ellipsoid Fitting", 《IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT》 * |
WENGUANG FENG ET.AL: "A Calibration Method of Three-axis Magnetic Sensor Based on Ellipsoid Fitting", 《JOURNAL OF INFORMATION & COMPUTATIONAL SCIENCE》 * |
于振涛 等: "基于椭球约束的载体三维磁场补偿方法", 《哈尔滨工程大学学报》 * |
孟健: "三轴磁强计误差分析与校正研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
张晓明 等: "基于椭圆约束的新型载体磁场标定及补偿技术", 《仪器仪表学报》 * |
黄学功 等: "地磁信号检测系统误差分析与补偿方法研究", 《兵工学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108680874A (zh) * | 2018-04-25 | 2018-10-19 | 浙江工业大学 | 一种基于脉冲泵浦式原子磁力计的弱磁场重建方法 |
CN108680874B (zh) * | 2018-04-25 | 2020-05-26 | 浙江工业大学 | 一种基于脉冲泵浦式原子磁力计的弱磁场重建方法 |
CN109146956A (zh) * | 2018-08-09 | 2019-01-04 | 厦门市计量检定测试院 | 一种视觉定位系统的线性误差修正系数获取方法 |
CN110530397A (zh) * | 2019-08-08 | 2019-12-03 | 北京首贝科技发展有限公司 | 一种基于九轴imu的磁场自动标定方法 |
CN111998848A (zh) * | 2020-08-28 | 2020-11-27 | 北京信息科技大学 | 对地滚转指向确定方法及装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107703469A (zh) | 一种磁力计标定方法及装置 | |
Valenti et al. | Keeping a good attitude: A quaternion-based orientation filter for IMUs and MARGs | |
CN104884902B (zh) | 用于三轴磁力计和三轴加速度计的数据融合的方法和装置 | |
US9389281B2 (en) | Magnetic compensation circuit and method for compensating the output of a magnetic sensor, responding to changes in a first magnetic field | |
US10132636B2 (en) | Hybrid inertial/magnetic system for determining the position and orientation of a mobile body | |
CN202815202U (zh) | 基于九个三轴矢量磁传感器的磁性目标磁矩测量装置 | |
Zhang et al. | Mathematical model and matlab simulation of strapdown inertial navigation system | |
CN107544042A (zh) | 一种磁力计阵列校正方法 | |
CN109856689B (zh) | 一种超导航磁梯度张量数据抑噪处理方法和系统 | |
CN107870001A (zh) | 一种基于椭球拟合的磁力计校正方法 | |
Hayashi | An MHD simulation model of time‐dependent co‐rotating solar wind | |
CN113156355B (zh) | 一种超导全张量磁梯度测量装置的磁干扰补偿方法 | |
CN107290801A (zh) | 基于函数链接型神经网络和场模平方差的捷联三轴磁强计误差一步校正方法 | |
CN108072910A (zh) | 一种分布式磁异常探测系统环境磁补偿方法 | |
Kang et al. | A Fast in‐Motion Alignment Algorithm for DVL Aided SINS | |
CN109521384A (zh) | 一种基于原子磁强计的矢量磁补偿方法 | |
CN107561592A (zh) | 一种密度为多项式的任意多面体的重力场正演方法 | |
CN103995152A (zh) | 一种外场环境三维测量加速度计误差无奇异估计方法 | |
Wan et al. | Improved component compensation for geomagnetic field vector measurement using Lagrange multiplier method | |
CN103235278B (zh) | 一种测量磁强计三磁轴之间的正交性的方法 | |
CN107589464B (zh) | 一种卫星测高重力数据与船测重力数据融合方法 | |
CN114705184A (zh) | 基于神经网络的九轴姿态传感器一体化智能误差补偿方法 | |
US8954608B1 (en) | Network clock synchronization using total-field magnetometers and the spatial coherence of the earth's geomagnetic field | |
Liu et al. | An efficient nonlinear filter for spacecraft attitude estimation | |
CN114111835A (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20180216 |
|
RJ01 | Rejection of invention patent application after publication |