首页> 中国专利> 一种利用加速度计组合输出离散度进行精度评估的方法

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

摘要

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

著录项

  • 公开/公告号CN104077472A

    专利类型发明专利

  • 公开/公告日2014-10-01

    原文格式PDF

  • 申请/专利权人 北京航天控制仪器研究所;

    申请/专利号CN201410265272.4

  • 发明设计人 魏宗康;刘璠;

    申请日2014-06-13

  • 分类号G06F19/00;G01C25/00;

  • 代理机构中国航天科技专利中心;

  • 代理人安丽

  • 地址 100854 北京市海淀区142信箱403分箱

  • 入库时间 2023-12-17 01:49:17

法律信息

  • 法律状态公告日

    法律状态信息

    法律状态

  • 2017-06-06

    授权

    授权

  • 2014-10-29

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

    实质审查的生效

  • 2014-10-01

    公开

    公开

说明书

技术领域

本发明涉及一种利用加速度计组合输出离散度进行精度评估的方法,可 用于惯性测量系统精度评定和惯性导航系统落点精度评估中。

背景技术

捷联惯性测量组合的测量误差是捷联导航系统的主要误差源之一,对系 统的导航精度有很大影响,在导航解算前必须对惯组输出的原始数据进行误 差补偿。

误差参数主要包括陀螺仪和加速度计的标度因数、零位偏差、安装误差 角以及标度因数不对称性误差等,这些参数需要在使用前进行标定,到目前 为止已经提出了许多种标定方法。因为多种误差的影响,在运用这些标定方 法后,也无法测出误差系数的精确值,而这也导致了导航误差,但是,因为 标定值是在精确值的一定范围内上下波动,所以通过计算多组标定值的统计 特性就可以估计出导航系统的导航误差。

在实际应用中,对惯性导航的估计具有重要意义,包括落点精度(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轴误差模型为:

Δax=Axp-KaxaxKax=1axayazaxsign(ax)1k0xδkaxkyxkzxδKaxϵxT

其中,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轴误差模型为:

Δay=Ayp-KayayKay=1axayazaysign(ay)1k0ykxyδkaykzyδKayϵyT

其中,Ayp为Y轴加速度计输出脉冲频率;Kay为Y轴加速度计标度因数; k0y为Y轴加速度计零偏;δkay为Y轴加速度计标度因数相对误差;kxy、kzy分 别为X轴和Z轴相对于Y轴的安装误差角;δKay为Y轴加速度计标度因数不对 称相对误差;Δay为Y轴加速度计测量误差;εy为Y轴拟合残差;

加速度计组合Z轴误差模型为:

Δaz=Azp-KazazKaz=1axayazazsign(az)1k0zkxzkyzδkazδKazϵzT

其中,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=(PxTPx)-1 PxTYx

其中,X轴系统矩阵Px

Px=1ax1ay1az1ax1sign(ax1)1ax2ay2az2ax2sign(ax2)···············1axmaymazmaxmsign(axm)

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]=(PyTPy)-1PyYy

其中,Y轴系统矩阵Py

Py=1ax1ay1az1ay1sign(ay1)1ax2ay2az2ay2sign(ay2)···············1axmaymazmaymsign(aym)

加速度计组合在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]=(PzPz)-1PzYz

其中,Z轴系统矩阵Pz

Pz=1ax1ay1az1az1sign(az1)1ax2ay2az2az2sign(az2)···············1axmaymazmazmsign(azm)

加速度计组合在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轴各误差系数的平均值为

k0xδkaxkyxkzxδKaxT=1NΣj=1Nk0xjΣj=1NδkaxjΣj=1NkyxjΣj=1NkzxjΣj=1NδKaxjT

其中,k0xj、δkaxj、kyxj、kzxj、δKaxj分别为第j组测量后计算得到的k0x、δkax、 kyx、kzx、δKax数值;

X轴各误差系数的无偏方差为

σ2(k0x)σ2(δkax)σ2(kyx)σ2(kzx)σ2(δKax)T=1N-1Σj=1N(k0xj-k0x)2Σj=1N(δkaxj-δkax)2Σj=1N(kyxj-kyx)2Σj=1N(kzxj-kzx)2Σj=1N(δKaxj-δKax)2T

X轴第i个位置拟合残差的平均值为

ϵxi=1NΣj=1Nϵxij

其中,εxij为第j组测量中第i个位置的拟合残差;

X轴第i个位置拟合残差的无偏方差为

σ2(ϵxi)=1N-1Σj=1N(ϵxij-ϵxi)2

N组测量后Y轴各误差系数的平均值为

k0ykxyδkaykzyδKayT=1NΣj=1Nk0yjΣj=1NkxyjΣj=1NδkayjΣj=1NkzyjΣj=1NδKayjT

其中,k0yj、kxyj、δkayj、kzyj、δKayj分别为第j组测量后计算得到的k0y、kxy、 δkay、kzy、δKay数值;

Y轴各误差系数的无偏方差为

σ2(k0y)σ2(kxy)σ2(δkay)σ2(kzy)σ2(δKay)T=1N-1Σj=1N(k0yj-k0y)2Σj=1N(kxyj-kxy)2Σj=1N(δkayj-δkay)2Σj=1N(kzyj-kzy)2Σj=1N(δKayj-δKay)2T

Y轴第i个位置拟合残差的平均值为

ϵyi=1NΣj=1Nϵyij

其中,εyij为第j组测量中第i个位置的拟合残差;

Y轴第i个位置拟合残差的无偏方差为

σ2(ϵyi)=1N-1Σj=1N(ϵyij-ϵyi)2

Z轴各误差系数的平均值为

k0zkxzkyzδkazδKazT=1NΣj=1Nk0zjΣj=1NkxzjΣj=1NkyzjΣj=1NδkazjΣj=1NδKazjT

其中,k0zj、kxzj、kyzj、δkazj、δKazj分别为第j组测量后计算得到的k0z、kxz、 kyz、δkaz、δKaz数值;

Z轴各误差系数的无偏方差为

σ2(k0z)σ2(kxz)σ2(kyz)σ2(δkaz)σ2(δKaz)T=1N-1Σj=1N(k0zj-k0z)2Σj=1N(kxzj-kxz)2Σj=1N(kyzj-kyz)2Σj=1N(δkazj-δkaz)2Σj=1N(δKazj-δKaz)2T

Z轴第i个位置拟合残差的平均值为

ϵzi=1NΣj=1Nϵzij

其中,εzij为第j组测量中第i个位置的拟合残差;

Z轴第i个位置拟合残差的无偏方差为

σ2(ϵzi)=1N-1Σj=1N(ϵzij-ϵzi)2

所述步骤(3)中计算步骤(2)中得到的加速度计零偏、标度因数相对误 差、安装误差角和标度因数不对称相对误差和每个位置的拟合残差之间的协方 差矩阵;具体为:

X轴第i个位置的协方差矩阵为

Σxi=σ2(k0x)σ2(δkax,k0x)σ2(kyx,k0x)σ2(kzx,k0x)σ2(δKax,k0x)σ2(ϵxi,k0x)σ2(k0x,δkax)σ2(δkax)σ2(kyx,δkax)σ2(kzx,δkax)σ2(δKax,δkax)σ2(ϵxi,δkax)σ2(k0x,kyx)σ2(δkax,kyx)σ2(kyx)σ2(kzx,kyx)σ2(δKax,kyx)σ2(ϵxi,kyx)σ2(k0x,kzx)σ2(δkax,kzx)σ2(kyx,kzx)σ2(kzx)σ2(δKax,kzx)σ2(ϵxi,kzx)σ2(k0x,δKax)σ2(δkax,δKax)σ2(kyx,δKax)σ2(kzx,δKax)σ2(δKax)σ2(ϵxi,δKax)σ2(k0x,ϵxi)σ2(δkax,ϵxi)σ2(kyx,ϵxi)σ2(kzx,ϵxi)σ2(δKax,ϵxi)σ2(ϵxi)

协方差计算公式为:

σ2(P,Q)=1N-1Σj=1N(Pj-P)(Qj-Q)

其中,P,Q为协方差矩阵涉及到的变量中的任意两个,为变量P和 Q对应的均值,Pj,Qj分别为第j组测量中变量P和Q的估计值;

Y轴第i个位置的协方差矩阵为

Σyi=σ2(k0y)σ2(kxy,k0y)σ2(δkay,k0y)σ2(kzy,k0y)σ2(δKay,k0y)σ2(ϵyi,k0y)σ2(k0y,kxy)σ2(kxy)σ2(δkay,kxy)σ2(kzy,kxy)σ2(δKay,kxy)σ2(ϵyi,kxy)σ2(k0y,δkay)σ2(kxy,δkay)σ2(δkay)σ2(kzy,δkay)σ2(δKay,δkay)σ2(ϵyi,δkay)σ2(k0y,kzy)σ2(kxy,kzy)σ2(δkay,kzy)σ2(kzy)σ2(δKay,kzy)σ2(ϵyi,kzy)σ2(k0y,δKay)σ2(kxy,δKay)σ2(δkay,δKay)σ2(kzy,δKay)σ2(δKay)σ2(ϵyi,δKay)σ2(k0y,ϵyi)σ2(kxy,ϵyi)σ2(δkay,ϵyi)σ2(kzy,ϵyi)σ2(δKay,ϵyi)σ2(ϵyi)

Z轴第i个位置的协方差矩阵为

Σzi=σ2(k0z)σ2(kxz,k0z)σ2(kyz,k0z)σ2(δkaz,k0z)σ2(δKaz,k0z)σ2(ϵzi,k0z)σ2(k0z,kxz)σ2(kxz)σ2(kyz,kxz)σ2(δkaz,kxz)σ2(δKaz,kxz)σ2(ϵzi,kxz)σ2(k0z,kyz)σ2(kxz,kyz)σ2(kyz)σ2(δkaz,kyz)σ2(δKaz,kyz)σ2(ϵzi,kyz)σ2(k0z,δkaz)σ2(kxz,δkaz)σ2(kyz,δkaz)σ2(δkaz)σ2(δKaz,δkaz)σ2(ϵzi,δkaz)σ2(k0z,δKaz)σ2(kxz,δKaz)σ2(kyz,δKaz)σ2(δkaz,δKaz)σ2(δKaz)σ2(ϵzi,δKaz)σ2(k0z,ϵzi)σ2(kxz,ϵzi)σ2(kyz,ϵzi)σ2(δkaz,ϵzi)σ2(δKaz,ϵzi)σ2(ϵzi)

所述步骤(4)中根据步骤(1)各位置中重力加速度在X轴、Y轴和Z轴方 向上的分量和步骤(3)中计算得到的协方差矩阵,计算各位置加速度计组合输 出脉冲个数的无偏方差估计值,具体为:

加速度计X轴加速度计在第i个位置的输出量离散度无偏方差估计值为

σ2(Axi)=Kax2σ2(Δaxi)

其中,σ2(Δaxi)=BxixiBxiT,且Bxi=[1 axi ayi azi axisign(axi) 1];

加速度计Y轴加速度计在第i个位置的输出量离散度无偏方差估计值为

σ2(Ayi)=Kay2σ2(Δayi)

其中,σ2(Δayi)=ByiyiByiT,且Byi=[1 axi ayi azi ayisign(ayi) 1];

加速度计Z轴加速度计在第i个位置的输出量离散度无偏方差估计值为

σ2(Azi)=Kaz2σ2(Δazi)

其中,σ2(Δazi)=BziziBziT,且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轴误差模型为:

Δax=Axp-KaxaxKax=1axayazaxsign(ax)1k0xδkaxkyxkzxδKaxϵxT

其中,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轴误差模型为:

Δay=Ayp-KayayKay=1axayazaysign(ay)1k0ykxyδkaykzyδKayϵyT

其中,Ayp为Y轴加速度计输出脉冲频率;Kay为Y轴加速度计标度因数; k0y为Y轴加速度计零偏;δkay为Y轴加速度计标度因数相对误差;kxy、kzy分 别为X轴和Z轴相对于Y轴的安装误差角;δKay为Y轴加速度计标度因数不对 称相对误差;Δay为Y轴加速度计测量误差;εy为Y轴拟合残差。

加速度计组合Z轴误差模型为:

Δaz=Azp-KazazKaz=1axayazazsign(az)1k0zkxzkyzδkazδKazϵzT

其中,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=(PxTPx)-1PxTYx

其中,X轴系统矩阵Px

Px=1ax1ay1az1ax1sign(ax1)1ax2ay2az2ax2sign(ax2)···············1axmaymazmaxmsign(axm)

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=(PyTPy)-1PyTYy

其中,Y轴系统矩阵Py

Py=1ax1ay1az1ay1sign(ay1)1ax2ay2az2ay2sign(ay2)···············1axmaymazmaymsign(aym)

加速度计组合在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=(PzTPz)-1PzTYz

其中,Z轴系统矩阵Pz

Pz=1ax1ay1az1az1sign(az1)1ax2ay2az2az2sign(az2)···············1axmaymazmazmsign(azm)

加速度计组合在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轴各误差系数的平均值为

k0xδkaxkyxkzxδKaxT=1NΣj=1Nk0xjΣj=1NδkaxjΣj=1NkyxjΣj=1NkzxjΣj=1NδKaxjT

其中,k0xj、δkaxj、kyxj、kzxj、δKaxj分别为第j组测量后计算得到的k0x、δkax、 kyx、kzx、δKax数值。

X轴各误差系数的无偏方差为

σ2(k0x)σ2(δkax)σ2(kyx)σ2(kzx)σ2(δKax)T=1N-1Σj=1N(k0xj-k0x)2Σj=1N(δkaxj-δkax)2Σj=1N(kyxj-kyx)2Σj=1N(kzxj-kzx)2Σj=1N(δKaxj-δKax)2T

X轴第i个位置拟合残差的平均值为

ϵxi=1NΣj=1Nϵxij

其中,εxij为第j组测量中第i个位置的拟合残差。

X轴第i个位置拟合残差的无偏方差为

σ2(ϵxi)=1N-1Σj=1N(ϵxij-ϵxi)2

N组测量后Y轴各误差系数的平均值为

k0ykxyδkaykzyδKayT=1NΣj=1Nk0yjΣj=1NkxyjΣj=1NδkayjΣj=1NkzyjΣj=1NδKayjT

其中,k0yj、kxyj、δkayj、kzyj、δKayj分别为第j组测量后计算得到的k0y、kxy、 δkay、kzy、δKay数值。

Y轴各误差系数的无偏方差为

σ2(k0y)σ2(kxy)σ2(δkay)σ2(kzy)σ2(δKay)T=1N-1Σj=1N(k0yj-k0y)2Σj=1N(kxyj-kxy)2Σj=1N(δkayj-δkay)2Σj=1N(kzyj-kzy)2Σj=1N(δKayj-δKay)2T

Y轴第i个位置拟合残差的平均值为

ϵyi=1NΣj=1Nϵyij

其中,εyij为第j组测量中第i个位置的拟合残差。

Y轴第i个位置拟合残差的无偏方差为

σ2(ϵyi)=1N-1Σj=1N(ϵyij-ϵyi)2

Z轴各误差系数的平均值为

k0zkxzkyzδkazδKazT=1NΣj=1Nk0zjΣj=1NkxzjΣj=1NkyzjΣj=1NδkazjΣj=1NδKazjT

其中,k0zj、kxzj、kyzj、δkazj、δKazj分别为第j组测量后计算得到的k0z、kxz、 kyz、δkaz、δKaz数值。

Z轴各误差系数的无偏方差为

σ2(k0z)σ2(kxz)σ2(kyz)σ2(δkaz)σ2(δKaz)T=1N-1Σj=1N(k0zj-k0z)2Σj=1N(kxzj-kxz)2Σj=1N(kyzj-kyz)2Σj=1N(δkazj-δkaz)2Σj=1N(δKazj-δKaz)2T

Z轴第i个位置拟合残差的平均值为

ϵzi=1NΣj=1Nϵzij

其中,εzij为第j组测量中第i个位置的拟合残差。

Z轴第i个位置拟合残差的无偏方差为

σ2(ϵzi)=1N-1Σj=1N(ϵzij-ϵzi)2

(3)计算步骤(2)中得到的加速度计零偏、标度因数相对误差、安装 误差角和标度因数不对称相对误差和每个位置的拟合残差之间的协方差矩 阵;

X轴第i个位置的协方差矩阵为

Σxi=σ2(k0x)σ2(δkax,k0x)σ2(kyx,k0x)σ2(kzx,k0x)σ2(δKax,k0x)σ2(ϵxi,k0x)σ2(k0x,δkax)σ2(δkax)σ2(kyx,δkax)σ2(kzx,δkax)σ2(δkax,δkax)σ2(ϵxi,δkax)σ2(k0x,kyx)σ2(δkax,kyx)σ2(kyx)σ2(kzx,kyx)σ2(δKax,kyx)σ2(ϵxi,kyx)σ2(k0x,kzx)σ2(δkax,kzx)σ2(kyx,kzx)σ2(kzx)σ2(δKax,kzx)σ2(ϵxi,kzx)σ2(k0x,δKax)σ2(δkax,δKax)σ2(kyx,δKax)σ2(kzx,δKax)σ2(δKax)σ2(ϵxi,δKax)σ2(k0x,ϵxi)σ2(δkax,ϵxi)σ2(kyx,ϵxi)σ2(kzx,ϵxi)σ2(δKax,ϵxi)σ2(ϵxi)

其中,任意两个变量之间的协方差计算式为

σ2(P,Q)=1N-1Σj=1N(Pj-P)(Qj-Q)

其中,P,Q为协方差矩阵涉及到的变量中的任意两个,,为变量P和 Q对应的均值,Pj,Qj分别为第j组测量中变量P和Q的估计值;

Y轴第i个位置的协方差矩阵为

Σyi=σ2(k0y)σ2(kxy,k0y)σ2(δkay,k0y)σ2(kzy,k0y)σ2(δKay,k0y)σ2(ϵyi,k0y)σ2(k0y,kxy)σ2(kxy)σ2(δkay,δkxy)σ2(kzy,kxy)σ2(δkay,kxy)σ2(ϵyi,kxy)σ2(k0y,δkay)σ2(kxy,kay)σ2(δkay)σ2(kzy,δkay)σ2(δKay,δkay)σ2(ϵyi,δkay)σ2(k0y,kzy)σ2(kxy,kzy)σ2(δkay,kzy)σ2(kzy)σ2(δKay,kzy)σ2(ϵyi,kzy)σ2(k0y,δKay)σ2(kxy,δKay)σ2(δkay,δKay)σ2(kzy,δKay)σ2(δKay)σ2(ϵyi,δKay)σ2(k0y,ϵyi)σ2(kxy,ϵyi)σ2(δkay,ϵyi)σ2(kzy,ϵyi)σ2(δKay,ϵyi)σ2(ϵyi)

Z轴第i个位置的协方差矩阵为

Σzi=σ2(k0z)σ2(kxz,k0z)σ2(kyz,k0z)σ2(δkaz,k0z)σ2(δKaz,k0z)σ2(ϵzi,k0z)σ2(k0z,kxz)σ2(kxz)σ2(kyz,kxz)σ2(δkaz,kxz)σ2(δkaz,kxz)σ2(ϵzi,kxz)σ2(k0z,kyz)σ2(kxz,kyz)σ2(kyz)σ2(δkaz,kyz)σ2(δKaz,kyz)σ2(ϵzi,kyz)σ2(k0z,δkaz)σ2(kxz,δkaz)σ2(kyz,δkaz)σ2(δkaz)σ2(δKaz,δkaz)σ2(ϵzi,δkaz)σ2(k0z,δKaz)σ2(kxz,δKaz)σ2(kyz,δKaz)σ2(δkaz,δKaz)σ2(δKaz)σ2(ϵzi,δKaz)σ2(k0z,ϵzi)σ2(kxz,ϵzi)σ2(δkyz,ϵzi)σ2(δkaz,ϵzi)σ2(δKaz,ϵzi)σ2(ϵzi)

(4)根据步骤(1)各位置中重力加速度在加速度计组合三个轴上的分 量和步骤(3)中计算得到的协方差矩阵,计算各位置加速度计组合输出脉 冲个数的无偏方差估计值,即加速度计组合输出离散度。

加速度计X轴加速度计在第i个位置的输出量离散度无偏方差估计值为

σ2(Axi)=Kax2σ2(Δaxi)

其中,σ2(Δaxi)=BxixiBxiT,且Bxi=[1 axi ayi azi axisign(axi) 1]。

加速度计Y轴加速度计在第i个位置的输出量离散度无偏方差估计值为

σ2(Ayi)=Kay2σ2(Δayi)

其中,σ2(Δayi)=ByiyiByiT,且Byi=[1 axi ayi azi ayisign(ayi) 1]。

加速度计Z轴加速度计在第i个位置的输出量离散度无偏方差估计值为

σ2(Azi)=Kaz2σ2(Δazi)

其中,σ2(Δazi)=BziziBziT,且Bi=[1 axi ayi azi azisign(azi) 1]。

(5)利用步骤(4)中计算得到的输出离散度进行待检测系统的精度评 估。具体公式见《中国惯性技术学报》19卷第一期(2011年2月出版) 116~121页的文章《基于蒙特卡罗法的弹道导弹落点密集度验前估计》中描 述了加速度计测量误差和速度偏差以及位置偏差之间的关系;其中落点估计 即计算位置偏差的均值和方差,在计算位置的无偏方差时,需要加速度计测 量误差的无偏方差,即输出离散度。

实施例

为验证发明方法的实用性和正确性,进行了转台测试试验,加速度计组 合的X轴误差模型为

Δax=Ax-Kax-axKax=1axayazaxsign(ax)k0xδkaxkyxkzxδKaxT

表1给出加速度计X轴误差系数6次标定结果。

表1

参数 δkaxk0x(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=(Δax)=σ2(k0x)+ax2σ2(δkax)+ay2σ2(kyx)+az2σ2(kzx)+ax2σ2(δKax)

在某一位置,有ax=0,ay=1,az=0,此时

σ^2=(Δax)=σ2(k0x)+σ2(kyx)=4.5108e-10

另外,加速度计组合的拟合输出平均值为

A^x=Kax(k0x+kyx)=16.757

加速度计组合原始测量输出值进行比较,见表2所示。在已知标度因数 以后,Δax=Axp-KaxaxKax.

表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次测量方差值与计算值进行比较,发现二者有差异, 问题主要在于认为各误差系数相互独立,而且没有考虑拟合残差。

由于拟合残差在各位置的平均值并不相同,考虑拟合残差时,加速度计 组合的误差模型可写为

Δax=Axp-KaxaxKax=1axayazaxsign(ax)1k0xδkaxkyxkzxδKaxϵxT

在该位置的拟合残差ε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)=15(ϵx-ϵx)T(ϵx-ϵx)

在考虑拟合残差以后,加速度计组合的输出平均值为

Ax=Kax(k0x+kyx)+ϵx=16.603

比较上式计算结果与表2的统计结果,二者相等。

由于各项误差系数的均值和方差已计算得到,下面列出各系数之间的相 关性。X轴加速度计误差系数相关性统计信息如表4所示;

表4

ρ k0xδkaxkyxkzxδKaxεxk0x1 0.816053 0.36384 0.24179 0.72293 0.31510 δkax0.816053 1 0.62067 -0.05072 0.97997 0.39718 kyx0.36384 0.62067 1 -0.69092 0.70444 0.47351 kzx0.24179 -0.00572 -0.69092 1 -0.12857 -0.66290 δKax0.72293 0.97997 0.70444 -0.12857 1 0.33576 εx0.31510 0.39718 0.47351 -0.66290 0.33576 1

利用各项系数和拟合残差的方差及其相关系数就可估计出加速度计输 出的方差值

对于X轴加速度计,有

Σx=ρ11σ2(k0x)ρ12σ(k0x)σ(δkax)ρ13σ(k0x)σ(kyx)ρ14σ(k0x)σ(kzx)ρ15σ(k0x)σ(δKax)ρ16σ(k0x)σ(ϵx)ρ21σ(δkax)σ(k0x)ρ22σ2(δkax)ρ23σ(δkax)σ(kyx)ρ24σ(δkax)σ(kax)ρ25σ(δkax)σ(δKax)ρ26σ(δkax)σ(ϵx)ρ31σ(kyx)σ(k0x)ρ32σ(kyx)σ(δkax)ρ33σ2(kyx)ρ34σ(kyx)σ(kzx)ρ35σ(kyx)σ(δKax)ρ36σ(kyx)σ(ϵx)ρ41σ(kzx)σ(k0x)ρ42σ(kzx)σ(δkax)ρ43σ(kzx)σ(kyx)ρ44σ2(kzx)ρ46σ(kzx)σ(δKax)ρ46σ(kzx)σ(ϵx)ρ51σ(δKax)σ(k0x)ρ52σ(δKax)σ(δkax)ρ53σ(δKax)σ(kyx)ρ54σ(δKax)σ(kzx)ρ55σ2(δKax)ρ56σ(δKax)σ(ϵx)ρ61σ(ϵx)σ(k0x)ρ62σ(ϵx)σ(δkax)ρ63σ(ϵx)σ(kyx)ρ64σ(ϵx)σ(kzx)ρ65σ(ϵx)σ(δKax)ρ66σ2(ϵx)

可求得考虑拟合残差后的X轴加速度计输出量方差为

σ2(Ax)=Kax2σ2(Δax)

其中

在该位置,有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, 由此可见本发明中的方法评估值与实验值更为接近,性能更好。

本发明未详细描述内容为本领域技术人员公知技术。

去获取专利,查看全文>

相似文献

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

客服邮箱:kefu@zhangqiaokeyan.com

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

  • 服务号