[发明专利]一种对双观测系统量测噪声方差阵的自适应同步估计方法有效
申请号: | 201210213914.7 | 申请日: | 2012-06-25 |
公开(公告)号: | CN102749096A | 公开(公告)日: | 2012-10-24 |
发明(设计)人: | 张海;周启帆;王嫣然 | 申请(专利权)人: | 北京航空航天大学 |
主分类号: | G01D18/00 | 分类号: | G01D18/00 |
代理公司: | 北京永创新实专利事务所 11121 | 代理人: | 官汉增 |
地址: | 100191*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 观测 系统 噪声 方差 自适应 同步 估计 方法 | ||
1.一种对双观测系统量测噪声方差阵的自适应同步估计方法,其特征在于:包括以下几个步骤:
步骤一:分别得到观测系统A、观测系统B在各时刻的数据信号Z1(i)、Z2(i),其中i为观测系统的数据信号测量时刻;
步骤二:分别计算观测系统A数据信号Z1(i)的自差分序列和观测系统B数据信号Z2(i)的自差分序列,并计算两个自差分序列的互差分序列,具体为:
(1)观测系统A数据信号Z1(i)的自差分序列ΔZ1(i)为:
ΔZ1(i)=Z1(i)-Z1(i-1)
其中i-1和i分别表示观测系统A的数据采集时刻;
(2)观测系统B数据信号Z2(i)的自差分序列ΔZ2(i)为:
ΔZ2(i)=Z2(i)-Z2(i-1)
其中i-1和i分别表示观测系统B的数据采集时刻;
(3)观测系统A和观测系统B的两个自差分序列的互差分序列C(i)为:
C(i)=ΔZ1(i)-ΔZ2(i)
步骤三:分别计算观测系统A数据信号在不同窗口长度下自差分序列的方差,观测系统B数据信号在不同窗口长度下自差分序列的方差,以及两个观测系统在不同窗口长度下互差分序列的方差,并利用方差进行相关计算得到观测系统A、观测系统B不同窗口长度下的量测噪声方差阵R1、R2,具体为:
(1)首先选取最大窗口长度MMax、最小窗口长度MMin和窗口长度间隔MDis,且窗口长度间隔MDis为MMax与MMin之差的整数倍,若当前数据信号量测时刻k小于等于MMax,则直接采用窗口长度累积的方式计算观测系统A自差分序列的方差:
其中E1(k)表示观测系统A的1到k时刻观测值序列的均值,σ1(k)表示观测系统A的1到k时刻观测值序列的方差;
若当前数据信号量测时刻k大于MMax,则计算观测系统A数据信号在不同窗口长度下自差分序列的方差:
其中,k为观测系统A当前数据信号量测时刻,i为数据信号量测时刻,ΔZ1(i)为观测系统A自差分序列在i时刻的值,E1(M,k)为k时刻窗口长度为M时观测系统A自差分序列的均值,σ1(M,k)为k时刻窗口长度为M时自差分序列的方差,M为窗口长度序列;
(2)若当前数据量测时刻k小于等于MMax,则直接采用窗口长度累积的方式计算观测系统B自差分序列的方差:
其中E2(k)表示观测系统B的1到k时刻观测值序列的均值,σ2(k)表示观测系统B的1到k时刻观测值序列的均值;
若当前数据量测时刻k大于MMax,则计算观测系统B数据信号在不同窗口长度下的自差分序列的方差:
其中,k为观测系统B当前数据信号量测时刻,i为数据信号量测时刻,ΔZ2(i)为观测系统B自差分序列在i时刻的值,E2(M,k)为k时刻窗口长度为M时观测系统B自差分序列的均值,σ2(M,k)为k时刻窗口长度为M时的自差分序列方差,M为窗口长度序列;
(3)若当前数据量测时刻k小于等于MMax,计算两个观测系统互差分序列的方差σC(k):
其中,C(i)表示观测系统A和观测系统B自差分序列在i时刻的互差分序列;EC(k)表示k时刻互差分序列的均值;
若当前系统数据量测时刻k大于MMax,则按下式计算两个量测系统互差分序列的方差:
其中,k为测量系统当前数据信号量测时刻,i为数据信号量测时刻,C(i)表示观测系统A和观测系统B自差分序列在i时刻的互差分序列,EC(M,k)为k时刻窗口长度为M时互差分序列的均值,σC(M,k)为k时刻窗口长度为M时互差分序列的方差,M为窗口长度序列;
(4)利用上述(1)、(2)、(3)步骤中得到的各个方差计算观测系统A和观测系统B的量测噪声方差阵;
若当前数据信号量测时刻k小于等于MMax,量测噪声方差阵为:
R1(k)表示数据量测时刻k小于MMax时观测系统A的量测噪声方差阵;R2(k)表示数据量测时刻k小于MMax时观测系统B的量测噪声方差阵;
若当前数据信号量测时刻k大于MMax,量测噪声方差阵为:
其中,k为系统当前数据量测时刻,σ1(k)、σ2(k)分别为观测系统A、观测系统B自差分序列在k时刻的方差,σC(k)为互差分序列在k时刻的方差,M为窗口长度,R1(M,k)表示数据量测时刻k大于MMax时观测系统A的量测噪声方差阵;R2(M,k)表示数据量测时刻k大于MMax时观测系统B的量测噪声方差阵;
步骤四:根据两个观测系统在不同窗口长度下计算得到的量测噪声方差阵信息,得到当前时刻最优窗口长度,使用最优窗口长度计算得当前时刻的量测噪声方差阵,具体为:
(1)当k小于等于MMax时,直接按照步骤三(4)中k小于等于MMax情况下的公式计算量测噪声方差阵:
(2)当k大于MMax时,将k时刻不同窗口下计算得到的噪声方差阵序列使用一次线形函数进行拟合,并记录其斜率;
其中,k为当前时刻,a为拟合直线的斜率,b为拟合直线的截距:
则拟合直线的斜率和截距为:
其中R(MMin,k)、R(MMin+MDis,k)、R(MMax-MDis,k)、R(MMax,k)分别表示窗口长度为MMin,(MMin+MDis),(MMax-MDis),MMax时的量测噪声方差阵;
(3)将拟合直线计算的斜率带入下式方程得到当前时刻k应使用的数据窗口长度M',若计算得到的窗口长度M'小于MMin,则取M'为MMin,且MMin取值为100:
其中:fix(·)表示取整,amax为所拟合的直线达到的最大斜率;
(4)利用最优窗口内的序列信息计算得到最终噪声方差阵的估计值:
R1f(M,k)、R2f(M,k)分别表示观测系统A、观测系统B在k时刻估计得到的量测噪声方差阵。
2.根据权利要求1所述的一种对双观测系统量测噪声方差阵的自适应同步估计方法,其特征在于:所述的最大斜率amax取值为3~7。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京航空航天大学,未经北京航空航天大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201210213914.7/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种高压喷枪的转接装置
- 下一篇:一种神经外科用手术托