CN101806595B - 一种两维电子指南针校准方法 - Google Patents
一种两维电子指南针校准方法 Download PDFInfo
- Publication number
- CN101806595B CN101806595B CN2010101502384A CN201010150238A CN101806595B CN 101806595 B CN101806595 B CN 101806595B CN 2010101502384 A CN2010101502384 A CN 2010101502384A CN 201010150238 A CN201010150238 A CN 201010150238A CN 101806595 B CN101806595 B CN 101806595B
- Authority
- CN
- China
- Prior art keywords
- data
- magnetic
- bidimensional
- ellipse
- max
- 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
Abstract
本发明公开了一种两维指南针校准方法,其包括有以下步骤。首先是建立一个特殊的椭圆—单位圆。持续获取磁传感器采集到的物理量级别磁数据,更新磁物理量数据的最大值/最小值,并利用磁物理量数据的最大值/最小值动态计算椭圆的几何中心。将椭圆几何中心以及两次不同采样点带入椭圆标准方程,计算出椭圆方程的长半轴/短半轴参数,进而计算出因磁传感器自身误差造成的灵敏度误差和非正交度并补偿。本发明涉及的两维指南针校准方法,基于最小二乘法的椭圆拟合方法,实现了两维指南针新式的、数学层面的、简便的校准。
Description
技术领域
本发明涉及一种两维电子指南针校准方法。
背景技术
目前,业界对于两维电子指南针的应用很少,特别是在移动电话设备领域。
通常使用的两维电子指南针的方法,在做地磁校准时,需要用户让设备旋转超过两圈(两圈半左右)。其中先旋转半圈左右建立临时坐标系,用于监测旋转动作;其次转第一圈采集数据的最大值/最小值,进而求出几何中心;最后转第二圈求各个点到几何中心的距离,进而得出磁传感器正交轴的灵敏度误差。
上述校准方法具有以下缺陷:
1.校准过程较为复杂,需要沿着顺时针或逆时针一个方向水平旋转设备近三圈,并且无法屏蔽设备顺时针/逆时针交替较快旋转所造成的监测误差;
2.校准方法只关注几何中心以及各采样点到几何中心的距离,无法实现图形层面的最优匹配;
3.对一般磁传感器各轴上的灵敏度误差补偿精度较低,并且无法修正一般磁传感器各轴非正交造成的误差;
4.只能手动启动校准,无法实现自动校准;
5.使用磁传感器获得的原始数据而非真正的磁物理量数据进行计算,无法较好地兼容不同类型的磁传感器。
基于以上缺陷,业界确有必要开发一种新的两维电子指南针校准方法。
发明内容
本发明所要解决的技术问题是,现有电子指南针的地磁校准方法,不仅校准过程较为复杂、无法实现图形层面的最优匹配、无法对一般磁传感器各轴上的灵敏度误差进行精确补偿、无法修正一般磁传感器各轴非正交造成的误差、无法实现自动校准,而且不能较好地兼容不同类型的磁传感器。
为解决上述技术问题,本发明提供一种两维电子指南针校准方法,其包括有以下步骤。
建立一个特殊的椭圆:单位圆,其圆点位于指南针的磁传感器坐标系原点,半径为1。持续获取磁传感器采集到的物理量级别磁数据,更新磁物理量数据的最大值/最小值,并将新采集到的数据带入第一椭圆方程,计算出其平方的数值,并与预设的阀值做比较,如果数据超出阀值,则计算椭圆参数。采集磁传感器数据,获得当前周围磁场磁感强度的最大值/最小值坐标并保存。利用已采集到的磁物理量数据的最大值/最小值动态计算椭圆的几何中心。将椭圆几何中心以及两次不同采样点带入第二椭圆方程,计算出第二椭圆方程的长半轴/短半轴参数,进而计算出因磁传感器自身误差造成的灵敏度误差和非正交度并补偿。将计算结果保存到校准参数存储空间中。
进一步的,在不同实施方式中,其中涉及使用的第一椭圆方程为F(x,y)=b2*x2 + a2*y2 - a2*b2。
进一步的,在不同实施方式中,其中在获取磁传感器采集到的物理量级别磁数据时,对采集到的数据进行数据处理,并将数据投影到嵌入式处理器能够容纳的数值范围内。
进一步的,在不同实施方式中,其中对磁传感器采集到的数据涉及使用的数据处理公式为:
A=A*(Rmax-Rmin)/(Amax-Amin)
其中:A表示待映射的数据,Rmax/Rmin表示映射后的数据最大值和最小值,Amax/Amin表示待映射的数据最大值和最小值。
进一步的,在不同实施方式中,其中其为当连续若干数据都超出阀值时,计算椭圆参数。这是因为,当连续若干数据都超出阀值时,则说明当前参数构成的椭圆图形与已有采样点轨迹所构成的图形在图形层面不匹配,需要进入计算椭圆参数的过程,也就是进行后续步骤;否则,则说明目前图形匹配较好,不需进行后续步骤,下次采样时再继续执行采样值与预设阀值的比较步骤。
进一步的,在不同实施方式中,其中动态计算椭圆的几何中心的方式为:取磁物理量数据最大值/最小值采样点线段的中点作为采样点轨迹的几何中心,并建立新的坐标系。
进一步的,在不同实施方式中,其中建立新坐标系涉及使用的公式为:
Xoriginal=(Xmax+Xmin)/2
Yoriginal=(Ymax+Ymin)/2
其中:Xoriginal、Yoriginal表示新建立的坐标系原点在原坐标系中的坐标,Xmax/Ymax表示X/Y两维坐标数值的最大值,Xmin/Ymin表示X/Y两维坐标数值的最小值。
进一步的,在不同实施方式中,其中涉及使用的第二椭圆方程为标准椭圆方程x2/a2+y2/b2=1。计算方式为:
x0 2/a2+y0 2/b2=1
x1 2/a2+y1 2/b2=1
a2=(y1 2*x0 2-y0 2*x1 2)/(y1 2-y0 2)
b2=(a2*y1 2)/(a2-x1 2)
相对于现有技术,本发明采用基于最小二乘法的椭圆拟合来实现两维电子指南针的校准方法,其具有以下优点:
1.解决了传统的两维指南针只能手动校准的局限以及校准过程需要用户较为复杂的操作的问题:只能在水平面上沿着顺时针或逆时针一个方向旋转将近三圈,并且无法屏蔽设备顺时针/逆时针交替较快旋转所造成的监测误差。本发明涉及的校准方法理论上只需要水平随意旋转设备达到一周即可,而实际的测试表明通常只需要水平旋转设备200度左右就可以计算出最终校准结果了。
2.校准结果的精确度比传统的两维指南针校准结果有较大提高,由于采用了椭圆拟合的方法,实现了动态逼近的数学逼近法,校准结果所组成的数学图形与真实磁传感器采样轨迹最接近,即以图形最优匹配为最高目标,真实轨迹与数学拟合结果的图形误差最大不超过1%。
3.高准确度自动补偿磁传感器误差。相比传统的两维指南针简单使用坐标最值估算采样轨迹的几何中心而忽略实际轨迹图形的方法,本发明涉及的方法更关注于几何图形级别的最优匹配,不仅仅可以更准确计算出一般磁传感器各个感应阵列的灵敏度误差,还可以计算出一般磁传感器各感应阵列的非正交度并修正,最终实现比传统的两维指南针更高准确度的误差补偿。
4.本校准方法不但可以手动校准,还可以进行自动校准。
5.相比传统的两维指南针校准方法使用磁传感器的原始转换数据,本发明涉及的方法使用磁传感器转换的真正的磁物理量数据,更好的兼容了不同的磁传感器,方便方法的整机移植。
具体实施方式
本发明涉及的两维电子指南针校准方法,是基于最小二乘法的椭圆拟合方法来实现两维电子指南针新式的、数学层面的、简便的校准的方法,用户只需在水平面让设备划一个“8”的轨迹或者水平旋转一圈即可。且在计算过程中,使用数值映射方法,将采集到的数据投影到嵌入式处理器的数据长度能够容纳的范围之内进行计算。
由于磁传感器自身的装配误差和灵敏度误差、以及设备硬磁干扰等因素的存在,使两维磁传感器在水平面采集到的数据形成的轨迹近似为一个几何中心偏离磁传感器坐标系原点一定数值的椭圆,因此,求出最接近该轨迹的椭圆即可实现精确指向。
本发明涉及的两维指南针校准方法,首先是建立一个特殊的椭圆:单位圆,其圆点位于磁传感器坐标系原点,半径为1;持续获取磁传感器采集到的物理量级别磁数据,更新磁物理量数据的最大值/最小值,并利用磁物理量数据的最大值/最小值动态计算椭圆的几何中心;将椭圆几何中心以及两次不同采样点带入椭圆标准方程,计算出椭圆方程的长半轴/短半轴参数,进而计算出因磁传感器自身误差造成的灵敏度误差和非正交度并补偿。将新采集到的数据带入更新参数后的椭圆方程F(x,y),计算出其平方的数值F2(x,y),并与预设的阀值做比较,如果连续若干数据都超出阀值,则说明当前参数构成的椭圆图形与已有采样点轨迹所构成的图形在图形层面不匹配,需要重复上面计算椭圆参数的过程。否则,说明目前图形匹配较好,继续计算新的磁物理量数据采样。
具体实施方式包括有以下步骤:
1. 建立一个特殊的椭圆——单位圆,圆心位于磁传感器X/Y坐标系原点,半径为1。
2. 采集磁传感器数据,获得当前周围磁场磁感强度的最大值/最小值坐标并保存;同时对数据进行数值映射,将数据投影到嵌入式处理器能够容纳的数值范围内;其中涉及使用的公式为:
A=A*(Rmax-Rmin)/(Amax-Amin)
其中:A表示待映射的数据,Rmax/Rmin表示映射后的数据最大值和最小
值,Amax/Amin表示待映射的数据最大值和最小值。
3. 判断该采样点对当前椭圆的质量分数,如果超过预设的阀值,则进入步骤4;否则计算指针指向后推出,下次采样仍然进入步骤2;其中涉及使用的公式为:
Quality = F(x,y)=b2*x2+a2*y2-a2*b2。
4. 取最大值/最小值采样点线段的中点作为采样点轨迹的几何中心并建立坐标系;
Xoriginal=(Xmax+Xmin)/2
Yoriginal=(Ymax+Ymin)/2
其中:Xoriginal、Yoriginal表示新建立的坐标系原点在原坐标系中的坐标,Xmax/Ymax表示X/Y两轴坐标数值的最大值,Xmin/Ymin表示X/Y两轴坐标数值的最小值。
5. 通过两组采样数据求出最接近当前已有采样点轨迹的椭圆,并将计算结果反映射回到原有的数值范围;其采用椭圆标准方程公式x2/a2+y2/b2=1进行计算:
x0 2/a2+y0 2/b2=1
x1 2/a2+y1 2/b2=1
a2=(y1 2*x0 2-y0 2*x1 2)/(y1 2-y0 2)
b2=(a2*y1 2)/(a2-x1 2)
6. 返回步骤2继续执行。
本发明涉及的校准方法的流程如上述步骤1~6所述,当用户将设备在水平面扭动出一个“8”字之后(或水平旋转超过半圈即可),根据本发明涉及的校准方法计算出的椭圆已经基本最接近已有的采样点轨迹和未采集到的数据点所组成的轨迹了,此时设备即可实现精确指向。
本发明采用新的校准原理,大大简化了校准过程,并且更关注于校准结果所构成的几何图形与采样点轨迹图形,在图形层面的匹配,实现最优匹配。如此还可以高准确度的计算出一般磁传感器的各轴灵敏度误差以及各轴的非正交度误差,并高精度的补偿。同时完全实时自动校准,也可以配合手动校准。另外,使用磁物理量数据进行计算,方便磁传感器更新替换。
以上所述仅为本发明的较佳实施方式,本发明的保护范围并不以上述实施方式为限,但凡本领域普通技术人员根据本发明揭示内容所作的等效修饰或变化,皆应纳入权利要求书中记载的保护范围内。
Claims (2)
1.一种两维指南针校准方法,其特征在于:包括有以下步骤:
建立一个特殊的椭圆:单位圆,其圆点位于指南针的磁传感器坐标系原点,半径为1;
持续获取磁传感器采集到的物理量级别磁数据,更新磁物理量数据的最大值/最小值,并将新采集到的数据带入第一椭圆方程,计算出其平方的数值,并与预设的阀值做比较,如果数据超出阀值,则进入到计算椭圆参数的步骤;
采集磁传感器数据,获得当前周围磁场磁感强度的最大值/最小值坐标并保存,利用已采集到的磁物理量数据的最大值/最小值动态计算椭圆的几何中心;
将椭圆几何中心以及两次不同采样点带入第二椭圆方程,计算出第二椭圆方程的长半轴/短半轴参数,进而计算出因磁传感器自身误差造成的灵敏度误差和非正交度并补偿;
将计算结果保存到校准参数存储空间中。
2.根据权利要求1所述的两维指南针校准方法,其特征在于:其中涉及使用的第一椭圆方程为F(x,y)=b2*x2+ a2*y2-a2*b2。
3、根据权利要求1所述的两维指南针校准方法,其特征在于:其中在获取磁传感器采集到的物理量级别磁数据时,对采集到的数据进行数据处理,并将数据投影到嵌入式处理器能够容纳的数值范围内。
4、根据权利要求3所述的两维指南针校准方法,其特征在于:其中对磁传感器采集到的数据涉及使用的数据处理公式为:
A=A*(Rmax-Rmin)/(Amax-Amin)
其中:A表示待映射的数据,Rmax/Rmin表示映射后的数据最大值和最小值,Amax/Amin表示待映射的数据最大值和最小值。
5、根据权利要求1所述的两维指南针校准方法,其特征在于:其中其为当连续若干数据都超出阀值时,则进入到计算椭圆参数的步骤。
6、根据权利要求1所述的两维指南针校准方法,其特征在于:其中动态计算椭圆的几何中心的方式为:取磁物理量数据最大值/最小值采样点线段的中点作为采样点轨迹的几何中心,并建立新的坐标系。
7、根据权利要求6所述的两维指南针校准方法,其特征在于:其中建立新坐标系涉及使用的公式为:
Xoriginal=(Xmax+Xmin)/2
Yoriginal=(Ymax+Ymin)/2
其中:Xoriginal、Yoriginal表示新建立的坐标系原点在原坐标系中的坐标,Xmax/Ymax表示X/Y两维坐标数值的最大值,Xmin/Ymin表示X/Y两维坐标数值的最小值。
8、根据权利要求1所述的两维指南针校准方法,其特征在于:其中涉及使用的第二椭圆方程为标准椭圆方程x2/a2+y2/b2=1,计算方式为:
x0 2/a2+y0 2/b2=1
x1 2/a2+y1 2/b2=1
a2=(y1 2*x0 2-y0 2*x1 2)/(y1 2-y0 2)
b2=(a2*y1 2)/(a2-x1 2)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010101502384A CN101806595B (zh) | 2010-04-19 | 2010-04-19 | 一种两维电子指南针校准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010101502384A CN101806595B (zh) | 2010-04-19 | 2010-04-19 | 一种两维电子指南针校准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101806595A CN101806595A (zh) | 2010-08-18 |
CN101806595B true CN101806595B (zh) | 2012-01-04 |
Family
ID=42608487
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010101502384A Active CN101806595B (zh) | 2010-04-19 | 2010-04-19 | 一种两维电子指南针校准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101806595B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102297687B (zh) * | 2011-05-13 | 2012-07-04 | 北京理工大学 | 一种电子罗盘的标定方法 |
JP5927776B2 (ja) * | 2011-05-20 | 2016-06-01 | 株式会社ソニー・インタラクティブエンタテインメント | 携帯機器 |
CN102278980B (zh) * | 2011-06-22 | 2014-06-25 | 青岛海信移动通信技术股份有限公司 | 用于电子指南针检测的方法、装置和系统 |
CN102238589A (zh) * | 2011-07-04 | 2011-11-09 | 珠海世纪鼎利通信科技股份有限公司 | 一种无线网络通信基站天线性能监测装置 |
CN102620725B (zh) * | 2012-03-16 | 2015-02-11 | 惠州Tcl移动通信有限公司 | 一种移动装置的指南针校准方法 |
CN104142485B (zh) * | 2013-05-08 | 2017-09-15 | 意法半导体(中国)投资有限公司 | 校准磁传感器的方法和装置 |
CN104237822B (zh) * | 2013-06-20 | 2018-10-19 | 意法半导体(中国)投资有限公司 | 用于电子磁力计传感器的补偿磁干扰 |
CN105115485B (zh) * | 2015-07-23 | 2017-08-15 | 小米科技有限责任公司 | 指南针校准界面的显示方法及装置 |
CN108037474B (zh) * | 2017-11-29 | 2023-09-15 | 歌尔科技有限公司 | 磁力计数据处理方法及设备 |
CN109798884B (zh) * | 2019-02-21 | 2021-04-23 | 广东工业大学 | 一种多旋翼无人机磁力计动态实时校准方法 |
CN113640726B (zh) * | 2021-10-19 | 2021-12-21 | 青岛杰瑞自动化有限公司 | 一种双轴磁强计的多方位椭圆拟合标定方法及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5581899A (en) * | 1991-09-17 | 1996-12-10 | Siemens Aktiengesellschaft | Process for compensating a magnetic interference field in a vehicle |
CN1323979A (zh) * | 2000-05-12 | 2001-11-28 | 精工电子有限公司 | 校正机构,具有校正机构的电子方位计和电子时钟 |
CN1639542A (zh) * | 2002-03-01 | 2005-07-13 | 金泰克斯公司 | 电子罗盘系统 |
WO2006088057A1 (ja) * | 2005-02-17 | 2006-08-24 | Alps Electric Co., Ltd. | 方位計測装置 |
CN101149262A (zh) * | 2006-09-20 | 2008-03-26 | 三星电子株式会社 | 校准指南针传感器及测量方位角的方法、设备和介质 |
CN101292131A (zh) * | 2005-09-02 | 2008-10-22 | 诺基亚公司 | 3d场传感器的校准 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7523559B2 (en) * | 2004-04-07 | 2009-04-28 | Continental Automotive Systems Us, Inc. | Compass heading noise immunity |
US20090259424A1 (en) * | 2008-03-06 | 2009-10-15 | Texas Instruments Incorporated | Parameter estimation for accelerometers, processes, circuits, devices and systems |
-
2010
- 2010-04-19 CN CN2010101502384A patent/CN101806595B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5581899A (en) * | 1991-09-17 | 1996-12-10 | Siemens Aktiengesellschaft | Process for compensating a magnetic interference field in a vehicle |
CN1323979A (zh) * | 2000-05-12 | 2001-11-28 | 精工电子有限公司 | 校正机构,具有校正机构的电子方位计和电子时钟 |
CN1639542A (zh) * | 2002-03-01 | 2005-07-13 | 金泰克斯公司 | 电子罗盘系统 |
WO2006088057A1 (ja) * | 2005-02-17 | 2006-08-24 | Alps Electric Co., Ltd. | 方位計測装置 |
CN101292131A (zh) * | 2005-09-02 | 2008-10-22 | 诺基亚公司 | 3d场传感器的校准 |
CN101149262A (zh) * | 2006-09-20 | 2008-03-26 | 三星电子株式会社 | 校准指南针传感器及测量方位角的方法、设备和介质 |
Also Published As
Publication number | Publication date |
---|---|
CN101806595A (zh) | 2010-08-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101806595B (zh) | 一种两维电子指南针校准方法 | |
CN106443578B (zh) | 一种室内定位基站坐标标定方法 | |
CN108051835B (zh) | 一种基于双天线的倾斜测量装置及测量与放样方法 | |
CN106247914B (zh) | 一种坐标测量机触发式测头标定方法 | |
CN104897061A (zh) | 一种全站仪与三维激光扫描联合的大型海工装备测量方法 | |
CN103737433B (zh) | 大尺寸构件复合式精度测量方法 | |
CN105091911A (zh) | 一种pos系统动态定位精度检测系统及方法 | |
CN105043381A (zh) | 一种基于磁钉的定位方法 | |
CN104483891A (zh) | 一种提高机床空间运动精度的方法 | |
CN110263075A (zh) | Ladcp与usbl组合观测及数据资料处理方法 | |
CN202903177U (zh) | 一种激光测距仪 | |
CN105651311B (zh) | 农机作业卫星导航自动驾驶精度的测试方法 | |
CN104251665B (zh) | 一种引入控制点提高车载激光扫描数据的算法 | |
CN107063263A (zh) | 一种跟踪鲸类动物的方法 | |
CN203204159U (zh) | 一种用于水下定位综合系统 | |
CN106405604A (zh) | 一种基于传感器的定位方法及其装置 | |
CN106546229B (zh) | 一种便于现场指挥的测量放样方法 | |
CN105157691A (zh) | 一种指南针方位的确定方法及装置 | |
CN110232734B (zh) | 一种在役管道数据的数字化处理方法 | |
CN104166985A (zh) | 一种基于区域分割的星敏感器标定方法 | |
CN109767686A (zh) | 地图采集方法及电子设备、可读存储介质 | |
CN206002103U (zh) | 一种船体测量辅助工装 | |
CN106772332B (zh) | 一种旋转式距离测量验证方法 | |
CN107588773A (zh) | 一种基于航位推算与测距信息的多节点协同导航方法 | |
CN201876464U (zh) | 一种智能型多功能速度、位移标定系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |