CN104077472A - 一种利用加速度计组合输出离散度进行精度评估的方法 - Google Patents

一种利用加速度计组合输出离散度进行精度评估的方法 Download PDF

Info

Publication number
CN104077472A
CN104077472A CN201410265272.4A CN201410265272A CN104077472A CN 104077472 A CN104077472 A CN 104077472A CN 201410265272 A CN201410265272 A CN 201410265272A CN 104077472 A CN104077472 A CN 104077472A
Authority
CN
China
Prior art keywords
sigma
delta
axis
epsiv
error
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
Application number
CN201410265272.4A
Other languages
English (en)
Other versions
CN104077472B (zh
Inventor
魏宗康
刘璠
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China Aerospace Times Electronics Corp
Beijing Aerospace Control Instrument Institute
Original Assignee
China Aerospace Times Electronics Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by China Aerospace Times Electronics Corp filed Critical China Aerospace Times Electronics Corp
Priority to CN201410265272.4A priority Critical patent/CN104077472B/zh
Publication of CN104077472A publication Critical patent/CN104077472A/zh
Application granted granted Critical
Publication of CN104077472B publication Critical patent/CN104077472B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Length Measuring Devices With Unspecified Measuring Means (AREA)
  • Navigation (AREA)

Abstract

一种利用加速度计组合输出离散度进行精度评估的方法,在选取惯性组合一次通电的测试位置后进行多组测试,并在建立误差模型后计算各误差系数和拟合残差,并统计出均值和无偏方差,之后,利用这些值计算出误差系数和各位置拟合残差的协方差矩阵。最后,利用协方差矩阵和加速度值可以得到加速度计组合输出离散度。本发明首次提出惯性仪表输出离散度与各项系数离散度的内在关系,从而能够准确评定惯性仪表的输出精度。

Description

一种利用加速度计组合输出离散度进行精度评估的方法
技术领域
本发明涉及一种利用加速度计组合输出离散度进行精度评估的方法,可用于惯性测量系统精度评定和惯性导航系统落点精度评估中。
背景技术
捷联惯性测量组合的测量误差是捷联导航系统的主要误差源之一,对系统的导航精度有很大影响,在导航解算前必须对惯组输出的原始数据进行误差补偿。
误差参数主要包括陀螺仪和加速度计的标度因数、零位偏差、安装误差角以及标度因数不对称性误差等,这些参数需要在使用前进行标定,到目前为止已经提出了许多种标定方法。因为多种误差的影响,在运用这些标定方法后,也无法测出误差系数的精确值,而这也导致了导航误差,但是,因为标定值是在精确值的一定范围内上下波动,所以通过计算多组标定值的统计特性就可以估计出导航系统的导航误差。
在实际应用中,对惯性导航的估计具有重要意义,包括落点精度(CEP)分析。但是,经常发现在地面标定的数据与真实落点精度有所偏差。所以,为了分析输出测量值和误差参数统计特性之间的关系,需要针对惯性仪表开展误差系数和仪表输出离散度一致性的研究。在目前的研究中,认为各误差系数相互独立,即两个系数之间的协方差为零,而且在计算仪表输出离散度时并不考虑拟合残差的影响,这导致了在计算输出离散度时的误差的增大。
发明内容
本发明的技术解决问题:克服现有技术的不足,提供了一种利用加速度计组合输出离散度进行精度评估的方法,通过对加速度计在若干个位置的输出进行多次测量和统计计算,获得了加速度计组合的输出离散度。应用本发明计算输出离散度具有计算快捷、准确度高的优点,可以在惯性测量系统精度评定和落点精度估计中进行应用。
本发明的技术解决方案:提供一种利用加速度计组合输出离散度进行精度评估的方法,步骤如下:
(1)在一次通电过程中,测量加速度计组合在m个位置点经过Δt秒后的输出脉冲个数,所述加速度计组合包括X轴加速度计、Y轴加速度计和Z轴加速度计,X轴、Y轴和Z轴符合右手规则,X轴加速度计、Y轴加速度计和Z轴加速度计在第i个位置点输出的脉冲个数分别为Axi、Ayi和Azi;其中i∈[1,m];所述Δt大于等于10s;
(2)对步骤(1)的每个位置点进行N组测量,分别建立X轴加速度计、Y轴加速度计和Z轴加速度计的误差模型,利用预设的三个加速度计的标度因数计算三个加速度计误差模型中的误差系数和拟合残差,并统计每个误差系数和拟合残差在N组测量中的平均值和无偏方差,所述误差系数包括加速度计零偏、标度因数相对误差、安装误差角和标度因数不对称相对误差;
(3)计算步骤(2)中得到的加速度计零偏、标度因数相对误差、安装误差角和标度因数不对称相对误差与每个位置的拟合残差之间的协方差矩阵;
(4)根据步骤(1)各位置中重力加速度在X轴、Y轴和Z轴方向上的分量和步骤(3)中计算得到的协方差矩阵,计算各位置加速度计组合输出脉冲个数的无偏方差估计值,即加速度计组合输出离散度;
(5)利用步骤(4)中计算得到的输出离散度进行待检测系统的精度评估。
所述步骤(2)中分别建立X轴加速度计、Y轴加速度计和Z轴加速度计的误差模型,具体为:
加速度计组合X轴误差模型为:
Δa x = A xp - K ax a x K ax = 1 a x a y a z a x sign ( a x ) 1 k 0 x δk ax k yx k zx δ K ax ϵ x T
其中,Axp为X轴加速度计输出脉冲频率;Kax为X轴加速度计标度因数;k0x为X轴加速度计零偏;δkax为X轴加速度计标度因数相对误差;kyx、kzx分别为Y轴和Z轴相对于X轴的安装误差角;δKax为X轴加速度计标度因数不对称相对误差;ax、ay、az为加速度计组合X轴、Y轴和Z轴的惯性加速度分量;Δax为X轴加速度计测量误差;εx为X轴拟合残差;
加速度计组合Y轴误差模型为:
Δa y = A yp - K ay a y K ay = 1 a x a y a z a y sign ( a y ) 1 k 0 y k xy δk ay k zy δ K ay ϵ y T
其中,Ayp为Y轴加速度计输出脉冲频率;Kay为Y轴加速度计标度因数;k0y为Y轴加速度计零偏;δkay为Y轴加速度计标度因数相对误差;kxy、kzy分别为X轴和Z轴相对于Y轴的安装误差角;δKay为Y轴加速度计标度因数不对称相对误差;Δay为Y轴加速度计测量误差;εy为Y轴拟合残差;
加速度计组合Z轴误差模型为:
Δa z = A zp - K az a z K az = 1 a x a y a z a z sign ( a z ) 1 k 0 z k xz k yz δ k az δ K az ϵ z T
其中,Azp为Z轴加速度计输出脉冲频率;Kaz为Z轴加速度计标度因数;k0z为Z轴加速度计零偏;δkaz为Z轴加速度计标度因数相对误差;kxz、kyz分别为X轴和Y轴相对于Z轴的安装误差角;δKaz为Z轴加速度计标度因数不对称相对误差;Δaz为Z轴加速度计测量误差;εz为Z轴拟合残差。
所述步骤(2)中利用预先获得的三个加速度计的标度因数计算三个角速度计误差模型中的误差系数和拟合残差,具体为:
每组测量中加速度计组合X轴误差模型中各误差系数数值的计算公式为:
[k0x δkax kyx kzx δKax]T=(Px TPx)-1 Px TYx
其中,X轴系统矩阵Px
P x = 1 a x 1 a y 1 a z 1 a x 1 sign ( a x 1 ) 1 a x 2 a y 2 a z 2 a x 2 sign ( a x 2 ) · · · · · · · · · · · · · · · 1 a xm a ym a zm a xm sign ( a xm )
axi、ayi、azi分别为第i个位置重力加速度在加速度计组合X轴、Y轴、Z轴的分量;加速度计组合在m个位置的X轴测量输出误差Yx
Yx=[Δax1 Δax2 … Δaxm]
Δaxi为在第i个位置的X轴输出误差,
第i个位置的X轴拟合残差为
εxi=Δaxi-[1 axi ayi azi axisign(axi)][k0x δkax kyx kzx δKax]
每组测量中加速度计组合Y轴误差模型中各误差系数数值的计算公式为:
[k0y kxy δkay kzy δKay]=(Py TPy)-1Py Yy
其中,Y轴系统矩阵Py
P y = 1 a x 1 a y 1 a z 1 a y 1 sign ( a y 1 ) 1 a x 2 a y 2 a z 2 a y 2 sign ( a y 2 ) · · · · · · · · · · · · · · · 1 a xm a ym a zm a ym sign ( a ym )
加速度计组合在m个位置的Y轴测量输出误差Yy
Yy=[Δay1 Δay2 … Δaym]
Δayi为在第i个位置的Y轴输出误差,
第i个位置的Y轴拟合残差为
εyi=Δayi-[1 axi ayi azi ayisign(ayi)][k0y kxy δkay kzy δKay]T
每组测量中加速度计组合Z轴误差模型中各误差系数数值的计算公式为:
[k0z kxz kyz δkaz δKaz]=(Pz Pz)-1Pz Yz
其中,Z轴系统矩阵Pz
P z = 1 a x 1 a y 1 a z 1 a z 1 sign ( a z 1 ) 1 a x 2 a y 2 a z 2 a z 2 sign ( a z 2 ) · · · · · · · · · · · · · · · 1 a xm a ym a zm a zm sign ( a zm )
加速度计组合在m个位置的Z轴测量输出误差Yz
Yz=[Δaz1 Δaz2 …Δazm]
Δazi为在第i个位置的Z轴输出误差,
第i个位置的Z轴拟合残差为
εzi=Δazi-[1 axi ayi azi azisign(azi)][k0z kxz kyz δkazδKaz]
所述步骤(2)中统计每个误差系数和拟合残差在N组测量中的平均值和无偏方差,具体为:
N组测量后X轴各误差系数的平均值为
k ‾ 0 x δ k ‾ ax k ‾ yx k ‾ zx δ K ‾ ax T = 1 N Σ j = 1 N k 0 xj Σ j = 1 N δ k axj Σ j = 1 N k yxj Σ j = 1 N k zxj Σ j = 1 N δ K axj T
其中,k0xj、δkaxj、kyxj、kzxj、δKaxj分别为第j组测量后计算得到的k0x、δkax、kyx、kzx、δKax数值;
X轴各误差系数的无偏方差为
σ 2 ( k 0 x ) σ 2 ( δ k ax ) σ 2 ( k yx ) σ 2 ( k zx ) σ 2 ( δ K ax ) T = 1 N - 1 Σ j = 1 N ( k 0 xj - k ‾ 0 x ) 2 Σ j = 1 N ( δ k axj - δ k ‾ ax ) 2 Σ j = 1 N ( k yxj - k ‾ yx ) 2 Σ j = 1 N ( k zxj - k ‾ zx ) 2 Σ j = 1 N ( δ K axj - δ K ‾ ax ) 2 T
X轴第i个位置拟合残差的平均值为
ϵ ‾ xi = 1 N Σ j = 1 N ϵ xij
其中,εxij为第j组测量中第i个位置的拟合残差;
X轴第i个位置拟合残差的无偏方差为
σ 2 ( ϵ xi ) = 1 N - 1 Σ j = 1 N ( ϵ xij - ϵ ‾ xi ) 2
N组测量后Y轴各误差系数的平均值为
k ‾ 0 y k ‾ xy δ k ‾ ay k ‾ zy δ K ‾ ay T = 1 N Σ j = 1 N k 0 yj Σ j = 1 N k xyj Σ j = 1 N δk ayj Σ j = 1 N k zyj Σ j = 1 N δ K ayj T
其中,k0yj、kxyj、δkayj、kzyj、δKayj分别为第j组测量后计算得到的k0y、kxy、δkay、kzy、δKay数值;
Y轴各误差系数的无偏方差为
σ 2 ( k 0 y ) σ 2 ( k xy ) σ 2 ( δ k ay ) σ 2 ( k zy ) σ 2 ( δ K ay ) T = 1 N - 1 Σ j = 1 N ( k 0 yj - k ‾ 0 y ) 2 Σ j = 1 N ( k xyj - k ‾ xy ) 2 Σ j = 1 N ( δ k ayj - δ k ‾ ay ) 2 Σ j = 1 N ( k zyj - k ‾ zy ) 2 Σ j = 1 N ( δ K ayj - δ K ‾ ay ) 2 T
Y轴第i个位置拟合残差的平均值为
ϵ ‾ yi = 1 N Σ j = 1 N ϵ yij
其中,εyij为第j组测量中第i个位置的拟合残差;
Y轴第i个位置拟合残差的无偏方差为
σ 2 ( ϵ yi ) = 1 N - 1 Σ j = 1 N ( ϵ yij - ϵ ‾ yi ) 2
Z轴各误差系数的平均值为
k ‾ 0 z k ‾ xz k ‾ yz δ k ‾ az δ K ‾ az T = 1 N Σ j = 1 N k 0 zj Σ j = 1 N k xzj Σ j = 1 N k yzj Σ j = 1 N δ k azj Σ j = 1 N δ K azj T
其中,k0zj、kxzj、kyzj、δkazj、δKazj分别为第j组测量后计算得到的k0z、kxz、kyz、δkaz、δKaz数值;
Z轴各误差系数的无偏方差为
σ 2 ( k 0 z ) σ 2 ( k xz ) σ 2 ( k yz ) σ 2 ( δ k az ) σ 2 ( δ K az ) T = 1 N - 1 Σ j = 1 N ( k 0 zj - k ‾ 0 z ) 2 Σ j = 1 N ( k xzj - k ‾ xz ) 2 Σ j = 1 N ( k yzj - k ‾ yz ) 2 Σ j = 1 N ( δ k azj - δ k ‾ az ) 2 Σ j = 1 N ( δ K azj - δ K ‾ az ) 2 T
Z轴第i个位置拟合残差的平均值为
ϵ ‾ zi = 1 N Σ j = 1 N ϵ zij
其中,εzij为第j组测量中第i个位置的拟合残差;
Z轴第i个位置拟合残差的无偏方差为
σ 2 ( ϵ zi ) = 1 N - 1 Σ j = 1 N ( ϵ zij - ϵ ‾ zi ) 2
所述步骤(3)中计算步骤(2)中得到的加速度计零偏、标度因数相对误差、安装误差角和标度因数不对称相对误差和每个位置的拟合残差之间的协方差矩阵;具体为:
X轴第i个位置的协方差矩阵为
Σ xi = σ 2 ( k 0 x ) σ 2 ( δ k ax , k 0 x ) σ 2 ( k yx , k 0 x ) σ 2 ( k zx , k 0 x ) σ 2 ( δ K ax , k 0 x ) σ 2 ( ϵ xi , k 0 x ) σ 2 ( k 0 x , δ k ax ) σ 2 ( δ k ax ) σ 2 ( k yx , δ k ax ) σ 2 ( k zx , δ k ax ) σ 2 ( δ K ax , δ k ax ) σ 2 ( ϵ xi , δ k ax ) σ 2 ( k 0 x , k yx ) σ 2 ( δ k ax , k yx ) σ 2 ( k yx ) σ 2 ( k zx , k yx ) σ 2 ( δ K ax , k yx ) σ 2 ( ϵ xi , k yx ) σ 2 ( k 0 x , k zx ) σ 2 ( δ k ax , k zx ) σ 2 ( k yx , k zx ) σ 2 ( k zx ) σ 2 ( δ K ax , k zx ) σ 2 ( ϵ xi , k zx ) σ 2 ( k 0 x , δ K ax ) σ 2 ( δ k ax , δ K ax ) σ 2 ( k yx , δ K ax ) σ 2 ( k zx , δ K ax ) σ 2 ( δ K ax ) σ 2 ( ϵ xi , δ K ax ) σ 2 ( k 0 x , ϵ xi ) σ 2 ( δ k ax , ϵ xi ) σ 2 ( k yx , ϵ xi ) σ 2 ( k zx , ϵ xi ) σ 2 ( δ K ax , ϵ xi ) σ 2 ( ϵ xi )
协方差计算公式为:
σ 2 ( P , Q ) = 1 N - 1 Σ j = 1 N ( P j - P ‾ ) ( Q j - Q ‾ )
其中,P,Q为协方差矩阵涉及到的变量中的任意两个,为变量P和Q对应的均值,Pj,Qj分别为第j组测量中变量P和Q的估计值;
Y轴第i个位置的协方差矩阵为
Σ yi = σ 2 ( k 0 y ) σ 2 ( k xy , k 0 y ) σ 2 ( δk ay , k 0 y ) σ 2 ( k zy , k 0 y ) σ 2 ( δ K ay , k 0 y ) σ 2 ( ϵ yi , k 0 y ) σ 2 ( k 0 y , k xy ) σ 2 ( k xy ) σ 2 ( δk ay , k xy ) σ 2 ( k zy , k xy ) σ 2 ( δ K ay , k xy ) σ 2 ( ϵ yi , k xy ) σ 2 ( k 0 y , δk ay ) σ 2 ( k xy , δk ay ) σ 2 ( δk ay ) σ 2 ( k zy , δk ay ) σ 2 ( δ K ay , δk ay ) σ 2 ( ϵ yi , δk ay ) σ 2 ( k 0 y , k zy ) σ 2 ( k xy , k zy ) σ 2 ( δk ay , k zy ) σ 2 ( k zy ) σ 2 ( δ K ay , k zy ) σ 2 ( ϵ yi , k zy ) σ 2 ( k 0 y , δ K ay ) σ 2 ( k xy , δ K ay ) σ 2 ( δk ay , δ K ay ) σ 2 ( k zy , δ K ay ) σ 2 ( δ K ay ) σ 2 ( ϵ yi , δ K ay ) σ 2 ( k 0 y , ϵ yi ) σ 2 ( k xy , ϵ yi ) σ 2 ( δk ay , ϵ yi ) σ 2 ( k zy , ϵ yi ) σ 2 ( δ K ay , ϵ yi ) σ 2 ( ϵ yi )
Z轴第i个位置的协方差矩阵为
Σ zi = σ 2 ( k 0 z ) σ 2 ( k xz , k 0 z ) σ 2 ( k yz , k 0 z ) σ 2 ( δk az , k 0 z ) σ 2 ( δ K az , k 0 z ) σ 2 ( ϵ zi , k 0 z ) σ 2 ( k 0 z , k xz ) σ 2 ( k xz ) σ 2 ( k yz , k xz ) σ 2 ( δk az , k xz ) σ 2 ( δ K az , k xz ) σ 2 ( ϵ zi , k xz ) σ 2 ( k 0 z , k yz ) σ 2 ( k xz , k yz ) σ 2 ( k yz ) σ 2 ( δk az , k yz ) σ 2 ( δ K az , k yz ) σ 2 ( ϵ zi , k yz ) σ 2 ( k 0 z , δk az ) σ 2 ( k xz , δk az ) σ 2 ( k yz , δk az ) σ 2 ( δk az ) σ 2 ( δ K az , δk az ) σ 2 ( ϵ zi , δk az ) σ 2 ( k 0 z , δ K az ) σ 2 ( k xz , δ K az ) σ 2 ( k yz , δ K az ) σ 2 ( δk az , δ K az ) σ 2 ( δ K az ) σ 2 ( ϵ zi , δ K az ) σ 2 ( k 0 z , ϵ zi ) σ 2 ( k xz , ϵ zi ) σ 2 ( k yz , ϵ zi ) σ 2 ( δk az , ϵ zi ) σ 2 ( δ K az , ϵ zi ) σ 2 ( ϵ zi )
所述步骤(4)中根据步骤(1)各位置中重力加速度在X轴、Y轴和Z轴方向上的分量和步骤(3)中计算得到的协方差矩阵,计算各位置加速度计组合输出脉冲个数的无偏方差估计值,具体为:
加速度计X轴加速度计在第i个位置的输出量离散度无偏方差估计值为
σ2(Axi)=Kax 2σ2(Δaxi)
其中,σ2(Δaxi)=BxixiBxi T,且Bxi=[1 axi ayi azi axisign(axi) 1];
加速度计Y轴加速度计在第i个位置的输出量离散度无偏方差估计值为
σ2(Ayi)=Kay 2σ2(Δayi)
其中,σ2(Δayi)=ByiyiByi T,且Byi=[1 axi ayi azi ayisign(ayi) 1];
加速度计Z轴加速度计在第i个位置的输出量离散度无偏方差估计值为
σ2(Azi)=Kaz 2σ2(Δazi)
其中,σ2(Δazi)=BziziBzi T,且Bi=[1 axi ayi azi azisign(azi) 1]
本发明与现有技术相比的有益效果是:
(1)本发明中首次对惯性仪表各项误差之间的协方差进行了统计分析,并增加了拟合残差与各项误差之间的相关性分析,在考虑这两点后计算出来的加速度计组合输出离散度的精度具有极大提高;
(2)本发明中的计算方法建立了惯性仪表输出离散度无偏估计方差与各项误差系数离散度无偏估计方差之间的精确关系,可以在实际应用中精确评定惯性仪表的精度。
附图说明
图1为本发明流程图。
具体实施方式
一种利用加速度计组合输出离散度进行精度评估的方法,计算步骤如附图1所示,其特征在于步骤如下:
(1)一次通电过程中,测量加速度计组合在m个位置点经过Δt秒后的输出脉冲个数,所述加速度计组合包括X轴加速度计、Y轴加速度计和Z轴加速度计,X轴、Y轴和Z轴符合右手规则,X轴加速度计、Y轴加速度计和Z轴加速度计在第i个位置点输出的脉冲个数分别为Axi、Ayi和Azi;其中i∈[1,m];所述Δt大于等于10s;
(2)对所有的m个位置点进行N组测量,每组测量后,分别建立X轴加速度计、Y轴加速度计和Z轴加速度计误差模型,在预先知道三个方向加速度计的标度因数条件下计算X轴加速度计、Y轴加速度计和Z轴加速度计误差模型中的误差系数和拟合残差,并统计每个误差系数和拟合残差在N组测量中的平均值和无偏方差,所述误差系数包括加速度计零偏、标度因数相对误差、安装误差角和标度因数不对称相对误差;
加速度计组合X轴误差模型为:
Δa x = A xp - K ax a x K ax = 1 a x a y a z a x sign ( a x ) 1 k 0 x δk ax k yx k zx δK ax ϵ x T
其中,Axp为X轴加速度计输出脉冲频率;Kax为X轴加速度计标度因数;k0x为X轴加速度计零偏;δkax为X轴加速度计标度因数相对误差;kyx、kzx分别为Y轴和Z轴相对于X轴的安装误差角;δKax为X轴加速度计标度因数不对称相对误差;ax、ay、az为加速度计组合X、Y、Z轴敏感到的惯性加速度分量;Δax为X轴加速度计测量误差;εx为X轴拟合残差。
加速度计组合Y轴误差模型为:
Δ a y = A yp - K ay a y K ay = 1 a x a y a z a y sign ( a y ) 1 k 0 y k xy δk ay k zy δ K ay ϵ y T
其中,Ayp为Y轴加速度计输出脉冲频率;Kay为Y轴加速度计标度因数;k0y为Y轴加速度计零偏;δkay为Y轴加速度计标度因数相对误差;kxy、kzy分别为X轴和Z轴相对于Y轴的安装误差角;δKay为Y轴加速度计标度因数不对称相对误差;Δay为Y轴加速度计测量误差;εy为Y轴拟合残差。
加速度计组合Z轴误差模型为:
Δa z = A zp - K az a z K az = 1 a x a y a z a z sign ( a z ) 1 k 0 z k xz k yz δk az δK az ϵ z T
其中,Azp为Z轴加速度计输出脉冲频率;Kaz为Z轴加速度计标度因数;k0z为Z轴加速度计零偏;δkaz为Z轴加速度计标度因数相对误差;kxz、kyz分别为X轴和Y轴相对于Z轴的安装误差角;δKaz为Z轴加速度计标度因数不对称相对误差;Δaz为Z轴加速度计测量误差;εz为Z轴拟合残差。
每组测量中加速度计组合X轴误差模型中各误差系数数值的计算公式为:
[k0x δkax kyx kzx δKax]T=(Px TPx)-1Px TYx
其中,X轴系统矩阵Px
P x = 1 a x 1 a y 1 a z 1 a x 1 sign ( a x 1 ) 1 a x 2 a y 2 a z 2 a x 2 sign ( a x 2 ) · · · · · · · · · · · · · · · 1 a xm a ym a zm a xm sign ( a xm )
axi、ayi、azi分别为第i个位置重力加速度在加速度计组合X、Y、Z轴的分量;加速度计组合在m个位置的X轴测量输出误差Yx
Yx=[Δax1 Δax2 … Δaxm]T
Δaxi为在第i个位置的X轴输出误差,
第i个位置的X轴拟合残差为
εxi=Δaxi-[1 axi ayi azi axisign(axi)][k0x δkax kyx kzx δKax]T
每组测量中加速度计组合Y轴误差模型中各误差系数数值的计算公式为:
[k0y kxy δkay kzy δKay]T=(Py TPy)-1Py TYy
其中,Y轴系统矩阵Py
P y = 1 a x 1 a y 1 a z 1 a y 1 sign ( a y 1 ) 1 a x 2 a y 2 a z 2 a y 2 sign ( a y 2 ) · · · · · · · · · · · · · · · 1 a xm a ym a zm a ym sign ( a ym )
加速度计组合在m个位置的Y轴测量输出误差Yy
Yy=[Δay1 Δay2 … Δaym]T
Δayi为在第i个位置的Y轴输出误差,
第i个位置的Y轴拟合残差为
εyi=Δayi-[1 axi ayi azi ayisign(ayi)][k0y kxy δkay kzy δKay]T
每组测量中加速度计组合Z轴误差模型中各误差系数数值的计算公式为:
[k0z kxz kyz δkaz δKaz]T=(Pz TPz)-1Pz TYz
其中,Z轴系统矩阵Pz
P z = 1 a x 1 a y 1 a z 1 a z 1 sign ( a z 1 ) 1 a x 2 a y 2 a z 2 a z 2 sign ( a z 2 ) · · · · · · · · · · · · · · · 1 a xm a ym a zm a zm sign ( a zm )
加速度计组合在m个位置的Z轴测量输出误差Yz
Yz=[Δaz1 Δaz2 … Δaam]T
Δazi为在第i个位置的Z轴输出误差,
第i个位置的Z轴拟合残差为
εzi=Δazi-[1 axi ayi azi azisign(azi)][k0z kxz kyz δkaz δKaz]T
N组测量后X轴各误差系数的平均值为
k ‾ 0 x δ k ‾ ax k ‾ yx k ‾ zx δ K ‾ ax T = 1 N Σ j = 1 N k 0 xj Σ j = 1 N δk axj Σ j = 1 N k yxj Σ j = 1 N k zxj Σ j = 1 N δK axj T
其中,k0xj、δkaxj、kyxj、kzxj、δKaxj分别为第j组测量后计算得到的k0x、δkax、kyx、kzx、δKax数值。
X轴各误差系数的无偏方差为
σ 2 ( k 0 x ) σ 2 ( δk ax ) σ 2 ( k yx ) σ 2 ( k zx ) σ 2 ( δK ax ) T = 1 N - 1 Σ j = 1 N ( k 0 xj - k ‾ 0 x ) 2 Σ j = 1 N ( δk axj - δ k ‾ ax ) 2 Σ j = 1 N ( k yxj - k ‾ yx ) 2 Σ j = 1 N ( k zxj - k ‾ zx ) 2 Σ j = 1 N ( δK axj - δ K ‾ ax ) 2 T
X轴第i个位置拟合残差的平均值为
ϵ ‾ xi = 1 N Σ j = 1 N ϵ xij
其中,εxij为第j组测量中第i个位置的拟合残差。
X轴第i个位置拟合残差的无偏方差为
σ 2 ( ϵ xi ) = 1 N - 1 Σ j = 1 N ( ϵ xij - ϵ ‾ xi ) 2
N组测量后Y轴各误差系数的平均值为
k ‾ 0 y k ‾ xy δ k ‾ ay k ‾ zy δ K ‾ ay T = 1 N Σ j = 1 N k 0 yj Σ j = 1 N k xyj Σ j = 1 N δk ayj Σ j = 1 N k zyj Σ j = 1 N δK ayj T
其中,k0yj、kxyj、δkayj、kzyj、δKayj分别为第j组测量后计算得到的k0y、kxy、δkay、kzy、δKay数值。
Y轴各误差系数的无偏方差为
σ 2 ( k 0 y ) σ 2 ( k xy ) σ 2 ( δk ay ) σ 2 ( k zy ) σ 2 ( δK ay ) T = 1 N - 1 Σ j = 1 N ( k 0 yj - k ‾ 0 y ) 2 Σ j = 1 N ( k xyj - k ‾ xy ) 2 Σ j = 1 N ( δk ayj - δ k ‾ ay ) 2 Σ j = 1 N ( k zyj - k ‾ zy ) 2 Σ j = 1 N ( δK ayj - δ K ‾ ay ) 2 T
Y轴第i个位置拟合残差的平均值为
ϵ ‾ yi = 1 N Σ j = 1 N ϵ yij
其中,εyij为第j组测量中第i个位置的拟合残差。
Y轴第i个位置拟合残差的无偏方差为
σ 2 ( ϵ yi ) = 1 N - 1 Σ j = 1 N ( ϵ yij - ϵ ‾ yi ) 2
Z轴各误差系数的平均值为
k ‾ 0 z k ‾ xz k ‾ yz δ k ‾ az δ K ‾ az T = 1 N Σ j = 1 N k 0 zj Σ j = 1 N k xzj Σ j = 1 N k yzj Σ j = 1 N δk azj Σ j = 1 N δK azj T
其中,k0zj、kxzj、kyzj、δkazj、δKazj分别为第j组测量后计算得到的k0z、kxz、kyz、δkaz、δKaz数值。
Z轴各误差系数的无偏方差为
σ 2 ( k 0 z ) σ 2 ( k xz ) σ 2 ( k yz ) σ 2 ( δ k az ) σ 2 ( δ K az ) T = 1 N - 1 Σ j = 1 N ( k 0 zj - k ‾ 0 z ) 2 Σ j = 1 N ( k xzj - k ‾ xz ) 2 Σ j = 1 N ( k yzj - k ‾ yz ) 2 Σ j = 1 N ( δ k azj - δ k ‾ az ) 2 Σ j = 1 N ( δ K azj - δ K ‾ az ) 2 T
Z轴第i个位置拟合残差的平均值为
ϵ ‾ zi = 1 N Σ j = 1 N ϵ zij
其中,εzij为第j组测量中第i个位置的拟合残差。
Z轴第i个位置拟合残差的无偏方差为
σ 2 ( ϵ zi ) = 1 N - 1 Σ j = 1 N ( ϵ zij - ϵ ‾ zi ) 2
(3)计算步骤(2)中得到的加速度计零偏、标度因数相对误差、安装误差角和标度因数不对称相对误差和每个位置的拟合残差之间的协方差矩阵;
X轴第i个位置的协方差矩阵为
Σ xi = σ 2 ( k 0 x ) σ 2 ( δ k ax , k 0 x ) σ 2 ( k yx , k 0 x ) σ 2 ( k zx , k 0 x ) σ 2 ( δ K ax , k 0 x ) σ 2 ( ϵ xi , k 0 x ) σ 2 ( k 0 x , δk ax ) σ 2 ( δ k ax ) σ 2 ( k yx , δk ax ) σ 2 ( k zx , δk ax ) σ 2 ( δk ax , δk ax ) σ 2 ( ϵ xi , δk ax ) σ 2 ( k 0 x , k yx ) σ 2 ( δ k ax , k yx ) σ 2 ( k yx ) σ 2 ( k zx , k yx ) σ 2 ( δ K ax , k yx ) σ 2 ( ϵ xi , k yx ) σ 2 ( k 0 x , k zx ) σ 2 ( δk ax , k zx ) σ 2 ( k yx , k zx ) σ 2 ( k zx ) σ 2 ( δ K ax , k zx ) σ 2 ( ϵ xi , k zx ) σ 2 ( k 0 x , δK ax ) σ 2 ( δk ax , δK ax ) σ 2 ( k yx , δK ax ) σ 2 ( k zx , δK ax ) σ 2 ( δ K ax ) σ 2 ( ϵ xi , δK ax ) σ 2 ( k 0 x , ϵ xi ) σ 2 ( δk ax , ϵ xi ) σ 2 ( k yx , ϵ xi ) σ 2 ( k zx , ϵ xi ) σ 2 ( δ K ax , ϵ xi ) σ 2 ( ϵ xi )
其中,任意两个变量之间的协方差计算式为
σ 2 ( P , Q ) = 1 N - 1 Σ j = 1 N ( P j - P ‾ ) ( Q j - Q ‾ )
其中,P,Q为协方差矩阵涉及到的变量中的任意两个,为变量P和Q对应的均值,Pj,Qj分别为第j组测量中变量P和Q的估计值;
Y轴第i个位置的协方差矩阵为
Σ yi = σ 2 ( k 0 y ) σ 2 ( k xy , k 0 y ) σ 2 ( δk ay , k 0 y ) σ 2 ( k zy , k 0 y ) σ 2 ( δ K ay , k 0 y ) σ 2 ( ϵ yi , k 0 y ) σ 2 ( k 0 y , k xy ) σ 2 ( k xy ) σ 2 ( δ k ay , δk xy ) σ 2 ( k zy , k xy ) σ 2 ( δk ay , k xy ) σ 2 ( ϵ yi , k xy ) σ 2 ( k 0 y , δk ay ) σ 2 ( k xy , k ay ) σ 2 ( δk ay ) σ 2 ( k zy , δk ay ) σ 2 ( δ K ay , δk ay ) σ 2 ( ϵ yi , δk ay ) σ 2 ( k 0 y , k zy ) σ 2 ( k xy , k zy ) σ 2 ( δk ay , k zy ) σ 2 ( k zy ) σ 2 ( δ K ay , k zy ) σ 2 ( ϵ yi , k zy ) σ 2 ( k 0 y , δK ay ) σ 2 ( k xy , δK ay ) σ 2 ( δk ay , δK ay ) σ 2 ( k zy , δK ay ) σ 2 ( δ K ay ) σ 2 ( ϵ yi , δK ay ) σ 2 ( k 0 y , ϵ yi ) σ 2 ( k xy , ϵ yi ) σ 2 ( δ k ay , ϵ yi ) σ 2 ( k zy , ϵ yi ) σ 2 ( δ K ay , ϵ yi ) σ 2 ( ϵ yi )
Z轴第i个位置的协方差矩阵为
Σ zi = σ 2 ( k 0 z ) σ 2 ( k xz , k 0 z ) σ 2 ( k yz , k 0 z ) σ 2 ( δ k az , k 0 z ) σ 2 ( δ K az , k 0 z ) σ 2 ( ϵ zi , k 0 z ) σ 2 ( k 0 z , k xz ) σ 2 ( k xz ) σ 2 ( k yz , k xz ) σ 2 ( δk az , k xz ) σ 2 ( δk az , k xz ) σ 2 ( ϵ zi , k xz ) σ 2 ( k 0 z , k yz ) σ 2 ( k xz , k yz ) σ 2 ( k yz ) σ 2 ( δk az , k yz ) σ 2 ( δ K az , k yz ) σ 2 ( ϵ zi , k yz ) σ 2 ( k 0 z , δk az ) σ 2 ( k xz , δk az ) σ 2 ( k yz , δk az ) σ 2 ( δ k az ) σ 2 ( δ K az , δk az ) σ 2 ( ϵ zi , δk az ) σ 2 ( k 0 z , δK az ) σ 2 ( k xz , δK az ) σ 2 ( k yz , δK az ) σ 2 ( δk az , δK az ) σ 2 ( δ K az ) σ 2 ( ϵ zi , δK az ) σ 2 ( k 0 z , ϵ zi ) σ 2 ( k xz , ϵ zi ) σ 2 ( δ k yz , ϵ zi ) σ 2 ( δk az , ϵ zi ) σ 2 ( δ K az , ϵ zi ) σ 2 ( ϵ zi )
(4)根据步骤(1)各位置中重力加速度在加速度计组合三个轴上的分量和步骤(3)中计算得到的协方差矩阵,计算各位置加速度计组合输出脉冲个数的无偏方差估计值,即加速度计组合输出离散度。
加速度计X轴加速度计在第i个位置的输出量离散度无偏方差估计值为
σ2(Axi)=Kax 2σ2(Δaxi)
其中,σ2(Δaxi)=BxixiBxi T,且Bxi=[1 axi ayi azi axisign(axi) 1]。
加速度计Y轴加速度计在第i个位置的输出量离散度无偏方差估计值为
σ2(Ayi)=Kay 2σ2(Δayi)
其中,σ2(Δayi)=ByiyiByi T,且Byi=[1 axi ayi azi ayisign(ayi) 1]。
加速度计Z轴加速度计在第i个位置的输出量离散度无偏方差估计值为
σ2(Azi)=Kaz 2σ2(Δazi)
其中,σ2(Δazi)=BziziBzi T,且Bi=[1 axi ayi azi azisign(azi) 1]。
(5)利用步骤(4)中计算得到的输出离散度进行待检测系统的精度评估。具体公式见《中国惯性技术学报》19卷第一期(2011年2月出版)116~121页的文章《基于蒙特卡罗法的弹道导弹落点密集度验前估计》中描述了加速度计测量误差和速度偏差以及位置偏差之间的关系;其中落点估计即计算位置偏差的均值和方差,在计算位置的无偏方差时,需要加速度计测量误差的无偏方差,即输出离散度。
实施例
为验证发明方法的实用性和正确性,进行了转台测试试验,加速度计组合的X轴误差模型为
Δa x = A x - K ax - a x K ax = 1 a x a y a z a x sign ( a x ) k 0 x δk ax k yx k zx δ K ax T
表1给出加速度计X轴误差系数6次标定结果。
表1
参数 δkax k0x(g0) kyx(rad) kzx(rad) δKax
第一组 -3.9630e-5 3.3791E-3 -4.3844E-4 8.2079E-4 6.0597E-4
第二组 3.6790E-5 3.4004E-3 -4.1278E-4 8.2896E-4 6.2536E-4
第三组 -2.2236E-5 3.3694E-3 -4.2883E-4 8.2507E-4 6.1463E-4
第四组 5.5114E-5 3.3899E-3 -4.2082E-4 8.2633E-4 6.3128E-4
第五组 -7.4869E-5 3.3749E-3 -4.5807E-4 8.4602E-4 6.0087E-4
第六组 4.48316E-5 3.3989E-3 -4.4721E-4 8.4806E-4 6.2348E-4
平均值 0 3.3854E-3 -4.3436E-4 8.3254E-4 6.1693E-4
标准差 5.3050E-5 1.2899E-5 1.6873E-5 1.1558E-5 1.1858E-5
按照以往方法,认为误差系数相互独立,则X轴加速度计输出量方差为
σ ^ 2 = ( Δa x ) = σ 2 ( k 0 x ) + a x 2 σ 2 ( δk ax ) + a y 2 σ 2 ( k yx ) + a z 2 σ 2 ( k zx ) + a x 2 σ 2 ( δK ax )
在某一位置,有ax=0,ay=1,az=0,此时
σ ^ 2 = ( Δa x ) = σ 2 ( k 0 x ) + σ 2 ( k yx ) = 4.5108 e - 10
另外,加速度计组合的拟合输出平均值为
A ^ x = K ax ( k ‾ 0 x + k ‾ yx ) = 16.757
加速度计组合原始测量输出值进行比较,见表2所示。在已知标度因数以后, Δ a x = A xp - K ax a x K ax .
表2
Axp Δax
第一组 16.6000 2.9234e-3
第二组 16.8167 2.9616e-3
第三组 16.5167 2.9088e-3
第四组 16.7333 2.9469e-3
第五组 16.3500 2.8794e-3
第六组 16.6000 2.9234e-3
平均值 16.6028 2.9239e-3
方差 2.6824e-2 8.3197e-10
均方差 0.1637 2.8844e-5
表2的加速度计6次测量方差值与计算值进行比较,发现二者有差异,问题主要在于认为各误差系数相互独立,而且没有考虑拟合残差。
由于拟合残差在各位置的平均值并不相同,考虑拟合残差时,加速度计组合的误差模型可写为
Δ a x = A xp - K ax a x K ax = 1 a x a y a z a x sign ( a x ) 1 k 0 x δk ax k yx k zx δ K ax ϵ x T
在该位置的拟合残差εx统计特性如表3所示。
表3
εx
第一组 -1.7204e-5
第二组 -2.5976e-5
第三组 -3.1780e-5
第四组 -2.2113e-5
第五组 -3.7421e-5
第六组 -2.8223e-5
平均值 -2.7119e-5
方差 5.0751e-11
均方差 7.1240e-6
其中,拟合残差的方差计算方法为
σ 2 ( ϵ x ) = 1 5 ( ϵ x - ϵ ‾ x ) T ( ϵ x - ϵ ‾ x )
在考虑拟合残差以后,加速度计组合的输出平均值为
A ‾ x = K ‾ ax ( k ‾ 0 x + k ‾ yx ) + ϵ ‾ x = 16.603
比较上式计算结果与表2的统计结果,二者相等。
由于各项误差系数的均值和方差已计算得到,下面列出各系数之间的相关性。X轴加速度计误差系数相关性统计信息如表4所示;
表4
ρ k0x δkax kyx kzx δKax εx
k0x 1 0.816053 0.36384 0.24179 0.72293 0.31510
δkax 0.816053 1 0.62067 -0.05072 0.97997 0.39718
kyx 0.36384 0.62067 1 -0.69092 0.70444 0.47351
kzx 0.24179 -0.00572 -0.69092 1 -0.12857 -0.66290
δKax 0.72293 0.97997 0.70444 -0.12857 1 0.33576
εx 0.31510 0.39718 0.47351 -0.66290 0.33576 1
利用各项系数和拟合残差的方差及其相关系数就可估计出加速度计输出的方差值
对于X轴加速度计,有
Σ x = ρ 11 σ 2 ( k 0 x ) ρ 12 σ ( k 0 x ) σ ( δ k ax ) ρ 13 σ ( k 0 x ) σ ( k yx ) ρ 14 σ ( k 0 x ) σ ( k zx ) ρ 15 σ ( k 0 x ) σ ( δK ax ) ρ 16 σ ( k 0 x ) σ ( ϵ x ) ρ 21 σ ( δk ax ) σ ( k 0 x ) ρ 22 σ 2 ( δk ax ) ρ 23 σ ( δ k ax ) σ ( k yx ) ρ 24 σ ( δk ax ) σ ( k ax ) ρ 25 σ ( δk ax ) σ ( δK ax ) ρ 26 σ ( δ k ax ) σ ( ϵ x ) ρ 31 σ ( k yx ) σ ( k 0 x ) ρ 32 σ ( k yx ) σ ( δk ax ) ρ 33 σ 2 ( k yx ) ρ 34 σ ( k yx ) σ ( k zx ) ρ 35 σ ( k yx ) σ ( δ K ax ) ρ 36 σ ( k yx ) σ ( ϵ x ) ρ 41 σ ( k zx ) σ ( k 0 x ) ρ 42 σ ( k zx ) σ ( δ k ax ) ρ 43 σ ( k zx ) σ ( k yx ) ρ 44 σ 2 ( k zx ) ρ 46 σ ( k zx ) σ ( δK ax ) ρ 46 σ ( k zx ) σ ( ϵ x ) ρ 51 σ ( δ K ax ) σ ( k 0 x ) ρ 52 σ ( δ K ax ) σ ( δ k ax ) ρ 53 σ ( δ K ax ) σ ( k yx ) ρ 54 σ ( δK ax ) σ ( k zx ) ρ 55 σ 2 ( δ K ax ) ρ 56 σ ( δK ax ) σ ( ϵ x ) ρ 61 σ ( ϵ x ) σ ( k 0 x ) ρ 62 σ ( ϵ x ) σ ( δ k ax ) ρ 63 σ ( ϵ x ) σ ( k yx ) ρ 64 σ ( ϵ x ) σ ( k zx ) ρ 65 σ ( ϵ x ) σ ( δK ax ) ρ 66 σ 2 ( ϵ x )
可求得考虑拟合残差后的X轴加速度计输出量方差为
σ 2 ( A x ) = K ‾ ax 2 σ 2 ( Δ a x )
其中
在该位置,有ax=0,ay=1,az=0,此时
σ2(Δax)=ρ11σ2(k0x)+ρ31σ(kyx)σ(k0x)+axazsign(ax)(ρ5445)σ(δKax)σ(kzx)
+(ρ6116)σ(εx)σ(k0x)+(ρ6336)σ(εx)σ(kyx)
66σ2x)
=8.3197e-10
比较X轴加速度计的方差计算结果与表2中的加速度计输出方差,可以看出二者相等。
在该位置,使用现有技术和本发明方法计算出的输出均值和无偏方差如表5所示。从表中可以看出,使用本发明的计算结果与测量结果严格相等,相对于以往方法在精度上具有极大的提高。
表5
将本发明中计算得到的输出离散度用于精度评估,例如,使用圆概率偏差(CEP)对落点精度进行描述时,某组试验中获得的CEP为100m,使用现有技术估计得到的CEP为73.6m,使用本发明得到的CEP为99.9m,由此可见本发明中的方法评估值与实验值更为接近,性能更好。
本发明未详细描述内容为本领域技术人员公知技术。

Claims (6)

1.一种利用加速度计组合输出离散度进行精度评估的方法,其特征在于步骤如下:
(1)在一次通电过程中,测量加速度计组合在m个位置点经过Δt秒后的输出脉冲个数,所述加速度计组合包括X轴加速度计、Y轴加速度计和Z轴加速度计,X轴、Y轴和Z轴符合右手规则,X轴加速度计、Y轴加速度计和Z轴加速度计在第i个位置点输出的脉冲个数分别为Axi、Ayi和Azi;其中i∈[1,m];所述Δt大于等于10s;
(2)对步骤(1)的每个位置点进行N组测量,分别建立X轴加速度计、Y轴加速度计和Z轴加速度计的误差模型,利用预设的三个加速度计的标度因数计算三个加速度计误差模型中的误差系数和拟合残差,并统计每个误差系数和拟合残差在N组测量中的平均值和无偏方差,所述误差系数包括加速度计零偏、标度因数相对误差、安装误差角和标度因数不对称相对误差;
(3)计算步骤(2)中得到的加速度计零偏、标度因数相对误差、安装误差角和标度因数不对称相对误差与每个位置的拟合残差之间的协方差矩阵;
(4)根据步骤(1)各位置中重力加速度在X轴、Y轴和Z轴方向上的分量和步骤(3)中计算得到的协方差矩阵,计算各位置加速度计组合输出脉冲个数的无偏方差估计值,即加速度计组合输出离散度;
(5)利用步骤(4)中计算得到的输出离散度进行待检测系统的精度评估。
2.根据权利要求1所述的一种利用加速度计组合输出离散度进行精度评估的方法,其特征在于:所述步骤(2)中分别建立X轴加速度计、Y轴加速度计和Z轴加速度计的误差模型,具体为:
加速度计组合X轴误差模型为:
Δa x = A xp - K ax a x K ax = 1 a x a y a z a x sign ( a x ) 1 k 0 x δk ax k yx k zx δK ax ϵ x T
其中,Axp为X轴加速度计输出脉冲频率;Kax为X轴加速度计标度因数;k0x为X轴加速度计零偏;δkax为X轴加速度计标度因数相对误差;kyx、kzx分别为Y轴和Z轴相对于X轴的安装误差角;δKax为X轴加速度计标度因数不对称相对误差;ax、ay、az为加速度计组合X轴、Y轴和Z轴的惯性加速度分量;Δax为X轴加速度计测量误差;εx为X轴拟合残差;
加速度计组合Y轴误差模型为:
Δa y = A yp - K ay a y K ay = 1 a x a y a z a y sign ( a y ) 1 k 0 y k xy δ k ay k zy δK ay ϵ y T
其中,Ayp为Y轴加速度计输出脉冲频率;Kay为Y轴加速度计标度因数;k0y为Y轴加速度计零偏;δkay为Y轴加速度计标度因数相对误差;kxy、kzy分别为X轴和Z轴相对于Y轴的安装误差角;δKay为Y轴加速度计标度因数不对称相对误差;Δay为Y轴加速度计测量误差;εy为Y轴拟合残差;
加速度计组合Z轴误差模型为:
Δa z = A zp - K az a z K az = 1 a x a y a z a z sign ( a z ) 1 k 0 z k xz k yz δk az δK az ϵ z T
其中,Azp为Z轴加速度计输出脉冲频率;Kaz为Z轴加速度计标度因数;k0z为Z轴加速度计零偏;δkaz为Z轴加速度计标度因数相对误差;kxz、kyz分别为X轴和Y轴相对于Z轴的安装误差角;δKaz为Z轴加速度计标度因数不对称相对误差;Δaz为Z轴加速度计测量误差;εz为Z轴拟合残差。
3.根据权利要求1所述的一种利用加速度计组合输出离散度进行精度评估的方法,其特征在于:所述步骤(2)中利用预先获得的三个加速度计的标度因数计算三个角速度计误差模型中的误差系数和拟合残差,具体为:
每组测量中加速度计组合X轴误差模型中各误差系数数值的计算公式为:
[k0x δkax kyx kzx δKax]T=(Px TPx)-1Px TYx
其中,X轴系统矩阵Px
P x = 1 a x 1 a y 1 a z 1 a x 1 sign ( a x 1 ) 1 a x 2 a y 2 a z 2 a x 2 sign ( a x 2 ) . . . . . . . . . . . . . . . 1 a xm a ym a zm a xm sign ( a xm )
axi、ayi、azi分别为第i个位置重力加速度在加速度计组合X轴、Y轴、Z轴的分量;加速度计组合在m个位置的X轴测量输出误差Yx
Yx=[Δax1 Δax2…Δaxm]T
Δaxi为在第i个位置的X轴输出误差,
第i个位置的X轴拟合残差为
εxi=Δaxi-[1 axi ayi azi axisign(axi)][k0x δkax kyx kzx δKax]T
每组测量中加速度计组合Y轴误差模型中各误差系数数值的计算公式为:
[k0y kxy δkay kzy δKay]T=(Py TPy)-1Py TYy
其中,Y轴系统矩阵Py
P y = 1 a x 1 a y 1 a z 1 a y 1 sign ( a y 1 ) 1 a x 2 a y 2 a z 2 a y 2 sign ( a y 2 ) . . . . . . . . . . . . . . . 1 a xm a ym a zm a ym sign ( a ym )
加速度计组合在m个位置的Y轴测量输出误差Yy
Yy=[Δay1 Δay2…Δaym]T
Δayi为在第i个位置的Y轴输出误差,
第i个位置的Y轴拟合残差为
εyi=Δayi-[1 axi ayi azi ayisign(ayi)][k0y kxy δkay kzy δKay]T
每组测量中加速度计组合Z轴误差模型中各误差系数数值的计算公式为:
[k0z kxz kyz δkaz δKaz]T=(Pz T Pz)-1Pz TYz
其中,Z轴系统矩阵Pz
P z = 1 a x 1 a y 1 a z 1 a z 1 sign ( a z 1 ) 1 a x 2 a y 2 a z 2 a z 2 sign ( a z 2 ) · · · · · · · · · · · · · · · 1 a xm a ym a zm a zm sign ( a zm )
加速度计组合在m个位置的Z轴测量输出误差Yz
Yz=[Δaz1 Δaz2 … Δaam]T
Δazi为在第i个位置的Z轴输出误差,
第i个位置的Z轴拟合残差为
εzi=Δazi-[1 axi ayi azi azisign(azi)][k0z kxz kyz δkaz δKaz]T
4.根据权利要求1所述的一种利用加速度计组合输出离散度进行精度评估的方法,其特征在于:所述步骤(2)中统计每个误差系数和拟合残差在N组测量中的平均值和无偏方差,具体为:
N组测量后X轴各误差系数的平均值为
k ‾ 0 x δ k ‾ ax k ‾ yx k ‾ zx δ K ‾ ax T = 1 N Σ j = 1 N k 0 xj Σ j = 1 N δk axj Σ j = 1 N k yxj Σ j = 1 N k zxj Σ j = 1 N δK axj T
其中,k0xj、δkaxj、kyxj、kzxj、δKaxj分别为第j组测量后计算得到的k0x、δkax、kyx、kzx、δKax数值;
X轴各误差系数的无偏方差为
σ 2 ( k 0 x ) σ 2 ( δk ax ) σ 2 ( k yx ) σ 2 ( k zx ) σ 2 ( δK ax ) T = 1 N - 1 Σ j = 1 N ( k 0 xj - k ‾ 0 x ) 2 Σ j = 1 N ( δk axj - δ k ‾ ax ) 2 Σ j = 1 N ( k yxj - k ‾ yx ) 2 Σ j = 1 N ( k zxj - k ‾ zx ) 2 Σ j = 1 N ( δK axj - δ K ‾ ax ) 2 T
X轴第i个位置拟合残差的平均值为
ϵ ‾ xi = 1 N Σ j = 1 N ϵ xij
其中,εxij为第j组测量中第i个位置的拟合残差;
X轴第i个位置拟合残差的无偏方差为
σ 2 ( ϵ xi ) = 1 N - 1 Σ j = 1 N ( ϵ xij - ϵ ‾ xi ) 2
N组测量后Y轴各误差系数的平均值为
k ‾ 0 y k ‾ xy δ k ‾ ay k ‾ zy δ K ‾ ay T = 1 N Σ j = 1 N k 0 yj Σ j = 1 N k xyj Σ j = 1 N δ k ayj Σ j = 1 N k zyj Σ j = 1 N δK ayj T
其中,k0yj、kxyj、δkayj、kzyj、δKayj分别为第j组测量后计算得到的k0y、kxy、δkay、kzy、δKay数值;
Y轴各误差系数的无偏方差为
σ 2 ( k 0 y ) σ 2 ( k xy ) σ 2 ( δk ay ) σ 2 ( k zy ) σ 2 ( δK ay ) T = 1 N - 1 Σ j = 1 N ( k 0 yj - k ‾ 0 y ) 2 Σ j = 1 N ( k xyj - k ‾ xy ) 2 Σ j = 1 N ( δk ayj - δ k ‾ ay ) 2 Σ j = 1 N ( k zyj - k ‾ zy ) 2 Σ j = 1 N ( δK ayj - δ K ‾ ay ) 2 T
Y轴第i个位置拟合残差的平均值为
ϵ ‾ yi = 1 N Σ j = 1 N ϵ yij
其中,εyij为第j组测量中第i个位置的拟合残差;
Y轴第i个位置拟合残差的无偏方差为
σ 2 ( ϵ yi ) = 1 N - 1 Σ j = 1 N ( ϵ yij - ϵ ‾ yi ) 2
Z轴各误差系数的平均值为
k ‾ 0 z k ‾ xz k ‾ yz δ k ‾ az δ K ‾ az T = 1 N Σ j = 1 N k 0 zj Σ j = 1 N δk xzj Σ j = 1 N k yzj Σ j = 1 N k azj Σ j = 1 N δK azj T
其中,k0zj、kxzj、kyzj、δkazj、δKazj分别为第j组测量后计算得到的k0z、kxz、kyz、δkaz、δKaz数值;
Z轴各误差系数的无偏方差为
σ 2 ( k 0 z ) σ 2 ( k xz ) σ 2 ( k yz ) σ 2 ( δk az ) σ 2 ( δK az ) T = 1 N - 1 Σ j = 1 N ( k 0 zj - k ‾ 0 z ) 2 Σ j = 1 N ( k xzj - k ‾ xz ) 2 Σ j = 1 N ( k yzj - k ‾ yz ) 2 Σ j = 1 N ( δk azj - δ k ‾ az ) 2 Σ j = 1 N ( δK azj - δ K ‾ az ) 2 T
Z轴第i个位置拟合残差的平均值为
ϵ ‾ zi = 1 N Σ j = 1 N ϵ zij
其中,εzij为第j组测量中第i个位置的拟合残差;
Z轴第i个位置拟合残差的无偏方差为
σ 2 ( ϵ zi ) = 1 N - 1 Σ j = 1 N ( ϵ zij - ϵ ‾ zi ) 2
5.根据权利要求1所述的一种利用加速度计组合输出离散度进行精度评估的方法,其特征在于:所述步骤(3)中计算步骤(2)中得到的加速度计零偏、标度因数相对误差、安装误差角和标度因数不对称相对误差和每个位置的拟合残差之间的协方差矩阵;具体为:
X轴第i个位置的协方差矩阵为
Σ xi = σ 2 ( k 0 x ) σ 2 ( δk ax , k 0 x ) σ 2 ( k yx , k 0 x ) σ 2 ( k zx , k 0 x ) σ 2 ( δ K ax , k 0 x ) σ 2 ( ϵ xi , k 0 x ) σ 2 ( k 0 x , δk ax ) σ 2 ( δk ax ) σ 2 ( k yx , δk ax ) σ 2 ( k zx , δk ax ) σ 2 ( δK ax , δk ax ) σ 2 ( ϵ xi δk ax ) σ 2 ( k 0 x , k yx ) σ 2 ( δk ax , k yx ) σ 2 ( k yx ) σ 2 ( k zx , k yx ) σ 2 ( δK ax , k yx ) σ 2 ( ϵ xi , k yx ) σ 2 ( k 0 x , k zx ) σ 2 ( δk ax , k zx ) σ 2 ( k yx , k zx ) σ 2 ( k zx ) σ 2 ( δK ax , k zx ) σ 2 ( ϵ xi , k zx ) σ 2 ( k 0 x , δ K ax ) σ 2 ( δk ax , δK ax ) σ 2 ( k yx , δK ax ) σ 2 ( k zx , δK ax ) σ 2 ( δK ax ) σ 2 ( ϵ xi , δK ax ) σ 2 ( k 0 x , ϵ xi ) σ 2 ( δk ax , ϵ xi ) σ 2 ( k yx , ϵ xi ) σ 2 ( k zx , ϵ xi ) σ 2 ( δK ax , ϵ xi ) σ 2 ( ϵ xi )
协方差计算公式为:
σ 2 ( P , Q ) = 1 N - 1 Σ j = 1 N ( P j - P ‾ ) ( Q j - Q ‾ )
其中,P,Q为协方差矩阵涉及到的变量中的任意两个,为变量P和Q对应的均值,Pj,Qj分别为第j组测量中变量P和Q的估计值;
Y轴第i个位置的协方差矩阵为
Σ yi = σ 2 ( k 0 y ) σ 2 ( k xy , k 0 y ) σ 2 ( δk ay , k 0 y ) σ 2 ( k zy , k 0 y ) σ 2 ( δK ay , k 0 y ) σ 2 ( ϵ yi , k 0 y ) σ 2 ( k 0 y , k xy ) σ 2 ( k xy ) σ 2 ( δk ay , k xy ) σ 2 ( k zy , k xy ) σ 2 ( δK ay , k xy ) σ 2 ( ϵ yi , k xy ) σ 2 ( k 0 y , k ay ) σ 2 ( k xy , δk ay ) σ 2 ( δk ay ) σ 2 ( k zy , δk ay ) σ 2 ( δK ay , δk ay ) σ 2 ( ϵ yi , δk ay ) σ 2 ( k 0 y , δk zy ) σ 2 ( k xy , k zy ) σ 2 ( δk ay , k zy ) σ 2 ( k zy ) σ 2 ( δK ay , k zy ) σ 2 ( ϵ yi , k zy ) σ 2 ( k 0 y , δK ay ) σ 2 ( k xy , δK ay ) σ 2 ( δk ay , δK zy ) σ 2 ( k zy , δK ay ) σ 2 ( δK ay ) σ 2 ( ϵ yi , δK ay ) σ 2 ( k 0 y , ϵ yi ) σ 2 ( k xy , ϵ yi ) σ 2 ( δk ay , ϵ yi ) σ 2 ( k zy , ϵ yi ) σ 2 ( δK ay , ϵ yi ) σ 2 ( ϵ yi )
Z轴第i个位置的协方差矩阵为
Σ zi = σ 2 ( k 0 z ) σ 2 ( k xz , k 0 z ) σ 2 ( δk yz , k 0 z ) σ 2 ( δ k az , k 0 z ) σ 2 ( δK az , k 0 z ) σ 2 ( ϵ zi , k 0 z ) σ 2 ( k 0 z , k xz ) σ 2 ( k xz ) σ 2 ( k yz , k xz ) σ 2 ( δk az , k xz ) σ 2 ( δK az , k xz ) σ 2 ( ϵ zi , k xz ) σ 2 ( k 0 z , k yz ) σ 2 ( k xz , k yz ) σ 2 ( k yz ) σ 2 ( δ k az , k yz ) σ 2 ( δK az , k yz ) σ 2 ( ϵ zi , k yz ) σ 2 ( k 0 z , δk az ) σ 2 ( k xz , δk az ) σ 2 ( k yz , δk az ) σ 2 ( δ k az ) σ 2 ( δK az , δk az ) σ 2 ( ϵ zi , δk az ) σ 2 ( k 0 z , δK az ) σ 2 ( k xz , δK az ) σ 2 ( k yz , δK az ) σ 2 ( δk az , δK az ) σ 2 ( δK az ) σ 2 ( ϵ zi , δK az ) σ 2 ( k 0 z , ϵ zi ) σ 2 ( k xz , ϵ zi ) σ 2 ( k yz , ϵ zi ) σ 2 ( δk az , ϵ zi ) σ 2 ( δK az , ϵ zi ) σ 2 ( ϵ zi )
6.根据权利要求1所述的一种利用加速度计组合输出离散度进行精度评估的方法,其特征在于:所述步骤(4)中根据步骤(1)各位置中重力加速度在X轴、Y轴和Z轴方向上的分量和步骤(3)中计算得到的协方差矩阵,计算各位置加速度计组合输出脉冲个数的无偏方差估计值,具体为:
加速度计X轴加速度计在第i个位置的输出量离散度无偏方差估计值为
σ2(Axi)=Kax 2σ2(Δaxi)
其中,σ2(Δaxi)=BxixiBxi T,且Bxi=[1  axi  ayi  azi  axisign(axi)  1];
加速度计Y轴加速度计在第i个位置的输出量离散度无偏方差估计值为
σ2(Ayi)=Kay 2σ2(Δayi)
其中,σ2(Δayi)=ByiyiByi T,且Byi=[1  axi  ayi  azi  ayisign(ayi)  1];
加速度计Z轴加速度计在第i个位置的输出量离散度无偏方差估计值为
σ2(Azi)=Kaz 2σ2(Δazi)
其中,σ2(Δazi)=BziziBzi T,且Bi=[1  axi  ayi  azi  azisign(azi)  1]。
CN201410265272.4A 2014-06-13 2014-06-13 一种利用加速度计组合输出离散度进行精度评估的方法 Active CN104077472B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410265272.4A CN104077472B (zh) 2014-06-13 2014-06-13 一种利用加速度计组合输出离散度进行精度评估的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410265272.4A CN104077472B (zh) 2014-06-13 2014-06-13 一种利用加速度计组合输出离散度进行精度评估的方法

Publications (2)

Publication Number Publication Date
CN104077472A true CN104077472A (zh) 2014-10-01
CN104077472B CN104077472B (zh) 2017-06-06

Family

ID=51598724

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410265272.4A Active CN104077472B (zh) 2014-06-13 2014-06-13 一种利用加速度计组合输出离散度进行精度评估的方法

Country Status (1)

Country Link
CN (1) CN104077472B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109839124A (zh) * 2017-11-24 2019-06-04 北京自动化控制设备研究所 一种mems陀螺仪标度因数温度补偿方法

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN100585602C (zh) * 2007-01-17 2010-01-27 南京航空航天大学 惯性测量系统误差模型验证试验方法
CN102159920A (zh) * 2008-09-23 2011-08-17 皇家飞利浦电子股份有限公司 用于处理来自加速度计的测量结果的方法
CN102494699B (zh) * 2011-12-14 2014-08-13 中国人民解放军国防科学技术大学 捷联式航空重力仪测量参数置信度评估方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
程国旗: "惯性制导系统误差补偿评估模型研究", 《电光与控制》 *
谢波: "激光陀螺捷联惯导系统多位置标定方法", 《中国惯性技术学报》 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109839124A (zh) * 2017-11-24 2019-06-04 北京自动化控制设备研究所 一种mems陀螺仪标度因数温度补偿方法

Also Published As

Publication number Publication date
CN104077472B (zh) 2017-06-06

Similar Documents

Publication Publication Date Title
CN103246821B (zh) 一种基于仿真的多应力小样本加速寿命试验方案设计优化方法
CN102607636A (zh) 一种动态测量系统的比对式校准方法
CN102841385A (zh) 一种基于多重分形克里金法的局部地磁图构建方法
CN102778240B (zh) 一种基于物理模型的陀螺贮存寿命加速试验方案确定方法
CN101788305A (zh) 一种微惯性测量组合现场快速标定方法
CN103218482B (zh) 一种动力学系统中不确定参数的估计方法
CN104316079B (zh) 一种基于火箭橇试验的惯性测量系统落点精度估计方法
CN104913743A (zh) 基于惯性测量的电力铁塔变形监测方法
Zhao et al. A time‐controllable Allan variance method for MEMS IMU
CN103020456A (zh) 一种飞行器气动参数辨识误差区间估算方法
Zhao et al. Comparison of initial alignment methods for SINS
CN111679307B (zh) 一种卫星定位信号解算方法及装置
CN103106332A (zh) 一种测量不确定度的分析方法
CN104077472A (zh) 一种利用加速度计组合输出离散度进行精度评估的方法
CN103868527A (zh) 一种标定捷联惯性组合加速度计组合的方法
CN104297525A (zh) 基于火箭橇试验的惯性测量系统加速度计标定方法
CN103616024A (zh) 一种行星探测进入段自主导航系统可观测度确定方法
CN104567921B (zh) 一种天文测速自主导航系统地面试验方法
CN107044860A (zh) 一种惯性传感器的测量标定方法
CN101685102A (zh) 三轴加速度计的精度调整装置与调整方法
CN102679983A (zh) 一种余度惯性测量单元测量噪声估计和数据融合方法
CN104296779A (zh) 基于火箭橇试验的惯性测量系统加速度计迭代补偿方法
CN102679984A (zh) 基于极小化矢量距离准则的有限模型滤波方法
CN103940444A (zh) 一种mimu组网式系统级标定方法
CN104964666B (zh) 一种基于虚拟加速度的gnss变形监测方法及系统

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant