CN107907142A - 一种磁力计的初始校准方法、装置和磁力计 - Google Patents
一种磁力计的初始校准方法、装置和磁力计 Download PDFInfo
- Publication number
- CN107907142A CN107907142A CN201710949166.1A CN201710949166A CN107907142A CN 107907142 A CN107907142 A CN 107907142A CN 201710949166 A CN201710949166 A CN 201710949166A CN 107907142 A CN107907142 A CN 107907142A
- Authority
- CN
- China
- Prior art keywords
- magnetic field
- magnetometer
- field data
- axis
- maximum
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Radar, Positioning & Navigation (AREA)
- Operations Research (AREA)
- Algebra (AREA)
- Remote Sensing (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Measuring Magnetic Variables (AREA)
Abstract
本发明公开了一种磁力计的初始校准方法、装置和磁力计。该方法包括:获取磁力计采集的多组磁场数据,根据多组磁场数据,确定磁力计的磁场空间,磁场空间包括各轴的最大值的磁场数据和最小值的磁场数据;将各轴的最大值的磁场数据和最小值的磁场数据分别带入磁力计的校准方程,采用最小二乘法计算校准系数;判断校准系数是否在预设阈值范围内;若判断为是,则结束磁力计的初始校准;若判断为否,则继续获取磁力计采集的磁场数据,重新确定磁力计的磁场空间。可见,本方案可以根据计算的校准系数明确初始校准完成的时机,初始校准即可获得准确的校准系数,保证磁力计在初始一段时间的磁场数据的准确度,该技术方案的实施可以应用在自动化工程中。
Description
技术领域
本发明涉及传感器技术领域,特别涉及一种磁力计的初始校准方法、装置和磁力计。
背景技术
磁力计传感器是九轴传感器重要组成部分,它对于解算描述空间姿态的姿态角之一的航向角具有决定性作用。正常情况下,磁力计测得的磁场强度由地磁场产生,但是由于硬铁和软铁效应的存在,使得磁力计测量结果出现比较大的偏差,必须对磁力计进行初始校准才能使用。
目前,磁力计的初始校准方法中,不管是画“8”字校准法,还是十面校准法等,对于磁力计的初始校准,上述方法不适于应用到自动化的工程中;现在用到自动化算法校准中的磁力计的初始校准,在校准时无法获知何时校准完成,换句话说,就是没有明确的校准完成反馈,所以开始时磁力计校准系数不理想,校准结果不准确,只能通过在磁力的应用中通过自适应的校准来逐渐逼近准确的磁场,结果是牺牲了初始一段时间的磁场数据的准确度。
发明内容
鉴于上述问题,提出了本发明的一种磁力计的初始校准方法、装置和磁力计,以便解决或至少部分地解决上述问题。
根据本发明的一个方面,提供了一种磁力计的初始校准方法,所述方法包括:
获取磁力计采集的多组磁场数据,根据所述多组磁场数据,确定所述磁力计的磁场空间,所述磁场空间包括各轴的最大值的磁场数据和最小值的磁场数据;
将各轴的最大值的磁场数据和最小值的磁场数据分别带入所述磁力计的校准方程,采用最小二乘法计算所述校准系数;
判断所述校准系数是否在预设阈值范围内;
若判断为是,则结束所述磁力计的初始校准;若判断为否,则继续获取磁力计采集的磁场数据,重新确定所述磁力计的磁场空间。
根据本发明的另一个方面,提供了一种磁力计的初始校准装置,所述装置包括:
确定单元,用于获取磁力计采集的多组磁场数据,根据所述多组磁场数据,确定所述磁力计的磁场空间,所述磁场空间包括各轴的最大值的磁场数据和最小值的磁场数据;
计算单元,用于将各轴的最大值的磁场数据和最小值的磁场数据分别带入所述磁力计的校准方程,采用最小二乘法计算所述校准系数;
判断单元,用于判断所述校准系数是否在预设阈值范围内;若判断为是,则结束所述磁力计的初始校准;
通知单元,用于若判断为否,则通知所述确定单元继续获取磁力计采集的磁场数据,重新确定所述磁力计的磁场空间。
根据本发明的又一个方面,提供了一种磁力计的初始校准装置,所述装置包括存储器和处理器,所述存储器和所述处理器之间通过内部总线通讯连接,所述存储器存储有能够被所述处理器执行的计算机程序,所述计算机程序被所述处理器执行时能够实现前述的方法步骤。
根据本发明的又一个方面,提供了一种磁力计,所述磁力计包括如前所述的磁力计的初始校准装置。
综上所述,本发明技术方案的有益效果是:获取磁力计采集的多组磁场数据,根据多组磁场数据,确定磁力计的磁场空间,继而就确定了各轴的最大值的磁场数据和最小值的磁场数据;根据各轴的最大值的磁场数据和最小值的磁场数据计算校准系数;判断校准系数是否在预设阈值范围内;若判断为是,则结束磁力计的初始校准;若判断为否,则继续获取磁力计采集的磁场数据,重新确定磁力计的磁场空间。通过本技术方案可以根据计算的校准系数判断是否完成初始校准,明确了初始校准完成的时机,初始校准即可获得准确的校准系数,保证磁力计在初始一段时间的磁场数据的准确度,该技术方案的实施可以应用在自动化工程中。
附图说明
图1为本发明一个实施例提供的一种磁力计的初始校准方法的流程示意图;
图2为本发明一个实施例提供的一种磁力计的初始校准装置的功能结构示意图;
图3为本发明另一个实施例提供的一种磁力计的初始校准装置的功能结构示意图;
图4为本发明一个实施例提供的一种磁力计的功能结构示意图。
具体实施方式
本发明的设计思路是:为了得到明确的校准完成反馈,同时获得一个准确的磁力计校准系数,本发明以校准系数作为判断依据,明确初始校准的完成,还可以获得较准确的校准系数,保证磁力计测得的磁场数据准确度。为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明实施方式作进一步地详细描述。
图1为本发明一个实施例提供的一种磁力计的初始校准方法的流程示意图。如图1所示,该方法包括:
步骤S110,获取磁力计采集的多组磁场数据,根据多组磁场数据,确定磁力计的磁场空间,磁场空间包括各轴的最大值的磁场数据和最小值的磁场数据。
在磁力计不受到硬铁和软铁效应的影响下,磁力计测得的磁场数据确定的磁场空间是一个球形,在实际应用中磁力计收到硬铁和软铁效应,磁力计测得的磁场数据确定的磁场空间是一个椭球型。在本实施例中,为了计算磁力计的校准系数,首先要确定该磁力计测得的磁场数据确定的椭球型的磁场空间,磁场空间中包括了各轴的最大值的磁场数据和最小值的磁场数据。
磁力计采集的磁场数据包括各轴的磁场值,这里的各轴的最大值的磁场数据和最小值的磁场数据就包括:X轴的最大值对应的各轴的磁场数据,X轴的最小值对应的各轴的磁场数据;Y轴的最大值对应的各轴的磁场数据,Y轴的最小值对应的各轴的磁场数据;Z轴的最大值对应的各轴的磁场数据,Z轴的最小值对应的各轴的磁场数据。因为X轴的最大值对应的各轴的磁场数据中的Y轴的磁场值不一定是Y轴的最大值,所以这里各轴的最大值的磁场数据和最小值的磁场数据包括六组磁场数据值。
例如,X轴的最大值对应的各轴的磁场数据为Mxmax,My1,Mz1,X轴的最小值对应的各轴的磁场数据Mxmin,My1',Mz1';Y轴的最大值对应的各轴的磁场数据Mx2,Mymax,Mz2,Y轴的最小值对应的各轴的磁场数据Mx2',Mymin,Mz2';Z轴的最大值对应的各轴的磁场数据Mx3,My3,Mzmax,Z轴的最小值对应的各轴的磁场数据Mx3',My3',Mzmin。
步骤S120,将各轴的最大值的磁场数据和最小值的磁场数据分别带入磁力计的校准方程,采用最小二乘法计算校准系数。
本实施例中,将上述的六组数据分别带入磁力计的校准方程中,采用最小二乘法就可以计算出磁力计的校准系数。
步骤S130,判断校准系数是否在预设阈值范围内。
为了得到明确的校准完成反馈,同时获得一个准确的磁力计校准系数,本发明以校准系数作为判断依据,也就是说,判断计算的校准系数是否在预设阈值范围内。
步骤S140,若判断为是,则结束磁力计的初始校准;若判断为否,则继续获取磁力计采集的磁场数据,重新确定磁力计的磁场空间。
本实施例中,如果计算的校准系数在预设阈值范围内,则结束磁力计的初始校准,将计算的校准系数作为磁力计的初始校准结果,在后续的磁力计应用中就可以对磁力计测得的磁场值进行补偿。如果计算的校准系数不在预设阈值范围内,说明初始校准还不能结束,校准系数还不准确,则继续校准,获取磁力计重新采集的磁场数据,重新确定磁力计的磁场空间,即继续执行步骤S110至步骤S130的步骤。
通过图1所示的方法可以根据计算的校准系数判断是否完成初始校准,明确了初始校准完成的时机,初始校准即可获得准确的校准系数,保证磁力计在初始一段时间的磁场数据的准确度,该技术方案的实施可以应用在自动化工程中。
在本发明的一个实施例中,步骤S110中的根据多组磁场数据,确定磁力计的磁场空间包括:对于磁力计采集的各组磁场数据中的各轴的磁场值,获取各轴当前的最大值和各轴当前的最小值,分别比较该轴的磁场值与对应轴的最大值和最小值的大小,若磁场值大于最大值,则使用磁场值更新最大值,并将磁场值对应的那组磁场数据作为最大值的磁场数据;若磁场值小于最小值,则使用磁场值更新最小值,并将磁场值对应的那组磁场数据作为最小值的磁场数据;当各轴的最大值的磁场数据和最小值的磁场数据都确定后,根据各轴的最大值的磁场数据和最小值的磁场数据确定磁力计的磁场空间,各轴的最大值的磁场数据和最小值的磁场数据确定后,磁力计的磁场空间即确定,也就是说在磁力计的磁场空间的确定就是各轴的最大值的磁场数据和最小值的磁场数据的确定,确定空间分布中展开最大的六组数据,这样就可以从几何上确定由硬铁和软铁效应干扰的椭球形磁场空间。
在本实施例中,磁力计在初始校准开始时,可以预设各轴当前的最大值和各轴当前的最小值,以及最大值的磁场数据和最小值的磁场数据,然后在磁力计的初始校准过程中,各轴当前的最大值和各轴当前的最小值是不断的被更新的,直到计算出来的校准系数在预设阈值范围内为止。
在一个具体的例子中,以X轴的最大值的磁场数据的确定为例进行说明。磁力计当前测得磁场数据为Mx,My,Mz,X轴测得的磁场值为Mx,磁力计X轴当前的最大值和最小值分别是Mxmax、Mxmin,比较Mx和Mxmax、Mxmin的大小,若Mx大于Mxmax,则使用Mx更新Mxmax,即将Mx作为新的Mxmax,将Mx,My,Mz作为X轴最大值的磁场数据Mxmax,My1,Mz1,这里的Mxmax=Mx、My1=My、Mz1=Mz;若Mx小于Mxmin,则使用Mx更新Mxmin,即将Mx作为新的Mxmin,将Mx,My,Mz作为X轴最小值的磁场数据Mxmin,My1',Mz1',这里的Mxmin=Mx、My1'=My、Mz1'=Mz。对于磁力计当前测得的磁场数据中的Y轴的磁场值和Z轴的磁场值,依次进行上述的类似的比较即可。最终会确定出六组磁场数据包括:X轴的最大值对应的各轴的磁场数据为Mxmax,My1,Mz1,X轴的最小值对应的各轴的磁场数据Mxmin,My1',Mz1';Y轴的最大值对应的各轴的磁场数据Mx2,Mymax,Mz2,Y轴的最小值对应的各轴的磁场数据Mx2',Mymin,Mz2';Z轴的最大值对应的各轴的磁场数据Mx3,My3,Mzmax,Z轴的最小值对应的各轴的磁场数据Mx3',My3',Mzmin。
需要说明的是,在本实施例中,需要指定一个存储空间用来存储各轴的最大值以及其对应的磁场数据和最小值以及其对应的磁场数据。
还需要说明的是,上述的设定的各轴当前的最大值和最小值,以及最大值的磁场数据和最小值的磁场数据可以根据经验值进行设定,也可以在进行初始校准前,使用该磁力计获取多组磁场数据,从中确定各轴当前的最大值和最小值,以及最大值的磁场数据和最小值的磁场数据后,在进行初始校准。
进一步地,图1所示的步骤S120中的将各轴的最大值的磁场数据和最小值的磁场数据分别带入磁力计的校准方程,采用最小二乘法计算校准系数包括:
(1)使用各轴的最小值和最大值计算对应轴的零偏值。例如,使用X轴的最大值Mxmax和最小值Mxmin计算X轴的零偏值x_offset=(Mxmax-Mxmin)/2;Y轴的零偏值y_offset=(Mymax-Mymin)/2;Z轴的零偏值z_offset=(Mzmax-Mzmin)/2。
(2)将各轴的最大值的磁场数据、最小值的磁场数据和零偏值分别带入校准方程,采用最小二乘法计算校准系数;校准方程为:
Mxout=Kxx·Mx+Kxy·My+Kxz·Mz-x_offset,
Myout=Kyx·Mx+Kyy·My+Kyz·Mz-y_offset,
Mzout=Kzx·Mx+Kzy·My+Kzz·Mz-z_offset,
Mxout 2+Myout 2+Mzout 2=0.522;
其中,Mxout、Myout、Mzout是校准后的磁力计采集的磁场数据;Kxx、Kxy、Kxz、Kyx、Kyy、Kyz、Kzx、Kzy、Kzz是磁力计的校准系数;Mx、My、Mz是各轴的磁场数据;x_offset、y_offset、z_offset是各轴的零偏值。
例如,将X轴的将各轴的最大值的磁场数据、最小值的磁场数据和各轴的零偏值分别带入校准方程后得到8个方程,即为:
Mxout=Kxx·Mxmax+Kxy·My1+Kxz·Mz1-x_offset,
Myout=Kyx·Mxmax+Kyy·My1+Kyz·Mz1-y_offset,
Mzout=Kzx·Mxmax+Kzy·My1+Kzz·Mz1-z_offset,
Mxout 2+Myout 2+Mzout 2=0.522;
Mxout=Kxx·Mxmin+Kxy·My1'+Kxz·Mz1'-x_offset,
Myout=Kyx·Mxmin+Kyy·My1'+Kyz·Mz1'-y_offset,
Mzout=Kzx·Mxmin+Kzy·My1'+Kzz·Mz1'-z_offset,
Mxout 2+Myout 2+Mzout 2=0.522。
那么将各轴的最大值的磁场数据、最小值的磁场数据和零偏值,即六组磁场数据,分别带入校准方程后会得到24个方程,利用这24个方程计算12个未知数:Mxout、Myout、Mzout、Kxx、Kxy、Kxz、Kyx、Kyy、Kyz、Kzx、Kzy、Kzz,需要用最小二乘法进行计算。
本实施例中,校准系数包括各轴的自相关校准系数Kxx、Kyy、Kzz,和各轴的互相关校准系数Kxy、Kxz、Kyy、Kyz、Kzx、Kzy。而且,在无法获取到磁力计当前的地理纬度的条件下,选取磁场值的平均值0.52高斯作为计算标准。
在本发明的一个实施例中,校准系数包括各轴的自相关校准系数和各轴的互相关校准系数;例如,校准系数包括各轴的自相关校准系数Kxx、Kyy、Kzz,和各轴的互相关校准系数Kxy、Kxz、Kyy、Kyz、Kzx、Kzy。
则图1所示的步骤S130中的判断校准系数是否在预设阈值范围内包括:
(1)判断各轴的自相关校准系数是否在第一预设阈值范围内,即判断Kxx、Kyy、Kzz是否在第一预设阈值范围内。
(2)若判断为是,进一步判断各轴的互相关校准系数是否在第二预设阈值范围内,即判断Kxy、Kxz、Kyy、Kyz、Kzx、Kzy是否在第二预设阈值范围内。若判断为是,则结束初始校准,若判断为否,则继续进行磁力计的初始校准。
(3)若判断为否,则继续进行磁力计的初始校准。
本实施例中,首先判断自相关校准系数是否在第一预设阈值范围内,是因为在各校准系数中,自相关校准系数较为重要,自相关校准系数如果不在第一预设阈值范围内,则该初始校准不能结束,这样可以有效减少判断过程占用的系统资源。
在理想状态下,自相关校准系数是1,互相关校准系数是0,但是在实际使用过程中,并非是在理想状态下。在本发明的一个实施例中,自相关系数和互相关校准系数都在一定范围内,通过大量实验统计第一预设阈值范围和第二预设阈值范围保持相对稳定,例如,在一次实验中获得的校准系数为:
可以统计到,自相关系数在1上下浮动,互相关系数在在0上下浮动,但浮动的幅度不超过0.1。基于此,在本实施例中,确定第一预设阈值范围是[0.9,1.1];第二预设阈值范围是[-0.1,0.1],也就是说,计算的各校准系数要满足:kxx∈[0.9,1.1],kyy∈[0.9,1.1],kzz∈[0.9,1.1],kxy∈[-0.1,0.1],kxz∈[-0.1,0.1],kyx∈[-0.1,0.1],kyz∈[-0.1,0.1],kzx∈[-0.1,0.1],kzy∈[-0.1,0.1]。这样,才能保证初始校准的准确性,且可以结束初始校准。
图2为本发明一个实施例提供的一种磁力计的初始校准装置的功能结构示意图。如图2所示,该磁力计的初始校准装置200包括:
确定单元210,用于获取磁力计采集的多组磁场数据,根据多组磁场数据,确定磁力计的磁场空间,磁场空间包括各轴的最大值的磁场数据和最小值的磁场数据;
计算单元220,用于将各轴的最大值的磁场数据和最小值的磁场数据分别带入磁力计的校准方程,采用最小二乘法计算校准系数;
判断单元230,用于判断校准系数是否在预设阈值范围内;若判断为是,则结束磁力计的初始校准;
通知单元240,用于若判断为否,则通知确定单元210继续获取磁力计采集的磁场数据,重新确定磁力计的磁场空间。
在本发明的一个实施例中,确定单元210具体用于,对于磁力计采集的各组磁场数据中的各轴的磁场值,获取各轴当前的最大值和各轴当前的最小值,分别比较磁场值与对应轴的最大值和最小值的大小,若磁场值大于最大值,则使用磁场值更新最大值,并将磁场值对应的那组磁场数据作为最大值的磁场数据;若磁场值小于最小值,则使用磁场值更新最小值,并将磁场值对应的那组磁场数据作为最小值的磁场数据;根据各轴的最大值的磁场数据和最小值的磁场数据确定磁力计的磁场空间。
进一步地,确定单元210具体用于,使用各轴的最小值和最大值计算对应轴的零偏值;将各轴的最大值的磁场数据、最小值的磁场数据和零偏值分别带入校准方程,采用最小二乘法计算校准系数;校准方程为:
Mxout=Kxx·Mx+Kxy·My+Kxz·Mz-x_offset,
Myout=Kyx·Mx+Kyy·My+Kyz·Mz-y_offset,
Mzout=Kzx·Mx+Kzy·My+Kzz·Mz-z_offset,
Mxout 2+Myout 2+Mzout 2=0.522;
其中,Mxout、Myout、Mzout是校准后的磁力计采集的磁场数据;Kxx、Kxy、Kxz、Kyx、Kyy、Kyz、Kzx、Kzy、Kzz是磁力计的校准系数;Mx、My、Mz是各轴的磁场数据;x_offset、y_offset、z_offset是各轴的零偏值。
在本发明的一个实施例中,校准系数包括各轴的自相关校准系数和各轴的互相关校准系数。
判断单元230,用于判断各轴的自相关校准系数是否在第一预设阈值范围内;若判断为是,进一步判断各轴的互相关校准系数是否在第二预设阈值范围内。
具体地,上述的第一预设阈值范围是[0.9,1.1];第二预设阈值范围是[-0.1,0.1]。
图3为本发明另一个实施例提供的一种磁力计的初始校准装置的结构示意图。如图3所示,磁力计的初始校准装置300包括存储器310和处理器320,存储器310和处理器320之间通过内部总线330通讯连接,存储器310存储有能够被处理器320执行的磁力计的初始校准的计算机程序311,该磁力计的初始校准的计算机程序311被处理器320执行时能够实现图1中所示的各实施例的方法步骤。
在不同的实施例中,存储器310可以是内存或者非易失性存储器。其中非易失性存储器可以是:存储驱动器(如硬盘驱动器)、固态硬盘、任何类型的存储盘(如光盘、DVD等),或者类似的存储介质,或者它们的组合。内存可以是:RAM(Radom Access Memory,随机存取存储器)、易失存储器、非易失性存储器、闪存。进一步,非易失性存储器和内存作为机器可读存储介质,其上可存储由处理器320执行的磁力计的初始校准的计算机程序311。
图4为本发明一个实施例提供的一种磁力计的功能结构示意图。如图4所示,磁力计400包括如图2或图3所示的磁力计的初始校准装置410。
需要说明的是,图3、图3所示的装置和图4所示的磁力计的各实施例与图1所示的方法的各实施例对应相同,上文已有详细说明,在此不再赘述。
综上所述,本发明技术方案的有益效果是:获取磁力计采集的多组磁场数据,根据多组磁场数据,确定磁力计的磁场空间,继而就确定了各轴的最大值的磁场数据和最小值的磁场数据;根据各轴的最大值的磁场数据和最小值的磁场数据计算校准系数;判断校准系数是否在预设阈值范围内;若判断为是,则结束磁力计的初始校准;若判断为否,则继续获取磁力计采集的磁场数据,重新确定磁力计的磁场空间。通过本技术方案可以根据计算的校准系数判断是否完成初始校准,明确了初始校准完成的时机,初始校准即可获得准确的校准系数,保证磁力计在初始一段时间的磁场数据的准确度,该技术方案的实施可以应用在自动化工程中。
以上所述,仅为本发明的具体实施方式,在本发明的上述教导下,本领域技术人员可以在上述实施例的基础上进行其他的改进或变形。本领域技术人员应该明白,上述的具体描述只是更好的解释本发明的目的,本发明的保护范围应以权利要求的保护范围为准。
Claims (10)
1.一种磁力计的初始校准方法,其特征在于,所述方法包括:
获取磁力计采集的多组磁场数据,根据所述多组磁场数据,确定所述磁力计的磁场空间,所述磁场空间包括各轴的最大值的磁场数据和最小值的磁场数据;
将各轴的最大值的磁场数据和最小值的磁场数据分别带入所述磁力计的校准方程,采用最小二乘法计算所述校准系数;
判断所述校准系数是否在预设阈值范围内;
若判断为是,则结束所述磁力计的初始校准;若判断为否,则继续获取磁力计采集的磁场数据,重新确定所述磁力计的磁场空间。
2.如权利要求1所述的方法,其特征在于,所述根据所述多组磁场数据,确定所述磁力计的磁场空间包括:
对于所述磁力计采集的各组磁场数据中的各轴的磁场值,
获取各轴当前的最大值和各轴当前的最小值,
分别比较该轴的所述磁场值与对应轴的所述最大值和所述最小值的大小,
若所述磁场值大于所述最大值,则使用所述磁场值更新所述最大值,并将所述磁场值对应的那组磁场数据作为所述最大值的磁场数据;若所述磁场值小于所述最小值,则使用所述磁场值更新所述最小值,并将所述磁场值对应的那组磁场数据作为所述最小值的磁场数据;
根据各轴的所述最大值的磁场数据和所述最小值的磁场数据确定所述磁力计的磁场空间。
3.如权利要求2所述的方法,其特征在于,所述将各轴的最大值的磁场数据和最小值的磁场数据分别带入所述磁力计的校准方程,采用最小二乘法计算所述校准系数包括:
使用各轴的所述最小值和所述最大值计算对应轴的零偏值;
将各轴的所述最大值的磁场数据、所述最小值的磁场数据和所述零偏值分别带入校准方程,采用最小二乘法计算所述校准系数;所述校准方程为:
Mxout=Kxx·Mx+Kxy·My+Kxz·Mz-x_offset,
Myout=Kyx·Mx+Kyy·My+Kyz·Mz-y_offset,
Mzout=Kzx·Mx+Kzy·My+Kzz·Mz-z_offset,
Mxout 2+Myout 2+Mzout 2=0.522;
其中,Mxout、Myout、Mzout是校准后的所述磁力计采集的磁场数据;Kxx、Kxy、Kxz、Kyx、Kyy、Kyz、Kzx、Kzy、Kzz是所述磁力计的校准系数;Mx、My、Mz是各轴的磁场数据;x_offset、y_offset、z_offset是各轴的零偏值。
4.如权利要求1所述的方法,其特征在于,
所述校准系数包括各轴的自相关校准系数和各轴的互相关校准系数;
所述判断所述校准系数是否在预设阈值范围内包括:
判断所述各轴的自相关校准系数是否在第一预设阈值范围内;
若判断为是,进一步判断所述各轴的互相关校准系数是否在第二预设阈值范围内。
5.如权利要求4所述的方法,其特征在于,所述第一预设阈值范围是[0.9,1.1];所述第二预设阈值范围是[-0.1,0.1]。
6.一种磁力计的初始校准装置,其特征在于,所述装置包括:
确定单元,用于获取磁力计采集的多组磁场数据,根据所述多组磁场数据,确定所述磁力计的磁场空间,所述磁场空间包括各轴的最大值的磁场数据和最小值的磁场数据;
计算单元,用于将各轴的最大值的磁场数据和最小值的磁场数据分别带入所述磁力计的校准方程,采用最小二乘法计算所述校准系数;
判断单元,用于判断所述校准系数是否在预设阈值范围内;若判断为是,则结束所述磁力计的初始校准;
通知单元,用于若判断为否,则通知所述确定单元继续获取磁力计采集的磁场数据,重新确定所述磁力计的磁场空间。
7.如权利要求6所述的装置,其特征在于,所述确定单元具体用于,
对于所述磁力计采集的各组磁场数据中的各轴的磁场值,
获取各轴当前的最大值和各轴当前的最小值,
分别比较所述磁场值与对应轴的所述最大值和所述最小值的大小,
若所述磁场值大于所述最大值,则使用所述磁场值更新所述最大值,并将所述磁场值对应的那组磁场数据作为所述最大值的磁场数据;若所述磁场值小于所述最小值,则使用所述磁场值更新所述最小值,并将所述磁场值对应的那组磁场数据作为所述最小值的磁场数据;
根据各轴的所述最大值的磁场数据和所述最小值的磁场数据确定所述磁力计的磁场空间。
8.如权利要求6所述的装置,其特征在于,
所述校准系数包括各轴的自相关校准系数和各轴的互相关校准系数;
所述判断单元,用于判断所述各轴的自相关校准系数是否在第一预设阈值范围内;若判断为是,进一步判断所述各轴的互相关校准系数是否在第二预设阈值范围内。
9.一种磁力计的初始校准装置,其特征在于,所述装置包括存储器和处理器,所述存储器和所述处理器之间通过内部总线通讯连接,所述存储器存储有能够被所述处理器执行的计算机程序,所述计算机程序被所述处理器执行时能够实现权利要求1-5任意一项所述的方法步骤。
10.一种磁力计,其特征在于,所述磁力计包括如权利要求6-9任意一项所述的磁力计的初始校准装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710949166.1A CN107907142B (zh) | 2017-10-12 | 2017-10-12 | 一种磁力计的初始校准方法、装置和磁力计 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710949166.1A CN107907142B (zh) | 2017-10-12 | 2017-10-12 | 一种磁力计的初始校准方法、装置和磁力计 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107907142A true CN107907142A (zh) | 2018-04-13 |
CN107907142B CN107907142B (zh) | 2020-09-11 |
Family
ID=61840524
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710949166.1A Active CN107907142B (zh) | 2017-10-12 | 2017-10-12 | 一种磁力计的初始校准方法、装置和磁力计 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107907142B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109781084A (zh) * | 2019-03-11 | 2019-05-21 | 西安因诺航空科技有限公司 | 一种校准磁力计的装置和方法 |
CN111289933A (zh) * | 2020-05-07 | 2020-06-16 | 中航金城无人系统有限公司 | 一种多旋翼飞行器的磁力计自动校准系统和方法 |
WO2021043328A1 (zh) * | 2019-09-05 | 2021-03-11 | 深圳市道通智能航空技术有限公司 | 一种磁力计校准数据采集方法、装置以及飞行器 |
CN112762914A (zh) * | 2020-12-18 | 2021-05-07 | 易瓦特科技股份公司 | 基于电子磁力计的电磁测量方法、装置、设备和存储介质 |
CN113960519A (zh) * | 2021-10-19 | 2022-01-21 | 重庆金山医疗技术研究院有限公司 | 一种磁场传感器的校准方法、装置、介质及系统 |
CN114325536A (zh) * | 2021-12-22 | 2022-04-12 | 重庆金山医疗技术研究院有限公司 | 一种磁场校准方法及相关组件 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102597920A (zh) * | 2009-11-04 | 2012-07-18 | 高通股份有限公司 | 针对偏移、灵敏度和非正交性来校准多维传感器 |
CN106289243A (zh) * | 2016-08-03 | 2017-01-04 | 上海乐相科技有限公司 | 一种磁力计自动校准方法及系统 |
CN106483475A (zh) * | 2015-09-01 | 2017-03-08 | 意法半导体股份有限公司 | 用于磁场感测设备的校准方法、对应系统、装置和计算机程序产品 |
US20170123035A1 (en) * | 2015-10-29 | 2017-05-04 | Kespry, Inc. | Autonomous magnetometer calibration |
CN106842094A (zh) * | 2016-12-31 | 2017-06-13 | 深圳市优必选科技有限公司 | 磁力计校准的数据处理方法和装置 |
US20170176546A1 (en) * | 2015-12-18 | 2017-06-22 | Stmicroelectronics International N.V. | Method for calibration of magnetic sensor |
-
2017
- 2017-10-12 CN CN201710949166.1A patent/CN107907142B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102597920A (zh) * | 2009-11-04 | 2012-07-18 | 高通股份有限公司 | 针对偏移、灵敏度和非正交性来校准多维传感器 |
CN106483475A (zh) * | 2015-09-01 | 2017-03-08 | 意法半导体股份有限公司 | 用于磁场感测设备的校准方法、对应系统、装置和计算机程序产品 |
US20170123035A1 (en) * | 2015-10-29 | 2017-05-04 | Kespry, Inc. | Autonomous magnetometer calibration |
US20170176546A1 (en) * | 2015-12-18 | 2017-06-22 | Stmicroelectronics International N.V. | Method for calibration of magnetic sensor |
CN106289243A (zh) * | 2016-08-03 | 2017-01-04 | 上海乐相科技有限公司 | 一种磁力计自动校准方法及系统 |
CN106842094A (zh) * | 2016-12-31 | 2017-06-13 | 深圳市优必选科技有限公司 | 磁力计校准的数据处理方法和装置 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109781084A (zh) * | 2019-03-11 | 2019-05-21 | 西安因诺航空科技有限公司 | 一种校准磁力计的装置和方法 |
WO2021043328A1 (zh) * | 2019-09-05 | 2021-03-11 | 深圳市道通智能航空技术有限公司 | 一种磁力计校准数据采集方法、装置以及飞行器 |
CN111289933A (zh) * | 2020-05-07 | 2020-06-16 | 中航金城无人系统有限公司 | 一种多旋翼飞行器的磁力计自动校准系统和方法 |
CN112762914A (zh) * | 2020-12-18 | 2021-05-07 | 易瓦特科技股份公司 | 基于电子磁力计的电磁测量方法、装置、设备和存储介质 |
CN113960519A (zh) * | 2021-10-19 | 2022-01-21 | 重庆金山医疗技术研究院有限公司 | 一种磁场传感器的校准方法、装置、介质及系统 |
CN113960519B (zh) * | 2021-10-19 | 2024-08-16 | 重庆金山医疗技术研究院有限公司 | 一种磁场传感器的校准方法、装置、介质及系统 |
CN114325536A (zh) * | 2021-12-22 | 2022-04-12 | 重庆金山医疗技术研究院有限公司 | 一种磁场校准方法及相关组件 |
Also Published As
Publication number | Publication date |
---|---|
CN107907142B (zh) | 2020-09-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107907142A (zh) | 一种磁力计的初始校准方法、装置和磁力计 | |
KR101783050B1 (ko) | 3축 자계 센서의 교정 방법 및 장치 | |
US11231947B2 (en) | Method and apparatus for determining the capacity of an application cluster | |
CN108426571B (zh) | 一种电子罗盘本地实时校准方法及装置 | |
CN103941309B (zh) | 地磁传感器校准设备及其方法 | |
US20150100269A1 (en) | Automated localization for gnss device | |
CN106556877B (zh) | 一种地磁通化方法及装置 | |
CN109521444B (zh) | 一种地壳运动gps水平速度场自适应最小二乘拟合推估算法 | |
CN103969700A (zh) | 估计磁传感器的偏移量的方法 | |
CN103175520A (zh) | 电子罗盘校正方法、装置和设备 | |
WO2015021122A1 (en) | Sensor devices and methods for calculating an orientation while accounting for magnetic interference | |
CN112526470A (zh) | 标定雷达参数的方法和装置、电子设备、存储介质 | |
CN116016225A (zh) | 信息处理方法、信号定位方法、装置、设备和介质 | |
CN109960841B (zh) | 一种流体表面张力的仿真方法、终端设备及存储介质 | |
CN113420370A (zh) | 一种高度静不定结构的强度设计载荷获取方法 | |
CN116246069B (zh) | 自适应地形点云滤波的方法、装置、智能终端及存储介质 | |
CN107084712A (zh) | 数据处理方法和装置以及罗盘校准方法和装置 | |
CN108344963B (zh) | 确定磁传感器数据的方法及装置、电子设备及存储介质 | |
CN113392857B (zh) | 基于yolo网络的目标检测方法、装置和设备终端 | |
CN112987054B (zh) | 标定sins/dvl组合导航系统误差的方法和装置 | |
CN108152535A (zh) | 一种加速度计校准方法及装置 | |
CN111002348B (zh) | 机器人性能测试方法、机器人及计算机可读存储介质 | |
CN107389091A (zh) | 一种数据的检测方法及装置 | |
CN113702928A (zh) | 一种路口雷达标定方法和设备 | |
CN109211271B (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 |