首页> 中国专利> 三轴矢量传感器及两轴矢量传感器的标定补偿方法

三轴矢量传感器及两轴矢量传感器的标定补偿方法

摘要

本发明涉及矢量传感器的误差修正,具体是一种三轴矢量传感器及两轴矢量传感器的标定补偿方法。解决了现有多轴矢量传感器的标定补偿方法未同时兼顾引起测量误差的所有因素等问题,方法依照矢量传感器实测输出Sm、理论输出Se的关系式Sm=KSe+S0及误差系数矩阵K=K1K2,构建矢量传感器误差修正数学模型:,K1、K2分别为三轴矢量传感器的灵敏度误差系数矩阵、三测量轴间不正交误差系数矩阵;以有效方法获得误差修正数学模型中的零偏S0、修正系数矩阵K-1,最终得到所测矢量传感器的误差修正数学模型,对矢量传感器的测量结果进行标定补偿。兼顾引起多轴矢量传感器测量误差的所有因素进行标定补偿,提高测量结果精度;过程简洁方便、对硬件设备没有过高要求,适用于多种矢量传感器。

著录项

  • 公开/公告号CN101887068A

    专利类型发明专利

  • 公开/公告日2010-11-17

    原文格式PDF

  • 申请/专利权人 中北大学;

    申请/专利号CN201010192636.2

  • 申请日2010-06-01

  • 分类号G01P21/00(20060101);G01R35/00(20060101);

  • 代理机构14100 山西太原科卫专利事务所;

  • 代理人朱源;骆洋

  • 地址 030051 山西省太原市尖草坪区学院路3号

  • 入库时间 2023-12-18 01:05:14

法律信息

  • 法律状态公告日

    法律状态信息

    法律状态

  • 2023-06-09

    未缴年费专利权终止 IPC(主分类):G01P21/00 专利号:ZL2010101926362 申请日:20100601 授权公告日:20111116

    专利权的终止

  • 2011-11-16

    授权

    授权

  • 2011-10-05

    著录事项变更 IPC(主分类):G01P21/00 变更前: 变更后: 申请日:20100601

    著录事项变更

  • 2010-12-29

    实质审查的生效 IPC(主分类):G01P21/00 申请日:20100601

    实质审查的生效

  • 2010-11-17

    公开

    公开

说明书

技术领域

本发明涉及矢量传感器的误差修正,具体是一种三轴矢量传感器及两轴矢量传感器的标定补偿方法。

背景技术

随着现代科学技术的进步,许多工业领域对测量精度的要求越来越高,所以简单准确的仪器校准技术就显得至关重要。对于多轴矢量传感器(一般指三轴矢量传感器及两轴矢量传感器)来说,其测量结果的精度与构成多轴矢量传感器的各单轴传感器的零偏误差、灵敏度误差、以及各单轴传感器安装误差相关;其中,各单轴传感器的安装误差导致各单轴传感器的测量轴不正交(单轴传感器测量轴与正交坐标系坐标轴间的夹角一般在几十分到几度之间),是引起多轴矢量传感器的测量误差的主要原因。因此,现有多轴矢量传感器测量结果的标定补偿方法,都主要针对各单轴传感器的安装误差进行补偿,以获得较高精度的测量结果,而忽略构成多轴矢量传感器的各单轴传感器的零偏误差、灵敏度误差,至少未同时兼顾进行补偿;而且现有标定补偿方法都比较复杂,实现不易,例如:标定MEMS加速度计的六位置法,需要将待标定MEMS加速度计固定安装于位置转台台面上,并且待标定MEMS加速度计的被测试轴向需要与位置转台台面的中心轴线垂直安装,同时从六个标准位置采集数据,实现上存在难度;另外,对于多轴矢量传感器中矢量磁传感器的现有标定补偿方法来说,除存在着操作时间长、场地要求面积大等问题外,不但要求转台无磁性,而且由于方法中需要转台转动精确,因而对设备要求极高。

发明内容

本发明为了解决现有多轴矢量传感器的标定补偿方法未同时兼顾引起测量误差的所有因素,且方法复杂、实现不易、对设备要求极高等问题,提供了一种修正过程简便、修正结果精确的三轴矢量传感器及两轴矢量传感器的标定补偿方法。分别适用于三轴矢量加速度计、三轴矢量磁传感器、以及两轴矢量加速度计和两轴矢量磁传感器的误差校准。

本发明是采用如下技术方案实现的:三轴矢量传感器的标定补偿方法,设三轴矢量传感器的实测输出为理论输出为则有三轴矢量传感器实测输出Sm、理论输出Se的关系式:

Sm=KSe+S0        (1-1)

即Se=K-1(Sm-S0)  (1-2)

其中,K为误差系数矩阵,K-1为修正系数矩阵-误差系数矩阵K的逆矩阵,S0=[S0x S0y S0z]T为三轴矢量传感器的零偏;

误差系数矩阵K=K1K2    (1-3)

K1为三轴矢量传感器的灵敏度误差系数矩阵,且

K1=k100010001+δkx000δky000δkz=kx000ky000kz---(1-4)

其中,k为i(i=x,y,z)轴向上传感器的额定灵敏度;δki为i(i=x,y,z)轴向上传感器的灵敏度偏差;Ki为i(i=x,y,z)轴向上传感器的实际灵敏度;

K2为三轴矢量传感器的三测量轴间不正交误差系数矩阵,且

K2=cosα0sinαsinβcosγcosβcosγsinγ001---(1-5)

其中,如图1所示,K2的确定前提:设三轴矢量传感器三测量轴中的z轴、坐标圆心o与正交坐标系的ze轴、坐标圆心o重合,且x轴处于正交坐标系的xeoze平面,则夹角α为三轴矢量传感器三测量轴中x轴与正交坐标系xe轴间的夹角,夹角γ为三轴矢量传感器三测量轴中y轴与正交坐标系xeoye平面间的夹角,夹角β为三轴矢量传感器三测量轴中y轴在正交坐标系xeoye平面的投影与正交坐标系ye轴间的夹角;

则有修正系数矩阵

K-1=K2-1K1-1=secα/kx0-tanα/kz-secαtanβ/kxsecβsecγ/ky(-secβtanγ+secαtanβ)/kz001/kz---(1-6)

将式(1-6)代入式(1-2),即可得到三轴矢量传感器误差修正数学模型:

Se=K-1(Sm-S0)=K2-1K1-1(Sm-S0)=

secα/kx0-tanα/kz-secαtanβ/kxsecβsecγ/ky(-secβtanγ+secαtanβ)/kz001/kzSxm-S0xSym-S0ySzm-S0z---(1-7)

三轴矢量传感器的零偏S0、修正系数矩阵K-1的获取方法如下:

1)、选取某一已知准确测量结果-即理论输出Se的地点作为三轴矢量传感器的测量点,该测量点的理论输出Se表示为Sb,则三轴矢量传感器的理论输出Se满足:(Se)TSe=[K-1(Sm-S0)]T[K-1(Sm-S0)]=||Sb||2

(Sm-S0)T(K-1)TK-1||Sb||2(Sm-S0)=1---(1-8);

2)、在步骤1)所述测量点随机旋转三轴矢量传感器进行实时测量,使其姿态角的跨度覆盖三轴矢量传感器所在三维空间,从而获得一系列的测量值i=x,y,z,j=1,2,…,n;

3)、根据步骤2)获得的测量值进行椭球曲面拟合,获得最佳拟合椭球曲面的二次型函数

F(ξ,Z)=ξTZ=ax2+by2+cz2+2dxy+2exz+2fyz+2px+2qy+2rz+g=0,拟合参数ξ=[a,b,c,d,e,f,p,q,r,g]T

4)、将步骤3)获得的最佳拟合椭球曲面的二次型函数F(ξ,Z)用矩阵记号表示为:(X-X0)TA(X-X0)=1    (1-9),

其中,形状参数矩阵最佳拟合椭球曲面的的中心点坐标为参数矩阵A的逆矩阵;

5)、根据式(1-8)和式(1-9)可得到:

A=(K-1)TK-1||Sb||2---(1-10)

S0=X0=-A-1pqr---(1-11)

根据式(1-6)、式(1-10)可以计算得到式(1-6)中参数kx、ky、kz、α、β、γ的估计值如下:

k^x=a/||Sb||k^y=b/||Sb||k^z=c/||Sb||α^=arcsin(e/ac)β^=arcsin[(dc-ef)/(ac-e2)(bc-f2)]γ^=arcsin(f/bc)---(1-12)

将式(1-12)、式(1-11)的计算结果代入式(1-7),最终得到所测三轴矢量传感器的误差修正数学模型,依据所获得的误差修正数学模型即可对该三轴矢量传感器的测量结果进行标定补偿。

两轴矢量传感器的标定补偿方法,设两轴矢量传感器的实测输出为理论输出为则有两轴矢量传感器实测输出Sm、理论输出Se的关系式:

Sm=KSe+S0        (2-1)

即Se=K-1(Sm-S0)  (2-2)

其中,K为误差系数矩阵,K-1为修正系数矩阵-误差系数矩阵K的逆矩阵,S0=[S0x S0y]T为两轴矢量传感器的零偏;

误差系数矩阵K=K1K2    (2-3)

K1为两轴矢量传感器的灵敏度误差系数矩阵,且

K1=k1001+δkx00δky=kx00ky---(2-4)

其中,k为i(i=x,y)轴向上传感器的额定灵敏度;δki为i(i=x,y)轴向上传感器的灵敏度偏差;ki为i(i=x,y)轴向上传感器的实际灵敏度;

K2为两轴矢量传感器的两测量轴间不正交误差系数矩阵,且

K2=10sinαcosα---(2-5)

其中,如图2所示,K2的确定前提:设两轴矢量传感器两测量轴中的x轴、坐标圆心o与正交坐标系的xe轴、坐标圆心o重合,则夹角α为两轴矢量传感器两测量轴中y轴与正交坐标系ye轴间的夹角;

则有修正系数矩阵

K-1=K2-1K1-1=1/kx0-tanα/kxsecα/ky---(2-6)

将式(2-6)代入式(2-2),即可得到两轴矢量传感器误差修正数学模型:

Se=K-1(Sm-S0)=K2-1K1-1(Sm-S0)=1/kx0-tanα/kxsecα/kySxm-S0xSym-S0y---(2-7)

两轴矢量传感器的零偏S0、修正系数矩阵K-1的获取方法如下:

1)、选取某一已知准确测量结果-即理论输出Se的地点作为两轴矢量传感器的测量点,该测量点的理论输出Se表示为Sb,则两轴矢量传感器的理论输出Se满足:(Se)TSe=[K-1(Sm-S0)]T[K-1(Sm-S0)=||Sb||2

(Sm-S0)T(K-1)TK-1||Sb||2(Sm-S0)=1---(2-8);

2)、在步骤1)所述测量点设置两轴矢量传感器,使两轴矢量传感器的测量平面平行于其所测参数的方向矢量,在两轴矢量传感器的测量平面内随机旋转两轴矢量传感器进行实时测量,使其旋转角的跨度覆盖两轴矢量传感器的测量平面,从而获得一系列的测量值i=x,y,j=1,2,…,n;

3)、根据步骤2)获得的测量值进行椭圆曲线拟合,获得最佳拟合椭圆曲线的二次型函数F(ξ,z)=ξTz=ax2+by2+cxy+dx+ey+f=0,拟合参数ξ=[a,b,c,d,e,f]T

4)、将步骤3)获得的最佳拟合椭圆曲线的二次型函数F(ξ,Z)用矩阵记号表示为:(X-X0)TA(X-X0)=1    (2-9),

其中,形状参数矩阵最佳拟合椭圆曲线的的中心点坐标为参数矩阵A的逆矩阵;

5)、根据式(2-8)和式(2-9)可得到:

A=(K-1)TK-1||Sb||2---(2-10)

S0=X0=-12A-1de---(2-11)

根据式(2-6)、式(2-10)可以计算得到式(2-6)中参数kx、ky、α的估计值如下:

k^x=a/||Sb||k^y=b||Sb||α^=arcsin(c/ab)---(2-12)

将式(2-12)、式(2-11)的计算结果代入式(2-7),最终得到所测两轴矢量传感器的误差修正数学模型,依据所获得的误差修正数学模型即可对该两轴矢量传感器的测量结果进行标定补偿。

与现有技术相比,本发明兼顾引起多轴矢量传感器测量误差的所有因素:构成多轴矢量传感器的各单轴传感器的零偏误差、灵敏度误差、以及各单轴传感器的安装误差进行误差标定、补偿,能有效修正、校准矢量传感器的测量误差,明显提高多轴矢量传感器测量结果的精度;应用当前广泛用于处理实验数据的拟合方法来确定多轴矢量传感器的误差修正参数,使得修正过程简洁方便、实现容易、对硬件设备没有过高要求;适用于多种矢量传感器的校准工作,比如三轴矢量加速度计、三轴矢量磁传感器、以及两轴矢量加速度计和两轴矢量磁传感器。

附图说明

图1为三轴矢量传感器三测量轴与正交坐标系的关系图;

图2为两轴矢量传感器两测量轴与正交坐标系的关系图;

具体实施方式

下面分别以校准三轴矢量加速度计和两轴矢量磁传感器为例来对本发明所述方法作进一步说明:

1、应用本发明所述三轴矢量传感器的标定补偿方法校准三轴矢量加速度计

设三轴矢量加速度计的实测加速度输出为理论加速度输出为则有三轴矢量加速度计实测加速度输出Gm、理论加速度输出Ge的关系式:

Gm=KGe+G0        (1-1)

即Ge=K-1(Gm-G0)  (1-2)

其中,K为误差系数矩阵,K-1为修正系数矩阵-误差系数矩阵K的逆矩阵,G0=[G0x G0y G0z]T为三轴矢量加速度计的零偏;

误差系数矩阵K=K1K2    (1-3)

K1为三轴矢量加速度计的灵敏度误差系数矩阵,且

K1=k100010001+δkx000δky000δkz=kx000ky000kz---(1-4)

其中,k为i(i=x,y,z)轴向上加速度计的额定灵敏度;δki为i(i=x,y,z)轴向上加速度计的灵敏度偏差;ki为i(i=x,y,z)轴向上加速度计的实际灵敏度;

K2为三轴矢量加速度计的三测量轴间不正交误差系数矩阵,且

K2=cosα0sinαsinβcosγcosβcosγsinγ001---(1-5)

其中,如图1所示,K2的确定前提:设三轴矢量加速度计三测量轴中的z轴、坐标圆心o与正交坐标系的ze轴、坐标圆心o重合,且x轴处于正交坐标系的xeoze平面,则夹角α为三轴矢量加速度计三测量轴中x轴与正交坐标系xe轴间的夹角,夹角γ为三轴矢量加速度计三测量轴中y轴与正交坐标系xeoye平面间的夹角,夹角β为三轴矢量加速度计三测量轴中y轴在正交坐标系xeoye平面的投影与正交坐标系ye轴间的夹角;

则有修正系数矩阵

K-1=K2-1K1-1=secα/kx0-tanα/kz-secαtanβ/kxsecβsecγ/ky(-secβtanγ+secαtanβ)/kz001/kz---(1-6)

将式(1-6)代入式(1-2),即可得到三轴矢量加速度计误差修正数学模型:

Ge=K-1(Gm-G0)=K2-1K1-1(Gm-G0)=

secα/kx0-tanα/kz-secαtanβ/kxsecβsecγ/ky(-secβtanγ+secαtanβ)/kz001/kzGxm-G0xGym-G0yGzm-G0z---(1-7)

三轴矢量加速度计的零偏G0、修正系数矩阵K-1的获取方法如下:

1)、选取已知准确重力加速度Gb的地点作为三轴矢量加速度计的测量点,则三轴矢量加速度计的理论加速度输出Ge满足:

(Ge)TGe=[K-1(Gm-G0)]T[K-1(Gm-G0)]=||Gb||2

(Gm-G0)T(K-1)TK-1||Gb||2(Gm-G0)=1---(1-8);

2)、在步骤1)所述测量点随机旋转三轴矢量加速度计进行实时测量,使其姿态角的跨度覆盖三轴矢量加速度计所在三维空间,从而获得一系列的测量值i=x,y,z,j=1,2,…,n;

3)、根据步骤2)获得的测量值进行椭球曲面拟合,获得最佳拟合椭球曲面的二次型函数

F(ξ,Z)=ξTZ=ax2+by2+cz2+2dxy+2exz+2fyz+2px+2qy+2rz+g=0,拟合参数ξ=[a,b,c,d,e,f,p,q,r,g]T

4)、将步骤3)获得的最佳拟合椭球曲面的二次型函数F(ξ,Z)用矩阵记号表示为:(X-X0)TA(X-X0)=1    (1-9),

其中,形状参数矩阵最佳拟合椭球曲面的的中心点坐标为参数矩阵A的逆矩阵;

5)、根据式(1-8)和式(1-9)可得到:

A=(K-1)TK-1||Sb||2---(1-10)

G0=X0=-A-1pqr---(1-11)

根据式(1-6)、式(1-10)可以计算得到式(1-6)中参数kx、ky、kz、α、β、γ的估计值如下:

k^x=a/||Sb||k^y=b/||Sb||k^z=c/||Sb||α^=arcsin(e/ac)β^=arcsin[(dc-ef)/(ac-e2)(bc-f2)]γ^=arcsin(f/bc)---(1-12)

将式(1-12)、式(1-11)的计算结果代入式(1-7),最终得到所测三轴矢量加速度计的误差修正数学模型,依据所获得的误差修正数学模型即可对该三轴矢量加速度计的测量结果进行标定补偿。

2、应用本发明所述两轴矢量传感器的标定补偿方法校准两轴矢量磁传感器,设两轴矢量磁传感器的实测地磁场强度输出为理论地磁场强度输出为则有两轴矢量磁传感器实测地磁场强度输出Hm、理论地磁场强度输出He的关系式:

Hm=KHe+H0        (2-1)

即He=K-1(Hm-H0)  (2-2)

其中,K为误差系数矩阵,K-1为修正系数矩阵-误差系数矩阵K的逆矩阵,H0=[H0x H0y]T为两轴矢量磁传感器的零偏;

误差系数矩阵K=K1K2    (2-3)

K1为两轴矢量磁传感器的灵敏度误差系数矩阵,且

K1=k1001+δkx00δky=kx00ky---(2-4)

其中,k为i(i=x,y)轴向上传感器的额定灵敏度;δki为i(i=x,y)轴向上传感器的灵敏度偏差;ki为i(i=x,y)轴向上传感器的实际灵敏度;

K2为两轴矢量磁传感器的两测量轴间不正交误差系数矩阵,且

K2=10sinαcosα---(2-5)

其中,如图2所示,K2的确定前提:设两轴矢量磁传感器两测量轴中的x轴、坐标圆心o与正交坐标系的xe轴、坐标圆心o重合,则夹角α为两轴矢量磁传感器两测量轴中y轴与正交坐标系ye轴间的夹角;

则有修正系数矩阵

K-1=K2-1K1-1=1/kx0-tanα/kxsecα/ky---(2-6)

将式(2-6)代入式(2-2),即可得到两轴矢量磁传感器误差修正数学模型:

He=K-1(Hm-H0)=K2-1K1-1(Hm-H0)=1/kx0-tanα/kxsecα/kyHxm-H0xHym-H0y---(2-7)

两轴矢量磁传感器的零偏H0、修正系数矩阵K-1的获取方法如下:

1)、在地磁场短期变化较小的时间段内,选取已知准确地磁场强度Hb的地点作为两轴矢量磁传感器的测量点,则两轴矢量磁传感器的理论地磁场强度输出He满足:(He)THe=[K-1(Hm-H0)]T[K-1(Hm-H0)]=||Hb||2

(Hm-H0)T(K-1)TK-1||Hb||2(Hm-H0)=1---(2-8);

2)、在步骤1)所述测量点设置两轴矢量磁传感器,使两轴矢量磁传感器的测量平面平行于测量点处的地磁场方向(考虑到地磁场方向与地表平行,因此,使两轴矢量磁传感器的测量平面平行于测量点处的水平面即可),在两轴矢量磁传感器的测量平面内随机旋转两轴矢量传感器进行实时测量,使其旋转角的跨度覆盖两轴矢量磁传感器的测量平面,从而获得一系列的测量值i=x,y,j=1,2,…,n;

3)、根据步骤2)获得的测量值进行椭圆曲线拟合,获得最佳拟合椭圆曲线的二次型函数

F(ξ,z)=ξTz=ax2+by2+cxy+dx+ey+f=0,拟合参数ξ=[a,b,c,d,e,f]T

4)、将步骤3)获得的最佳拟合椭圆曲线的二次型函数F(ξ,Z)用矩阵记号表示为:(X-X0)TA(X-X0)=1    (2-9),

其中,参数矩阵最佳拟合椭圆曲线的的中心点坐标为参数矩阵A的逆矩阵;

5)、根据式(2-8)和式(2-9)可得到:

A=(K-1)TK-1||Sb||2---(2-10)

H0=X0=-12A-1de---(2-11)

根据式(2-6)、式(2-10)可以计算得到式(2-6)中参数kx、ky、α的估计值如下:

k^x=a/||Sb||k^y=b||Sb||α^=arcsin(c/ab)---(2-12)

将式(2-12)、式(2-11)的计算结果代入式(2-7),最终得到所测两轴矢量磁传感器的误差修正数学模型,依据所获得的误差修正数学模型即可对该两轴矢量磁传感器的测量结果进行标定补偿。

去获取专利,查看全文>

相似文献

  • 专利
  • 中文文献
  • 外文文献
获取专利

客服邮箱:kefu@zhangqiaokeyan.com

京公网安备:11010802029741号 ICP备案号:京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有
  • 客服微信

  • 服务号