CN112762916B - 磁罗盘参数标定方法、装置、计算机设备及存储介质 - Google Patents
磁罗盘参数标定方法、装置、计算机设备及存储介质 Download PDFInfo
- Publication number
- CN112762916B CN112762916B CN202110028970.2A CN202110028970A CN112762916B CN 112762916 B CN112762916 B CN 112762916B CN 202110028970 A CN202110028970 A CN 202110028970A CN 112762916 B CN112762916 B CN 112762916B
- Authority
- CN
- China
- Prior art keywords
- magnetic compass
- estimated
- parameters
- pointer
- magnetic
- 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
Images
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
-
- 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/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Data Mining & Analysis (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Pure & Applied Mathematics (AREA)
- Computational Mathematics (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computing Systems (AREA)
- Operations Research (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Measuring Magnetic Variables (AREA)
Abstract
本发明公开了一种磁罗盘参数标定方法、装置、计算机设备及存储介质,该方法通过获取磁罗盘的指针坐标;根据所述指针坐标计算待估计的参数向量;将所述待估计的参数向量代入预设的磁罗盘模型方程中,以计算所述磁罗盘参数,其中,所述磁罗盘参数包括所述磁罗盘的零偏误差和所述磁罗盘的比例系数。该磁罗盘参数标定方法、装置、计算机设备及存储介质能够简化磁罗盘参数的计算过程。
Description
技术领域
本发明涉及计算机领域,尤其涉及一种磁罗盘参数标定方法、装置、计算机设备及存储介质。
背景技术
随着科学技术的进步,无人机对载体姿态测量精度的要求越来越高。磁罗盘在无人机组合导航系统中用于提供绝对航向信息,而航向的精度直接决定着系统定位的精度。为了获得高精度、高可靠性的航向信息,就必须对磁罗盘误差进行有效的标定与补偿。
现有磁罗盘标定技术主要有两类:一类是借助外界信息的标定方法,如借助六面体或转台进行多位置标定,或依靠速率传感器、GPS等进行标定;此类方法精度高,但是对标定设备要求极高,十分容易引入外界磁干扰,从而导致结果不准确,给系统航向精度带来了不必要的损失。第二类是不借助外界信息的自标定方法,基于最佳椭圆假设,使用基于扩展卡尔曼滤波和Unscented卡尔曼滤波的方法,对磁罗盘进行实时标定,这种方法对三轴软硬磁干扰都进行了补偿,但补偿效果受滤波初值影响较大,且计算复杂。
发明内容
本发明发明的目的在于提供一种磁罗盘参数标定方法、装置、计算机设备及存储介质,以简化磁罗盘参数的标定过程。
为了实现上述目的,本发明采用如下技术方案:
本发明实施例提出了一种磁罗盘参数标定方法,包括:
获取磁罗盘的指针坐标;
根据所述指针坐标计算待估计的参数向量;
将所述待估计的参数向量代入预设的磁罗盘模型方程中,计算所述磁罗盘参数,其中,所述磁罗盘参数包括所述磁罗盘的零偏误差和所述磁罗盘的比例系数。
优选地,所述磁罗盘模型方程为:
其中,bx表示磁罗盘在x轴方向的零偏误差,by表示磁罗盘在y轴方向的零偏误差,kx表示磁罗盘在x轴方向的比例系数,ky表示磁罗盘在y轴方向的比例系数;
所述磁罗盘模型方程与所述待估计的参数向量之间的关系为:
所述将所述待估计的参数向量代入预设的磁罗盘模型方程中,以计算所述磁罗盘参数,包括:
根据公式(1)-(8)计算所述磁罗盘的零偏误差bx,by和所述磁罗盘的比例系数kx,ky。
优选地,在计算出所述磁罗盘参数之后,所述方法还包括:
根据所述磁罗盘参数对所述磁罗盘的指针坐标进行校正。
优选地,采用以下公式对所述磁罗盘的指针坐标进行校正,包括:
xc=(xm+bx)·kx (9)
yc=(ym+by)·ky (10)
其中,xc表示校正后的磁罗盘的指针x轴坐标,yc表示校正后的磁罗盘的指针y轴坐标。
本发明实施例还提出了一种磁罗盘参数标定装置,包括:
获取单元,用于获取磁罗盘的指针坐标;
第一计算单元,用于根据所述指针坐标计算待估计的参数向量;
第二计算单元,用于将所述待估计的参数向量代入预设的磁罗盘模型方程中,以计算所述磁罗盘参数,其中,所述磁罗盘参数包括所述磁罗盘的零偏误差和所述磁罗盘的比例系数。
优选地,所述磁罗盘参数标定装置还包括:校正单元,该校正单元用于根据所述磁罗盘参数对所述磁罗盘的指针坐标进行校正。
优选地,所述校正单元采用以下公式进行校正:
xc=(xm+bx)·kx
yc=(ym+by)·ky
其中,xc表示校正后的磁罗盘的指针x轴坐标,yc表示校正后的磁罗盘的指针y轴坐标。
本发明实施例还提出了一种计算机设备,包括存储器和处理器,所述存储器中存储有磁罗盘参数标定程序,所述处理器用于执行所述磁罗盘参数标定程序时实现所述的磁罗盘参数标定方法的步骤。
本发明实施例还提出了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现所述磁罗盘参数标定方法的步骤。
相对于现有技术,本发明具有以下有益效果:
上述磁罗盘参数标定方法、装置、计算机设备及存储介质,通过获取磁罗盘的指针坐标,并根据该指针坐标计算待估计的参数向量,然后输入根据磁罗盘的特性预先建立磁罗盘模型方程中,以计算磁罗盘参数。该方法操作和计算过程都较为简单,与采用卡尔曼滤波算来来计算磁罗盘参数的方法相比较,计算出来的磁罗盘参数受初值影响小,能够有效地提高磁罗盘参数的计算效率。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对本发明实施例的描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1是本发明一实施例中磁罗盘参数标定方法的流程图;
图2是磁罗盘的坐标系的示意图;
图3是本发明一实施例中磁罗盘参数标定装置的原理框图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
在本发明的描述中,需要说明的是,术语“第一”、“第二”、“第三”等仅用于区分描述,而不能理解为指示或暗示相对重要性。
在本发明的描述中,还需要说明的是,除非另有明确的规定和限定,术语“设置”、连接应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
本发明实施例提供的磁罗盘参数标定方法,可应用在各种导航系统中,例如无人机导航系统。在一实施例中,如图1所示,提供一种磁罗盘参数标定方法,包括如下步骤:
S10:获取磁罗盘的指针坐标。
其中,磁罗盘的指针坐标是指磁罗盘的指针在坐标系上的二维坐标,指针指向的位置则为指针坐标,示例性地,该坐标系可如图2所示。具体地,可以通过控制磁罗盘的指针沿着水平面方向旋转一定角度即可获得磁罗盘的指针坐标。
S20:根据指针坐标计算待估计的参数向量。
S30:将待估计的参数向量代入预设的磁罗盘模型方程中,以计算磁罗盘参数,其中,磁罗盘参数包括磁罗盘的零偏误差和磁罗盘的比例系数。
其中,磁罗盘模型方程的设置原理为:假设磁罗盘的指针坐标为:Magm=[xm ym]T,校正后的磁罗盘的指针坐标为:Magc=[xc yc]T,磁罗盘零偏误差为:Magb=[bx by]T,磁罗盘比例系数为:Magk=[kx ky]T,假设校正后磁罗盘水平坐标平面的值在一个圆形上,那么有:
则校正后的磁罗盘的指针坐标与原始的磁罗盘的指针坐标关系如下:
xc=(xm+bx)·kx
yc=(ym+by)·ky (12)
将式(12)带入式(11)得到:
将式(13)展开并整理可得:
假设:
根据式(15)(16),式(14)可改写为:
由式(16)可得,磁罗盘模型方程:
上述过程为磁罗盘模型方程的原理,在清楚磁罗盘模型方程的原理之后,本实施例将讲解如何计算磁罗盘参数:
首先,定义待估计的参数向量为:
定义量测矩阵为:量测向量为Zj,Pj=diag[100 100100100],Rj=[0.2],然后将量测向量Zj与量测矩阵Hj代入递推最小二乘估计公式可计算待估计的参数向量,其中,递推最小二乘估计公式为:
Pj=(I-KjHj)Pj-1 (20c)
最后,将a、b、d、e代入式(15)中可计算出磁罗盘参数:磁罗盘的零偏误差bx,by和所述磁罗盘的比例系数kx,ky。
上述实施例通过获取磁罗盘的指针坐标,并根据该指针坐标计算待估计的参数向量,然后输入根据磁罗盘的特性预先建立磁罗盘模型方程中,以计算磁罗盘参数。该方法操作和计算过程都较为简单,与采用卡尔曼滤波算来来计算磁罗盘参数的方法相比较,计算出来的磁罗盘参数受初值影响小,能够有效地提高磁罗盘参数的计算效率。
在计算出所述磁罗盘参数之后,可以根据磁罗盘参数对磁罗盘的指针坐标进行补偿校正,从而输出高精度的磁罗盘数据,进而为导航系统提供高精度的导航信息。
具体地,对磁罗盘的指针坐标进行补偿校正可以根据上述磁罗盘模型方程的设置原理进行:由于校正后的磁罗盘的指针坐标与原始的磁罗盘的指针坐标关系为:因此,在计算出磁罗盘参数:磁罗盘的零偏误差bx,by和所述磁罗盘的比例系数kx,ky之后,可将这些磁罗盘参数代入磁罗盘的指针坐标校正公式中,可计算出校正后的磁罗盘的指针坐标。
应理解,上述实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本发明实施例的实施过程构成任何限定。
在一实施例中,提供一种磁罗盘参数标定装置,该磁罗盘参数标定装置与上述实施例中磁罗盘参数标定方法一一对应。如图3所示,该磁罗盘参数标定装置包括:
获取单元10,用于获取磁罗盘的指针坐标;
第一计算单元20,用于根据所述指针坐标计算待估计的参数向量;
第二计算单元30,用于将所述待估计的参数向量代入预设的磁罗盘模型方程中,以计算所述磁罗盘参数,其中,所述磁罗盘参数包括所述磁罗盘的零偏误差和所述磁罗盘的比例系数。
另外,该磁罗盘参数标定装置还包括:校正单元,用于根据磁罗盘参数对磁罗盘的指针坐标进行校正。且该校正单元采用以下公式进行校正:
xc=(xm+bx)·kx
yc=(ym+by)·ky
其中,xc表示校正后的磁罗盘的指针x轴坐标,yc表示校正后的磁罗盘的指针y轴坐标。
关于磁罗盘参数标定装置的具体限定可以参见上文中对于磁罗盘参数标定装置方法的限定,在此不再赘述。上述磁罗盘参数标定装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
在一个实施例中,提供了一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,处理器执行计算机程序时实现以下上述磁罗盘参数标定装置方法的步骤。
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现上述磁罗盘参数标定装置方法的步骤。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本发明所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(ROM)、可编程ROM(PROM)、电可编程ROM(EPROM)、电可擦除可编程ROM(EEPROM)或闪存。易失性存储器可包括随机存取存储器(RAM)或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,诸如静态RAM(SRAM)、动态RAM(DRAM)、同步DRAM(SDRAM)、双数据率SDRAM(DDRSDRAM)、增强型SDRAM(ESDRAM)、同步链路(Synchlink)DRAM(SLDRAM)、存储器总线(Rambus)直接RAM(RDRAM)、直接存储器总线动态RAM(DRDRAM)、以及存储器总线动态RAM(RDRAM)等。
所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,仅以上述各功能单元、模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能单元、模块完成,即将所述装置的内部结构划分成不同的功能单元或模块,以完成以上描述的全部或者部分功能。
以上所述实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围,均应包含在本发明的保护范围之内。
Claims (6)
1.一种磁罗盘参数标定方法,其特征在于,包括:
获取磁罗盘的指针坐标;
根据所述指针坐标计算待估计的参数向量;
将所述待估计的参数向量代入预设的磁罗盘模型方程中,计算所述磁罗盘参数;其中,所述磁罗盘参数包括所述磁罗盘的零偏误差和所述磁罗盘的比例系数;
所述磁罗盘模型方程为:
其中,bx表示磁罗盘在x轴方向的零偏误差,by表示磁罗盘在y轴方向的零偏误差,kx表示磁罗盘在x轴方向的比例系数,ky表示磁罗盘在y轴方向的比例系数;
所述磁罗盘模型方程与所述待估计的参数向量之间的关系为:
所述将所述待估计的参数向量代入预设的磁罗盘模型方程中,计算所述磁罗盘参数,包括:
根据公式(1)-(8)计算所述磁罗盘的零偏误差bx,by和所述磁罗盘的比例系数kx,ky;
所述方法还包括:
根据所述磁罗盘参数对所述磁罗盘的指针坐标进行校正。
2.如权利要求1所述的磁罗盘参数标定方法,其特征在于,采用以下公式对所述磁罗盘的指针坐标进行校正,包括:
xc=(xm+bx)·kx (9)
yc=(ym+by)·ky (10)
其中,xc表示校正后的磁罗盘的指针x轴坐标,yc表示校正后的磁罗盘的指针y轴坐标。
3.一种磁罗盘参数标定装置,其特征在于,包括:
获取单元,用于获取磁罗盘的指针坐标;
第一计算单元,用于根据所述指针坐标计算待估计的参数向量;
第二计算单元,用于将所述待估计的参数向量代入预设的磁罗盘模型方程中,计算所述磁罗盘参数,其中,所述磁罗盘参数包括所述磁罗盘的零偏误差和所述磁罗盘的比例系数;
所述磁罗盘参数标定装置还包括:校正单元,用于根据所述磁罗盘参数对所述磁罗盘的指针坐标进行校正;
所述磁罗盘模型方程为:
其中,bx表示磁罗盘在x轴方向的零偏误差,by表示磁罗盘在y轴方向的零偏误差,kx表示磁罗盘在x轴方向的比例系数,ky表示磁罗盘在y轴方向的比例系数;
所述磁罗盘模型方程与所述待估计的参数向量之间的关系为:
所述将所述待估计的参数向量代入预设的磁罗盘模型方程中,计算所述磁罗盘参数,包括:
根据公式(1)-(8)计算所述磁罗盘的零偏误差bx,by和所述磁罗盘的比例系数kx,ky。
4.如权利要求3所述的磁罗盘参数标定装置,其特征在于,所述校正单元采用以下公式进行校正:
xc=(xm+bx)·kx
yc=(ym+by)·ky
其中,xc表示校正后的磁罗盘的指针x轴坐标,yc表示校正后的磁罗盘的指针y轴坐标。
5.一种计算机设备,包括存储器和处理器,其特征在于,所述存储器中存储有磁罗盘参数标定程序,所述处理器用于执行所述磁罗盘参数标定程序时实现如权利要求1至2任一项所述的磁罗盘参数标定方法的步骤。
6.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至2任一项所述磁罗盘参数标定方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110028970.2A CN112762916B (zh) | 2021-01-09 | 2021-01-09 | 磁罗盘参数标定方法、装置、计算机设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110028970.2A CN112762916B (zh) | 2021-01-09 | 2021-01-09 | 磁罗盘参数标定方法、装置、计算机设备及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112762916A CN112762916A (zh) | 2021-05-07 |
CN112762916B true CN112762916B (zh) | 2023-02-10 |
Family
ID=75701235
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110028970.2A Active CN112762916B (zh) | 2021-01-09 | 2021-01-09 | 磁罗盘参数标定方法、装置、计算机设备及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112762916B (zh) |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106597017B (zh) * | 2016-12-16 | 2019-07-26 | 上海拓攻机器人有限公司 | 一种基于扩展卡尔曼滤波的无人机角加速度估计方法及装置 |
CN110954081A (zh) * | 2019-12-25 | 2020-04-03 | 中国船舶重工集团有限公司第七一0研究所 | 一种磁罗盘快速校准装置及方法 |
CN111982089A (zh) * | 2020-07-28 | 2020-11-24 | 陕西宝成航空仪表有限责任公司 | 一种磁罗盘全罗差实时校准与补偿方法 |
-
2021
- 2021-01-09 CN CN202110028970.2A patent/CN112762916B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN112762916A (zh) | 2021-05-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109959381B (zh) | 一种定位方法、装置、机器人及计算机可读存储介质 | |
CN111208492B (zh) | 车载激光雷达外参标定方法及装置、计算机设备及存储介质 | |
US20210041236A1 (en) | Method and system for calibration of structural parameters and construction of affine coordinate system of vision measurement system | |
CN108507568B (zh) | 补偿温度漂移误差的方法、装置和组合导航系统 | |
CN108426571B (zh) | 一种电子罗盘本地实时校准方法及装置 | |
JP2004525347A (ja) | 電子コンパス及び全オリエンテーション動作に対する大磁気誤差の補償 | |
CN109612460B (zh) | 一种基于静止修正的垂线偏差测量方法 | |
CN112798021B (zh) | 基于激光多普勒测速仪的惯导系统行进间初始对准方法 | |
CN108957495A (zh) | Gnss与mimu组合导航方法 | |
CN108198219B (zh) | 用于摄影测量的相机标定参数的误差补偿方法 | |
CN102798393A (zh) | 移动设备 | |
CN110579730A (zh) | 一种三轴磁传感器的转向差校正方法 | |
CN112099006A (zh) | 一种合成孔径雷达相对定位误差校正方法、系统及装置 | |
CN103913179A (zh) | 舰载单轴旋转调制捷联惯导姿态角修正方法 | |
CN112762916B (zh) | 磁罗盘参数标定方法、装置、计算机设备及存储介质 | |
CN111707292B (zh) | 一种自适应滤波的快速传递对准方法 | |
CN113092822A (zh) | 一种基于惯组的激光多普勒测速仪的在线标定方法和装置 | |
CN114019954B (zh) | 航向安装角标定方法、装置、计算机设备和存储介质 | |
CN110186479B (zh) | 一种惯性器件误差系数确定方法 | |
CN115616642A (zh) | 一种位置数据的纠正处理方法、装置、设备及存储介质 | |
CN111982155B (zh) | 磁传感器的标定方法、装置、电子设备和计算机存储介质 | |
CN109211271B (zh) | 一种磁罗盘自校正方法 | |
CN112683265A (zh) | 一种基于快速iss集员滤波的mimu/gps组合导航方法 | |
CN109581428A (zh) | 一种基于光学影像的在轨自修正的定位方法 | |
CN113267182B (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 |