CN113156167B - 一种三轴加速度计的标定方法及装置 - Google Patents
一种三轴加速度计的标定方法及装置 Download PDFInfo
- Publication number
- CN113156167B CN113156167B CN202110378609.2A CN202110378609A CN113156167B CN 113156167 B CN113156167 B CN 113156167B CN 202110378609 A CN202110378609 A CN 202110378609A CN 113156167 B CN113156167 B CN 113156167B
- Authority
- CN
- China
- Prior art keywords
- specific force
- term
- calibration
- acceleration
- model
- 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
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Force Measurement Appropriate To Specific Purposes (AREA)
Abstract
本发明提供了一种三轴加速度计的标定方法及装置。所述方法包括:建立三轴加速度计以比力为输入、以加速度为输出的三轴加速度计模型;求解用加速度、比力一次项、比力二次项表示的标定向量表达式;采用迭代法,根据所述模型和标定向量表达式更新比力一次项、比力二次项和标定向量,迭代结束后,完成三轴加速度计的标定。本发明不依赖于高精度三轴转台就可以实现三轴加速度计的标定;本发明由于不仅对比力一次项标定,还对比力二次项标定,可明显提高三轴加速度计的标定精度。
Description
技术领域
本发明涉及加速度计技术领域,具体涉及一种三轴加速度计的标定方法及装置。
背景技术
三轴加速度计是组成倾角仪和惯性导航系统的核心部件,其性能好坏直接影响到倾角仪和惯性导航系统的测量精度。加速度计的刻度系数、零位和安装误差会随时间推移而变化。在实际应用中,需要对三轴加速度计进行标定补偿以提高其测量精度。传统的加速度计标定方法需要利用高精度三轴转台提供姿态基准,根据三轴加速计输入输出的数学模型,借助高精度三轴转台提供输入基准值,结合加速度计的输出值进行标定。传统基于高精度三轴转台的标定方法,依赖于高精度三轴转台,但在外场环境中一般没有高精度三轴转台,因此限制了使用。基于椭球拟合的三轴加速度计标定方法不依赖于高精度转台,但无法对三轴加速度计的二次项系数进行标定,二次项误差是加速度计的一项重要误差源,如果不对其进行标定,很难满足加速度计在高精度领域的测精度要求。
发明内容
鉴于上述问题,本发明实施例提供一种三轴加速度计的标定方法及装置,标定过程不依赖于高精度三轴转台,而且同时对加速度计的一次项和二次项系数进行标定。
第一方面,本发明提供一种三轴加速度计的标定方法,包括:
建立三轴加速度计以比力为输入、以加速度为输出的三轴加速度计模型,所述模型包含比力一次项、比力二次项和常数项,比力一次项系数、比力二次项系数和常数项组成标定向量;
将m个不同位置的加速度代入所述模型得到一个方程组,求解所述方程组得到用加速度、比力一次项、比力二次项表示的标定向量表达式;
分别获取三轴加速度计在m个不同位置的加速度值,并以所述加速度值作为比力的初始值,采用迭代法,根据所述模型和标定向量表达式更新比力一次项、比力二次项和标定向量,迭代结束后,完成三轴加速度计的标定。
进一步地,所述模型为:
其中,ax、ay、az分别为加速度a在x、y、z方向的分量,fx、fy、fz分别为比力一次项在x、y、z方向的分量,分别为比力二次项在x、y、z方向的分量,kx、ky、kz、kxy、kyz、kzx为比力一次项系数,dx、dy、dz为比力二次项系数,为常数项。
标定向量表达式为:
X=[HTH]-1HTY
Y=[y1,y2,…,yi,…,ym]T
yi=[aix,aiy,aiz]T
H=[h1,h2,…,hi,…,hm]T
其中,i=1,2,…,m。
更进一步地,迭代过程中第n+1步比力的更新公式为:
第n+1步标定向量的更新公式为:
X(n+1)=[HT(n+1)H(n+1)]-1HT(n+1)Y
其中,i=1,2,…,m。
更进一步地,所述方法还包括归一化步骤,归一化公式为:
第二方面,本发明提供一种三轴加速度计的标定装置,包括:
模型建立模块,用于建立三轴加速度计以比力为输入、以加速度为输出的三轴加速度计模型,所述模型包含比力一次项、比力二次项和常数项,比力一次项系数、比力二次项系数和常数项组成标定向量;
表达式推导模块,用于将m个不同位置的加速度代入所述模型得到一个方程组,求解所述方程组得到用加速度、比力一次项、比力二次项表示的标定向量表达式;
迭代标定模块,用于分别获取三轴加速度计在m个不同位置的加速度值,并以所述加速度值作为比力的初始值,采用迭代法,根据所述模型和标定向量表达式更新比力一次项、比力二次项和标定向量,迭代结束后,完成三轴加速度计的标定。
进一步地,所述模型建立模块建立的所述模型为:
其中,ax、ay、az分别为加速度a在x、y、z方向的分量,fx、fy、fz分别为比力一次项在x、y、z方向的分量,分别为比力二次项在x、y、z方向的分量,kx、ky、kz、kxy、kyz、kzx为比力一次项系数,dx、dy、dz为比力二次项系数,为常数项。
标定向量表达式为:
X=[HTH]-1HTY
Y=[y1,y2,…,yi,…,ym]T
yi=[aix,aiy,aiz]T
H=[h1,h2,…,hi,…,hm]T
其中,i=1,2,…,m。
更进一步地,迭代过程中第n+1步比力的更新公式为:
第n+1步标定向量的更新公式为:
X(n+1)=[HT(n+1)H(n+1)]-1HT(n+1)Y
其中,i=1,2,…,m。
更进一步地,所述装置还包括归一化模块,用于按照下面公式对比力的值进行归一化处理:
与现有技术相比,本发明具有以下有益效果。
本发明通过建立三轴加速度计包含比力一次项、比力二次项和常数项的模型,以比力一次项系数、比力二次项系数和常数项组成标定向量,将m个不同位置的加速度代入所述模型并求解得到用加速度、比力一次项、比力二次项表示的标定向量表达式,分别获取三轴加速度计在m个不同位置的加速度值,并以所述加速度值作为比力的初始值,采用迭代法,根据所述模型和标定向量表达式更新比力一次项、比力二次项和标定向量,实现了三轴加速度计的标定。本发明不依赖于高精度三轴转台就可以实现三轴加速度计的标定;本发明由于不仅对比力一次项标定,还对比力二次项标定,可明显提高三轴加速度计的标定精度。
附图说明
图1为本发明实施例一种三轴加速度计的标定方法的流程图。
图2为三轴加速度计的18种不同位置的示意图。
图3为本发明一实施例一种三轴加速度计的标定装置的方框图。
具体实施方式
为使本发明的目的、技术方案及优点更加清楚、明白,以下结合附图及具体实施方式对本发明作进一步说明。显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1为本发明实施例一种三轴加速度计的标定方法的流程图,所述方法包括:
步骤101,建立三轴加速度计以比力为输入、以加速度为输出的模型,所述模型包含比力一次项、比力二次项和常数项,比力一次项系数、比力二次项系数和常数项组成标定向量;
步骤102,将m个不同位置的加速度代入所述模型得到一个方程组,求解所述方程组得到用加速度、比力一次项、比力二次项表示的标定向量表达式;
步骤103,分别获取三轴加速度计在m个不同位置的加速度值,并以所述加速度值作为比力的初始值,采用迭代法,根据所述模型和标定向量表达式更新比力一次项、比力二次项和标定向量,迭代结束后,完成三轴加速度计的标定。
本实施例中,步骤101主要用于建立三轴加速度计的加速度模型。加速度计是一种用来测量物体加速度的传感器,通常由质量块、阻尼器、弹性元件、敏感元件和控制器等部分组成。传感器在加速过程中,通过对质量块所受惯性力的测量,利用牛顿第二定律获得加速度值。常用的一种加速度传感器是三轴加速度计,用于测量加速度空间矢量,一方面,要准确了解物体的运动状态,必须测得其三个坐标轴上的分量;另一方面,在预先不知道物体运动方向的场合下,只有应用三轴加速度计来检测加速度信号。
加速度是比力的函数,比力的定义就是作用在单位质量上的非引力外力,即非引力外力与质量的比值就是比力。加速度可以近似表示为比力的一次函数或线性函数,现有技术中加速度的标定或校准也只是针对比力的一次项进行的。在精度要求不高的场合,只标定比力的一次项一般都能满足要求;但当精度要求很高时,只标定比力的一次项产生的误差就不容忽视了。为此,本实施例建立了不仅包含比力一次项,还包含比力二次项的加速度模型(当然还包含常数项)。实际上要标定的就是模型中比力的一次项系数、二次项系数和常数项,因此标定向量由这3项参数组成。这些参数标定好后,所述模型就确定了,只要将比力代入标定好的模型就可以得到输出的加速度值。
本实施例中,步骤102主要用于推导用加速度、比力一次项、比力二次项表示的标定向量表达式。将m个不同位置的加速度代入所述模型得到一组方程,这组方程以需要标定的参数为未知量、以加速度、比力一次项、比力二次项为已知量,求解这个方程组就可以得用加速度、比力一次项、比力二次项表示的标定向量表达式。要想使方程组有唯一解,方程的个数应不少于未知量的个数(即标定向量的维数),而一个位置可以得到分别对应x、y、z方向的三个方程。当然,标定参数也均与x、y、z三个方向对应。据此可确定m的大小。
本实施例中,步骤103主要用于采用迭代法完成三轴加速度计的标定。迭代法也称辗转法,是一种不断用上一时刻(步)变量的旧值递推当前时刻(步)变量新值的过程,即从初始值x(0)开始,依次得到x(1)、x(2)、…、x(k)的值,直到迭代误差小于设定的阈值或达到设定的最大迭代次数。因此,迭代法一般包括三个步骤:变量初始化,变量更新,重复迭代直到结束。
在本实施例中,首先,分别获取三轴加速度计在m个不同位置的加速度值,并以所述加速度值作为比力的初始值,根据比力的初始值和标定向量表达式可得到标定向量的初始值。为了降低噪声影响,可在每个位置重复测量多个加速度值再求均值。类似于椭球拟合标定法,m个不同位置分布在椭球的各个方位,其中位置编排不需要精确角度定位,只需大概的角度。下面给出m=18的一个具体实例,如图2所示,18个位置分别为:x轴朝天;x轴朝地;y轴朝天;y轴朝地;z轴朝天;z轴朝地;初始时z朝天,绕x轴正向旋转45°;初始时z朝天,绕x轴正向旋转135°;初始时z朝天,绕x轴正向旋转225°;初始时z朝天,绕x轴正向旋转315°;初始时z朝天,绕y轴正向旋转45°;初始时z朝天,绕y轴正向旋转135°;初始时z朝天,绕y轴正向旋转225°;初始时z朝天,绕y轴正向旋转315°;初始时x朝天,绕z轴正向旋转45°;初始时x朝天,绕z轴正向旋转135°;初始时x朝天,绕z轴正向旋转225°;初始时x朝天,绕z轴正向旋转315°。
初始化完成后,根据所述模型,以当前步的比力一次项为未知量,以上一步的比力二次项为未知量,可得到比力一次项的更新公式。根据标定向量表达式可得到标定向量的更新公式。最后,重复迭代,如果迭代次数达到设定的最大次数终止迭代。迭代结束后,就实现了三轴加速度计的标定,即对标定向量的校准。
本实施例通过建立包括比力一次项、比力二次项的加速度模型,采用迭代法实现了三轴加速度计的标定。本实施例由于不仅对比力一次项标定,还对比力二次项标定,可明显提高三轴加速度计的标定精度。
作为一可选实施例,所述模型为:
其中,ax、ay、az分别为加速度a在x、y、z方向的分量,fx、fy、fz分别为比力一次项在x、y、z方向的分量,分别为比力二次项在x、y、z方向的分量,kx、ky、kz、kxy、kyz、kzx为比力一次项系数,dx、dy、dz为比力二次项系数,为常数项。
本实施例给出了所述模型的一种具体表达式。模型是用矩阵表示的,等号左边是加速度的三个分量;等号右边包括比力一次项、比力二次项和常数项的三个分量。常数项又称为零位误差,即比力为0时的加速度值。比力一次项系数矩阵是一个对称矩阵,共有6个不同元素,分别为kx、ky、kz、kxy、kyz、kzx,它们的大小由三轴加速度计的结构决定。kxy、kyz、kzx不等于0,表示一个方向的加速度分量与三个方向的比力一次项有关。而比力二次项系数矩阵则只有对角线上的三个元素dx、dy、dz不是0,表示一个方向的加速度分量只与相同方向的比力二次项有关。
作为一可选实施例,标定向量为:
标定向量表达式为:
X=[HTH]-1HTY
Y=[y1,y2,…,yi,…,ym]T
yi=[aix,aiy,aiz]T
H=[h1,h2,…,hi,…,hm]T
其中,i=1,2,…,m。
本实施例给出了标定向量和标定向量表达式的一种具体形式。标定向量是一个12维向量,包括12个标定参数,依次是比力一次项系数矩阵中的6个参数、常数项的3个分量和比力二次项系数矩阵中的3个参数。有了标定向量X,前面的模型就可写成:
y=hX
y=[ax,ay,az[T
将m个不同位置的加速度代入y=hX,得到的方程组写成矩阵形式为:Y=HX,Y=[y1,y2,…,yi,…,ym]T,H=[h1,h2,…,hi,…,hm]T。Y=HX,两边同时左乘一个HT和[HTH]-1得到:X=[HTH]-1HTY。
作为一可选实施例,迭代过程中第n+1步比力的更新公式为:
第n+1步标定向量的更新公式为:
X(n+1)=[HT(n+1)H(n+1)]-1HT(n+1)Y
其中,i=1,2,…,m。
本实施例给出了迭代过程中比力和标定向量的更新公式。根据前面实施例中介绍的这两个量的更新原理,将具体的表达式代入后,很容易得到上面的更新公式。这里不再详细推导。
作为一可选实施例,所述方法还包括归一化步骤,归一化公式为:
本实施例给出了迭代过程中对比力进行归一化处理的计算公式。上面的归一化公式是将比力的模值都归一化到重力加速度g,很显然,公式右边三个分量的平方和再开方等于g。另外,n=0时,上面的公式是对比力的初始值进行归一化的公式,比力的初始值是在m个不同位置测得的加速度值。
图3为本发明实施例一种三轴加速度计的标定装置的组成示意图,所述装置包括:
模型建立模块11,用于建立三轴加速度计以比力为输入、以加速度为输出的三轴加速度计模型,所述模型包含比力一次项、比力二次项和常数项,比力一次项系数、比力二次项系数和常数项组成标定向量;
表达式推导模块12,用于将m个不同位置的加速度代入所述模型得到一个方程组,求解所述方程组得到用加速度、比力一次项、比力二次项表示的标定向量表达式;
迭代标定模块13,用于分别获取三轴加速度计在m个不同位置的加速度值,并以所述加速度值作为比力的初始值,采用迭代法,根据所述模型和标定向量表达式更新比力一次项、比力二次项和标定向量,迭代结束后,完成三轴加速度计的标定。
本实施例的装置,可以用于执行图1所示方法实施例的技术方案,其实现原理和技术效果类似,此处不再赘述。后面的实施例也是如此,均不再展开说明。
作为一可选实施例,所述模型建立模块11建立的所述模型为:
其中,ax、ay、az分别为加速度a在x、y、z方向的分量,fx、fy、fz分别为比力一次项在x、y、z方向的分量,分别为比力二次项在x、y、z方向的分量,kx、ky、kz、kxy、kyz、kzx为比力一次项系数,dx、dy、dz为比力二次项系数,为常数项。
作为一可选实施例,标定向量为:
标定向量表达式为:
X=[HTH]-1HTY
Y=[y1,y2,…,yi,…,ym]T
yi=[aix,aiy,aiz]T
H=[h1,h2,…,hi,…,hm]T
其中,i=1,2,…,m。
作为一可选实施例,迭代过程中第n+1步比力的更新公式为:
第n+1步标定向量的更新公式为:
X(n+1)=[HT(n+1)H(n+1)]-1HT(n+1)Y
其中,i=1,2,…,m。
作为一可选实施例,所述装置还包括归一化模块,用于按照下面公式对比力的值进行归一化处理:
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求书的保护范围为准。
Claims (6)
1.一种三轴加速度计的标定方法,其特征在于,包括:
建立三轴加速度计以比力为输入、以加速度为输出的三轴加速度计模型,所述模型包含比力一次项、比力二次项和常数项,比力一次项系数、比力二次项系数和常数项组成标定向量;所述模型为:
其中,ax、ay、az分别为加速度a在x、y、z方向的分量,fx、fy、fz分别为比力一次项在x、y、z方向的分量,分别为比力二次项在x、y、z方向的分量,kx、ky、kz、kxy、kyz、kzx为比力一次项系数,dx、dy、dz为比力二次项系数,为常数项;
标定向量表达式为:
X=[HTH]-1HTY
Y=[y1,y2,…,yi,…,ym]T
yi=[aix,aiy,aiz]T
H=[h1,h2,…,hi,…,hm]T
其中,i=1,2,…,m;
分别获取三轴加速度计在m个不同位置的加速度值,并以所述加速度值作为比力的初始值,采用迭代法,根据所述模型和标定向量表达式更新比力一次项、比力二次项和标定向量,迭代结束后,完成三轴加速度计的标定。
4.一种三轴加速度计的标定装置,其特征在于,包括:
其中,ax、ay、az分别为加速度a在x、y、z方向的分量,fx、fy、fz分别为比力一次项在x、y、z方向的分量,分别为比力二次项在x、y、z方向的分量,kx、ky、kz、kxy、kyz、kzx为比力一次项系数,dx、dy、dz为比力二次项系数,为常数项;
标定向量表达式为:
X=[HTH]-1HTY
Y=[y1,y2,…,yi,…,ym]T
yi=[aix,aiy,aiz]T
H=[h1,h2,…,hi,…,hm]T
其中,i=1,2,…,m;
迭代标定模块,用于分别获取三轴加速度计在m个不同位置的加速度值,并以所述加速度值作为比力的初始值,采用迭代法,根据所述模型和标定向量表达式更新比力一次项、比力二次项和标定向量,迭代结束后,完成三轴加速度计的标定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110378609.2A CN113156167B (zh) | 2021-04-08 | 2021-04-08 | 一种三轴加速度计的标定方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110378609.2A CN113156167B (zh) | 2021-04-08 | 2021-04-08 | 一种三轴加速度计的标定方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113156167A CN113156167A (zh) | 2021-07-23 |
CN113156167B true CN113156167B (zh) | 2022-12-02 |
Family
ID=76889148
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110378609.2A Active CN113156167B (zh) | 2021-04-08 | 2021-04-08 | 一种三轴加速度计的标定方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113156167B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114280332B (zh) * | 2021-12-31 | 2024-04-23 | 成都路行通信息技术有限公司 | 一种三轴加速度传感器校正方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03216557A (ja) * | 1990-01-23 | 1991-09-24 | Mitsubishi Heavy Ind Ltd | 加速度計精密校正法 |
CN102636183B (zh) * | 2012-03-31 | 2014-07-16 | 北京航空航天大学 | 基于光纤监测和双轴转台离心机的挠性陀螺二次过载项测试方法 |
CN108489485B (zh) * | 2018-03-20 | 2021-07-06 | 西北工业大学 | 一种无误差的捷联惯导数值更新方法 |
CN108982918B (zh) * | 2018-07-27 | 2020-07-14 | 北京航天控制仪器研究所 | 基准不确定情况下加速度计组合误差系数分离与标定方法 |
CN111781400B (zh) * | 2020-07-10 | 2021-08-10 | 哈尔滨工业大学 | 一种标定加速度计高阶误差系数的方法 |
-
2021
- 2021-04-08 CN CN202110378609.2A patent/CN113156167B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN113156167A (zh) | 2021-07-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Zhang et al. | Improved multi-position calibration for inertial measurement units | |
CN106969783B (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
EP1929246B1 (en) | Calibration of 3d field sensors | |
CN107655493B (zh) | 一种光纤陀螺sins六位置系统级标定方法 | |
CN108592952A (zh) | 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法 | |
CN112945271B (zh) | 磁力计信息辅助的mems陀螺仪标定方法及标定系统 | |
CN111780786A (zh) | 一种三轴tmr传感器在线校准方法 | |
CN110174123B (zh) | 一种磁传感器实时标定方法 | |
CN109709628B (zh) | 一种旋转加速度计重力梯度仪标定方法 | |
CN112129322B (zh) | 一种捷联惯组与三轴转台的安装误差检测方法及校正方法 | |
CN115046539A (zh) | Mems电子罗盘动态校准方法 | |
CN113156167B (zh) | 一种三轴加速度计的标定方法及装置 | |
Aligia et al. | An orientation estimation strategy for low cost IMU using a nonlinear Luenberger observer | |
CN114877915A (zh) | 一种激光陀螺惯性测量组件g敏感性误差标定装置及方法 | |
CN113916257A (zh) | 三轴mems加计组合惯性测量单元标定方法 | |
CN110940357B (zh) | 一种用于旋转惯导单轴自对准的内杆臂标定方法 | |
CN114459478B (zh) | 一种基于姿态运动学模型的惯性测量单元数据融合方法 | |
CN110954081A (zh) | 一种磁罗盘快速校准装置及方法 | |
Xing et al. | Offline calibration for MEMS gyroscope g-sensitivity error coefficients based on the Newton iteration and least square methods | |
CN116429095A (zh) | 一种基于主子惯导结合的行进间炮口振动测量方法 | |
CN109871658A (zh) | 用于导弹弹头转动惯量和惯性积测量的多姿态最优估计方法 | |
CN113405567B (zh) | 一种重力卫星星敏感器安装矩阵在轨定标方法及系统 | |
CN115267256A (zh) | 一种加速度计组件的模观测标定方法 | |
CN111780787A (zh) | 一种基于光纤惯性辅助的mems惯组标定方法 | |
CN113970344B (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 |