CN106021194B - 一种多传感器多目标跟踪偏差估计方法 - Google Patents
一种多传感器多目标跟踪偏差估计方法 Download PDFInfo
- Publication number
- CN106021194B CN106021194B CN201610339299.2A CN201610339299A CN106021194B CN 106021194 B CN106021194 B CN 106021194B CN 201610339299 A CN201610339299 A CN 201610339299A CN 106021194 B CN106021194 B CN 106021194B
- Authority
- CN
- China
- Prior art keywords
- mrow
- vector
- covariance matrix
- deviation
- msubsup
- 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
- 238000000034 method Methods 0.000 title claims abstract description 48
- 239000011159 matrix material Substances 0.000 claims abstract description 71
- 239000013598 vector Substances 0.000 claims abstract description 70
- 230000004927 fusion Effects 0.000 claims abstract description 36
- 238000005259 measurement Methods 0.000 claims description 34
- 238000001914 filtration Methods 0.000 claims description 6
- 230000007704 transition Effects 0.000 claims description 4
- 238000004088 simulation Methods 0.000 description 11
- 238000000342 Monte Carlo simulation Methods 0.000 description 8
- 239000000654 additive Substances 0.000 description 6
- 230000000996 additive effect Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F18/00—Pattern recognition
- G06F18/20—Analysing
- G06F18/25—Fusion techniques
- G06F18/251—Fusion techniques of input or preprocessed data
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/17—Function evaluation by approximation methods, e.g. inter- or extrapolation, smoothing, least mean square method
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Mathematical Physics (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- General Engineering & Computer Science (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- Algebra (AREA)
- Computing Systems (AREA)
- Life Sciences & Earth Sciences (AREA)
- Artificial Intelligence (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Bioinformatics & Computational Biology (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Biology (AREA)
- Evolutionary Computation (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开了一种多传感器多目标跟踪偏差估计方法,包括:还原步骤,还原本地传感器量测值us(k|k)及其协方差矩阵Us(k|k);卡尔曼增益获取步骤,利用所获得的本地传感器量测值协方差矩阵获得卡尔曼增益Ws,k;偏差虚拟量测获取步骤,利用卡尔曼增益,获取偏差向量的虚拟量测融合偏差向量虚拟量测获得步骤,根据偏差向量的虚拟量测,获得融合偏差向量虚拟量测;偏差估计向量与偏差估计协方差矩阵获取步骤,根据偏差向量的虚拟量测融合偏差向量虚拟量测以及上一时刻的偏差估计向量及偏差估计协方差矩阵,获得偏差估计向量与偏差估计协方差矩阵。使用本发明的方法可以实现对偏差的有效估计。
Description
技术领域
本发明涉及一种目标跟踪偏差估计方法,尤其涉及一种多传感器多目标跟踪偏差估计方法。
背景技术
一般来说,由于有偏传感器不能自己配准自身偏差,需要一个比照的对象,所以传感器的配准都需要两个或两个以上传感器来进行。
在Friedland B.Treatment of bias in recursive filtering[J].IEEETransactions on Automatic Control,1969,14(4):359-367.中将偏差配准问题视为一个两传感器问题并用未知偏差量扩展状态向量,这种方法的弊端是在扩维向量维数增加时计算量也将明显增大。如Nabaa N,Bishop R H.Solution to a multisensor trackingproblem with sensor registration errors[J].IEEE Transactions on Aerospace&Electronic Systems,1999,35(1):354-363.中所述,大多数偏差估计算法直接作用于量测值并需要本地传感器的卡尔曼增益来进行偏差的估计。然而在实际***中,传感器可能只向融合中心提供滤波航迹。所以,虽然偏差估计与补偿的方法很多,仍需要一种只需要滤波状态及其协方差矩阵的偏差估计算法。
多传感器信息融合(Multi-sensor Information Fusion,MSIF),就是利用计算机技术将来自多传感器或多源的信息和数据,在一定的准则下加以自动分析和综合,以完成所需要的决策和估计而进行的信息处理过程。在多传感器信息融合***中,就位置(空间)级融合***的结构而论,有集中式、分布式结构。目前针对融合中心无本地传感器卡尔曼增益的情况,欠缺有效估计传感器偏差的方法。
发明内容
本发明鉴于背景技术的以上问题提出,用于解决背景技术中存在的问题,至少是提供一种有益的选择。
为了实现以上目的,本发明公开了一种多传感器多目标跟踪偏差估计方法,包括以下步骤:还原步骤,还原本地传感器量测值us(k|k)及本地传感器量测值协方差矩阵Us(k|k);卡尔曼增益获取步骤,利用所述还原步骤获得的本地传感器量测值协方差矩阵获得卡尔曼增益Ws,k;虚拟量测获取步骤,利用所述卡尔曼增益Ws,k,获取偏差向量的虚拟量测融合偏差向量虚拟量测获得步骤,根据所获得的偏差向量的虚拟量测,获得融合偏差向量虚拟量测;偏差估计向量bs(k)与偏差估计协方差矩阵获取步骤,根据所述偏差向量的虚拟量测以及所述融合偏差向量虚拟量测获得偏差估计向量bs(k)与偏差估计协方差矩阵Σs(k)。
根据本发明的一种实施方式,所述还原步骤利用逆卡尔曼滤波还原本地传感器量测值及其协方差矩阵。
根据本发明的一种实施方式,在所述卡尔曼增益获取步骤中,利用Ws,k=Ps(k|k')H(k)T[H(k)Ps(k|k')H(k)T+Rs,k]-1与Rs,k=H(k)Us(k|k)H(k)T求卡尔曼增益Ws,k,其中Ps(k|k')为传感器s的状态协方差矩阵预测值,H(k)为量测矩阵,Rs,k为量测协方差矩阵,上标T表示转移矩阵。
根据本发明的一种实施方式,在所述虚拟量测获取步骤中,利用求偏差向量的虚拟量测其中F(k,k')为状态转移矩阵,Hs(k)是第s个传感器的量测矩阵,为本地传感器滤波状态向量,为本地传感器上一时刻的滤波状态向量。
根据本发明的一种实施方式,在所述融合偏差向量虚拟量测获得步骤中,利用Wf,k=Pf(k|k')H(k)T[H(k)Pf(k|k')H(k)T+Rf,k]-1获得融合卡尔曼增益并利用以下公式获得融合偏差向量虚拟量测
其中上标s表示传感器的编号,下标f表示融合。
根据本发明的一种实施方式,采用递归最小均方偏差估计算法,利用上一时刻的偏差估计向量及上一时刻的偏差估计协方差矩阵,获得当前时刻的偏差估计向量bs(k)与偏差估计协方差矩阵Σs(k)。
根据本发明的一种实施方式,所述采用递归最小均方偏差估计算法,获得偏差估计向量bs(k)与偏差估计协方差矩阵Σs(k)的步骤包括针对第s个传感器的以下步骤:
当t=1,...,N时,利用获得虚拟量测zb,t(k),其中t是目标的序号;计算偏差更新的增益Gt(k)=Σt-1(k)Ht(k)T[Ht(k)Σt-1(k)Ht(k)TRt(k)]-1与残差更新偏差估计与偏差估计协方差矩阵:
Σt(k)=Σt-1(k)-Σt-1(k)Ht(k)T[Ht(k)Σt-1(k)Ht(k)T+Rt(k)]-1Ht(k)Σt-1(k)。
根据本发明的一种实施方式,利用序贯融合算法,使用融合状态向量融合状态协方差矩阵 获得融合卡尔曼增益并获得融合偏差向量虚拟量测。
根据本发明的一种实施方式,还包括融合轨迹获得步骤,利用还原出的本地传感器量测值us(k|k)及本地传感器量测值协方差矩阵Us(k|k)来获得融合轨迹。
使用本发明的方法可以实现对偏差的有效估计。
附图说明
结合附图,可以更好地理解本发明,但是附图仅仅是示例性的,不是对本发明的限制。
图1示出了根据本发明的一种实施方式的多传感器多目标跟踪偏差估计方法的流程图。
图2示出了根据本发明方法对角度维乘性偏差在单次仿真中的估计情况;
图3示出了根据本发明方法对角度维加性偏差在单次仿真中的估计情况;
图4示出了根据本发明方法对距离维乘性偏差在单次仿真中的估计情况;
图5示出了根据本发明方法对距离维加性偏差在单次仿真中的估计情况;
图6示出了根据本发明方法对角度维乘性偏差利用蒙特卡洛方法计算的均方根误差;
图7示出了根据本发明方法对角度维加性偏差利用蒙特卡洛方法计算的均方根误差;
图8示出了根据本发明方法对距离维乘性偏差利用蒙特卡洛方法计算的均方根误差;
图9示出了根据本发明方法对距离维加性偏差利用蒙特卡洛方法计算的均方根误差。
具体实施方式
下面结合附图具体说明本发明的实施方式。所说明的实施方式仅是示例性的,不是对本发明的限制。在所做的说明中,各实施方式可以互相参照。
图1示出了根据本发明的一种实施方式的多传感器多目标跟踪偏差估计方法的流程图。如图1所示,根据本发明的一种实施方式,利用多传感器多目标偏差估计方法实现k=1,2,L时刻偏差估计的具体步骤为:
首先在第一步步骤S101,利用逆卡尔曼滤波还原本地传感器量测值us(k|k)及其协方差矩阵Us(k|k),具体公式如下:
As(k|k)=Ps(k|k')[Ds(k|k)]-1 (4)
Ds(k|k)=Ps(k|k')-Ps(k|k) (5)
由于本文涉及一些公式,为了便于理解,概括将所涉及的符号的含义说明如下:本文中b均指偏差向量,f是英文融合(fusion)的意思,t指目标编号,s指传感器编号,上方带^的为滤波值,上方带~的为滤波值与真实值的偏差,括号中的(k|k′)指的是预测,k′可以是k-1也可以是更靠前的步骤,只要依据这个值调整滤波过程中的相关矩阵即可。
在以上公式中,为本地传感器滤波状态的预测值,为本地传感器滤波状态向量,Ps(k|k')为本地传感器滤波状态协方差矩阵的预测值,Ps(k|k)为本地传感器滤波状态协方差矩阵。
在以上公式中,式(2)表明还原的量测值应为真实状态值与偏差值的和;式(3)表明偏差值的期望为0。式4和式5中的As和Ds是算法中的中间变量。
然后在第二步步骤S102,利用Ws,k=Ps(k|k')H(k)T[H(k)Ps(k|k')H(k)T+Rs,k]-1与Rs,k=H(k)Us(k|k)H(k)T求卡尔曼增益Ws,k,其中Ps(k|k')为传感器s的状态协方差矩阵预测值,H(k)为量测矩阵,Rs,k为量测协方差矩阵;Rs,k可视为对US的维数变换。
接着在第三步步骤S103,使用S102中所获得的卡尔曼增益Ws,k,利用求偏差向量的虚拟量测其中F(k,k')为状态转移矩阵。
偏差向量其中与分别为距离和角度的加性偏差,与分别为距离和角度的乘性偏差。
随着估计过程的进行,被估计的偏差是随算法进行逐步变化的,第一个传感器是无偏的,之后逐个估计第二、三、四等等传感器的偏差。
之后,在第四步步骤S104,得到融合轨迹。在一种实施方式中,调用序贯融合算法(SFA),利用 来获得融合轨迹。在最初,可以用偏差已配准的第一个传感器的滤波值作为融合状态向量的初始值以及融合状态协方差矩阵随着配准的一步步进行可以用配准后的还原量测值来利用序贯思想一步步更新量测值。一般来说目标跟踪的过程就是获得目标运动轨迹的过程,此算法在估计偏差的同时获得了融合轨迹,这是此算法的一个亮点。偏差估计的本身是不需要获得融合轨迹的。步骤S104也可以在步骤S103之前进行。
然后在第五步步骤S105,利用Wf,k=Pf(k|k')H(k)T[H(k)Pf(k|k')H(k)T+Rf,k]-1求融合卡尔曼增益可得融合偏差向量虚拟量测
接着在第六步步骤S106,调用递归最小均方偏差估计(RLSBE)算法,输入为 以及上一时刻对所有传感器更新的偏差估计及偏差估计的协方差矩阵,返回偏差估计向量bs(k)与偏差估计协方差矩阵Σs(k);
之后重复以上的步骤,处理下一时刻数据。
其中序贯融合算法(SFA)具体流程如下:
第一步:根据动态模型利用融合状态向量xf(k'|k')与融合状态协方差矩阵Pf(k'|k')计算融合状态向量估计值xf(k|k')与融合状态协方差矩阵估计值Pf(k|k');
第二步:记xtemp=xf(k|k'),Ptemp=Pf(k|k');
第三步:当s=1,...,M时,利用还原出的量测值us(k|k)及其协方差矩阵Us(k|k)更新xtemp及Ptemp;
第四步:返回xf(k|k)=xtemp,Pf(k|k)=Ptemp;转第一步等待处理下一时刻的雷达观测数据。
其中递归最小均方偏差估计(RLSBE)算法流程如下。针对第s个传感器:
第一步:当t=1,...,N时,利用求虚拟量测zb,t(k);
上标的1代表的是第一个传感器,结合本文整体过程代表的是无偏的传感器的融合结果;上标的2代表的是第二个传感器,结合本文整体过程代表的是有偏的待估计的那个传感器。
计算偏差更新的增益Gt(k)=Σt-1(k)Ht(k)T[Ht(k)Σt-1(k)Ht(k)TRt(k)]-1与残差
更新偏差估计与协方差
Σt(k)=Σt-1(k)-Σt-1(k)Ht(k)T[Ht(k)Σt-1(k)Ht(k)T+Rt(k)]-1Ht(k)Σt-1(k),
在此处,用t个目标的相关值来序贯地更新S传感器的偏差估计向量,当对t个目标都更新一次就可获得能获取的最精确的S传感器的偏差估计。这t次运算构成一个完整地对s传感器的偏差估计,每个传感器都有这t步。
第二步:返回偏差估计向量偏差估计协方差矩阵Σ0(k+1)=ΣN(k);转第一步等待处理下一时刻的雷达观测数据。
本发明提出了一种只需本地传感器状态滤波值及其协方差矩阵的偏差估计算法,这种算法解决了先前算法需要使用扩维矩阵所造成的计算量增大问题,并且在偏差估计过程没有使用本地传感器的卡尔曼增益,实现了对偏差的有效估计。
为了验证本发明的实施方式的效果,根据目标的运动方程和雷达量测方程,人为构造出一组仿真数据,并利用这组仿真数据进行实验来证实算法的性能。图2示出了根据本发明方法对角度维乘性偏差在单次仿真中的估计情况,图3示出了根据本发明方法对角度维加性偏差在单次仿真中的估计情况,图4示出了根据本发明方法对距离维乘性偏差在单次仿真中的估计情况,图5示出了根据本发明方法对距离维加性偏差在单次仿真中的估计情况。从图2到图5可以看出偏差的估计值始终向真实值收敛,证实了本方法在单次仿真中的有效性。
图6示出了根据本发明方法对角度维乘性偏差利用蒙特卡洛方法计算的均方根误差,图7示出了根据本发明方法对角度维加性偏差利用蒙特卡洛方法计算的均方根误差,图8示出了根据本发明方法对距离维乘性偏差利用蒙特卡洛方法计算的均方根误差,图9示出了根据本发明方法对距离维加性偏差利用蒙特卡洛方法计算的均方根误差。从图6到图9可以看出偏差估计的均方根误差均在向0收敛,证实了本方法的统计有效性,实现了对传感器偏差的有效估计。
Claims (6)
1.一种多传感器多目标跟踪偏差估计方法,包括以下步骤:
还原步骤,还原本地传感器量测值us(k|k)及本地传感器量测值协方差矩阵Us(k|k);
卡尔曼增益获取步骤,利用所述还原步骤获得的本地传感器量测值协方差矩阵获得卡尔曼增益Ws,k;
偏差虚拟量测获取步骤,利用所述卡尔曼增益Ws,k,获取偏差向量的虚拟量测
融合偏差向量虚拟量测获得步骤,根据所获得的偏差向量的虚拟量测,获得融合偏差向量虚拟量测
偏差估计向量bs(k)与偏差估计协方差矩阵获取步骤,根据所述偏差向量的虚拟量测以及所述融合偏差向量虚拟量测获得偏差估计向量bs(k)与偏差估计协方差矩阵Σs(k);
其中,所述还原步骤利用逆卡尔曼滤波还原本地传感器量测值及其协方差矩阵;
在所述卡尔曼增益获取步骤中,利用Ws,k=Ps(k|k')H(k)T[H(k)Ps(k|k')H(k)T+Rs,k]-1与Rs,k=H(k)Us(k|k)H(k)T求卡尔曼增益Ws,k,其中Ps(k|k')为传感器s的状态协方差矩阵预测值,H(k)为量测矩阵,Rs,k为量测协方差矩阵,上标T表示转移矩阵;
在所述偏差虚拟量测获取步骤中,利用求偏差向量的虚拟量测其中F(k,k')为状态转移矩阵,Hs(k)是第s个传感器的量测矩阵,为本地传感器滤波状态向量,为本地传感器上一时刻的滤波状态向量,是卡尔曼增益的广义逆,I为单位矩阵。
2.依据权利要求1所述的方法,其特征在于,在所述融合偏差向量虚拟量测获得步骤中,利用获得融合卡尔曼增益并利用以下公式获得融合偏差向量虚拟量测
<mrow>
<msubsup>
<mi>z</mi>
<mrow>
<mi>b</mi>
<mo>,</mo>
<mi>f</mi>
</mrow>
<mi>s</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>W</mi>
<mrow>
<mi>f</mi>
<mo>,</mo>
<mi>k</mi>
</mrow>
<mi>s</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>+</mo>
</msup>
<mo>&lsqb;</mo>
<msubsup>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mi>f</mi>
<mi>s</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>|</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>I</mi>
<mo>-</mo>
<msubsup>
<mi>W</mi>
<mrow>
<mi>f</mi>
<mo>,</mo>
<mi>k</mi>
</mrow>
<mi>s</mi>
</msubsup>
<msub>
<mi>H</mi>
<mi>f</mi>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mi>F</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>,</mo>
<msup>
<mi>k</mi>
<mo>&prime;</mo>
</msup>
<mo>)</mo>
</mrow>
<msubsup>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mi>f</mi>
<mi>s</mi>
</msubsup>
<mrow>
<mo>(</mo>
<msup>
<mi>k</mi>
<mo>&prime;</mo>
</msup>
<mo>|</mo>
<msup>
<mi>k</mi>
<mo>&prime;</mo>
</msup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
其中上标s表示传感器的编号,下标f表示融合;其中,为融合滤波状态向量,是上一时刻的融合滤波状态向量,I为单位矩阵,是融合卡尔曼增益的广义逆,Hf(k)是融合量测矩阵。
3.依据权利要求2所述的方法,其特征在于,采用递归最小均方偏差估计算法,利用上一时刻的偏差估计向量及上一时刻的偏差估计协方差矩阵,获得当前时刻的偏差估计向量bs(k)与偏差估计协方差矩阵Σs(k)。
4.依据权利要求3所述的方法,其特征在于,所述采用递归最小均方偏差估计算法,获得偏差估计向量bs(k)与偏差估计协方差矩阵Σs(k)的步骤包括针对第s个传感器的以下步骤:
当t=1,...,N时,利用获得偏差向量的等效虚拟量测zb,t(k),其中t是目标的序号;zb,t(k)是偏差向量的等效虚拟量测,是第1个传感器对目标t的偏差向量的虚拟量测,是第2个传感器对目标t的偏差向量的虚拟量测,H1(k)是第1个传感器的量测矩阵,是第2个传感器的量测矩阵的广义逆;
计算偏差更新的增益Gt(k)=Σt-1(k)Ht(k)T[Ht(k)Σt-1(k)Ht(k)TRt(k)]-1与残差其中Σt-1(k)是更新到第t-1个目标时的偏差估计协方差矩阵,Ht(k)是传感器对第t个目标的量测矩阵,Rt(k)是传感器对第t个目标的量测协方差矩阵,是更新到第t-1个目标时的偏差估计向量;
更新偏差估计向量与偏差估计协方差矩阵:
<mrow>
<msub>
<mover>
<mi>b</mi>
<mo>^</mo>
</mover>
<mi>t</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mover>
<mi>b</mi>
<mo>^</mo>
</mover>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>G</mi>
<mi>t</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>r</mi>
<mi>t</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
</mrow>
Σt(k)=Σt-1(k)-Σt-1(k)Ht(k)T[Ht(k)Σt-1(k)Ht(k)T+Rt(k)]-1Ht(k)Σt-1(k);
其中,rt(k)是残差,是更新到第t个目标时的偏差估计向量,Σt(k)是更新到第t个目标时的偏差估计协方差矩阵。
5.依据权利要求4所述的方法,其特征在于,利用序贯融合算法,使用融合状态向量融合状态协方差矩阵本地传感器量测值us(k|k)和本地传感器量测值协方差矩阵Us(k|k),得到当前时刻的融合状态向量当前时刻的融合状态协方差矩阵基于所述当前时刻的融合状态向量和当前时刻的融合状态协方差矩阵利用获得融合卡尔曼增益并利用以下公式获得融合偏差向量虚拟量测:
<mrow>
<msubsup>
<mi>z</mi>
<mrow>
<mi>b</mi>
<mo>,</mo>
<mi>f</mi>
</mrow>
<mi>s</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>W</mi>
<mrow>
<mi>f</mi>
<mo>,</mo>
<mi>k</mi>
</mrow>
<mi>s</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>+</mo>
</msup>
<mo>&lsqb;</mo>
<msubsup>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mi>f</mi>
<mi>s</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>|</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>I</mi>
<mo>-</mo>
<msubsup>
<mi>W</mi>
<mrow>
<mi>f</mi>
<mo>,</mo>
<mi>k</mi>
</mrow>
<mi>s</mi>
</msubsup>
<msub>
<mi>H</mi>
<mi>f</mi>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mi>F</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>,</mo>
<msup>
<mi>k</mi>
<mo>&prime;</mo>
</msup>
<mo>)</mo>
</mrow>
<msubsup>
<mover>
<mi>x</mi>
<mo>^</mo>
</mover>
<mi>f</mi>
<mi>s</mi>
</msubsup>
<mrow>
<mo>(</mo>
<msup>
<mi>k</mi>
<mo>&prime;</mo>
</msup>
<mo>|</mo>
<msup>
<mi>k</mi>
<mo>&prime;</mo>
</msup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>;</mo>
</mrow>
其中,序贯融合算法具体流程如下:
第一步:根据动态模型利用融合状态向量与融合状态协方差矩阵计算融合状态向量估计值与融合状态协方差矩阵估计值
第二步:记
第三步:当s=1,...,M时,利用还原出的量测值us(k|k)及其协方差矩阵Us(k|k)更新xtemp及Ptemp;
第四步:返回转第一步等待处理下一时刻的雷达观测数据。
6.依据权利要求5所述的方法,其特征在于,还包括融合轨迹获得步骤,利用还原出的本地传感器量测值us(k|k)及本地传感器量测值协方差矩阵Us(k|k)来获得融合轨迹。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610339299.2A CN106021194B (zh) | 2016-05-19 | 2016-05-19 | 一种多传感器多目标跟踪偏差估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610339299.2A CN106021194B (zh) | 2016-05-19 | 2016-05-19 | 一种多传感器多目标跟踪偏差估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106021194A CN106021194A (zh) | 2016-10-12 |
CN106021194B true CN106021194B (zh) | 2017-10-03 |
Family
ID=57095345
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610339299.2A Active CN106021194B (zh) | 2016-05-19 | 2016-05-19 | 一种多传感器多目标跟踪偏差估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106021194B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI614699B (zh) | 2016-12-30 | 2018-02-11 | 國立成功大學 | 大量客製化產品的品質預測方法 |
CN106767832B (zh) * | 2017-01-17 | 2020-11-13 | 哈尔滨工业大学 | 一种基于动态多维分配的被动多源多目标跟踪方法 |
CN106597498B (zh) * | 2017-01-18 | 2020-04-24 | 哈尔滨工业大学 | 多传感器融合***空时偏差联合校准方法 |
CN107229037B (zh) * | 2017-06-01 | 2020-04-28 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | 移动平台传感器量测数据扩维空间配准方法 |
WO2021163846A1 (zh) * | 2020-02-17 | 2021-08-26 | 华为技术有限公司 | 目标跟踪方法以及目标跟踪装置 |
CN112859004A (zh) * | 2021-01-04 | 2021-05-28 | 南京理工大学 | 基于改进卡尔曼滤波的野值剔除方法 |
CN112906743B (zh) * | 2021-01-19 | 2021-11-19 | 中国人民解放军国防科技大学 | 一种快速多传感器集势概率假设密度滤波方法 |
CN113391266B (zh) * | 2021-05-28 | 2023-04-18 | 南京航空航天大学 | 基于非圆多嵌套阵降维子空间数据融合的直接定位方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101968369A (zh) * | 2010-08-31 | 2011-02-09 | 哈尔滨工业大学 | 基于b样条和扩展卡尔曼滤波的多功能传感器信号重构方法及多功能传感器的标定方法 |
CN102353375A (zh) * | 2011-05-06 | 2012-02-15 | 微迈森惯性技术开发(北京)有限公司 | 运动姿态数据的动态参数调整方法与设备 |
CN103440418A (zh) * | 2013-08-30 | 2013-12-11 | 中南大学 | 基于自组织卡尔曼滤波的多传感器主动容错估计方法 |
CN105136145A (zh) * | 2015-08-11 | 2015-12-09 | 哈尔滨工业大学 | 一种基于卡尔曼滤波的四旋翼无人机姿态数据融合的方法 |
-
2016
- 2016-05-19 CN CN201610339299.2A patent/CN106021194B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101968369A (zh) * | 2010-08-31 | 2011-02-09 | 哈尔滨工业大学 | 基于b样条和扩展卡尔曼滤波的多功能传感器信号重构方法及多功能传感器的标定方法 |
CN102353375A (zh) * | 2011-05-06 | 2012-02-15 | 微迈森惯性技术开发(北京)有限公司 | 运动姿态数据的动态参数调整方法与设备 |
CN103440418A (zh) * | 2013-08-30 | 2013-12-11 | 中南大学 | 基于自组织卡尔曼滤波的多传感器主动容错估计方法 |
CN105136145A (zh) * | 2015-08-11 | 2015-12-09 | 哈尔滨工业大学 | 一种基于卡尔曼滤波的四旋翼无人机姿态数据融合的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106021194A (zh) | 2016-10-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106021194B (zh) | 一种多传感器多目标跟踪偏差估计方法 | |
CN111985093B (zh) | 一种带噪声估计器的自适应无迹卡尔曼滤波状态估计方法 | |
CN109472418B (zh) | 基于卡尔曼滤波的机动目标状态预测优化方法 | |
CN107994885B (zh) | 一种同时估计未知输入和状态的分布式融合滤波方法 | |
CN108319570B (zh) | 一种异步多传感器空时偏差联合估计与补偿方法及装置 | |
CN108871365B (zh) | 一种航向约束下的状态估计方法及*** | |
CN116047498A (zh) | 基于最大相关熵扩展卡尔曼滤波的机动目标跟踪方法 | |
CN116595897B (zh) | 一种基于消息传递的非线性动态***状态估计方法和装置 | |
CN115143954A (zh) | 一种基于多源信息融合的无人车导航方法 | |
CN108120452B (zh) | Mems陀螺仪动态数据的滤波方法 | |
CN108846427A (zh) | 非线性***任意延迟步数的单个失序量测集中式融合方法 | |
Tripathi et al. | Innovation-based fractional order adaptive Kalman filter | |
Huang et al. | A bank of maximum a posteriori estimators for single-sensor range-only target tracking | |
CN114139109A (zh) | 一种目标跟踪方法、***、设备、介质及数据处理终端 | |
CN111426322B (zh) | 同时估计状态和输入的自适应目标跟踪滤波方法及*** | |
Annabattula et al. | Underwater passive target tracking in constrained environment | |
CN110912535B (zh) | 一种新型无先导卡尔曼滤波方法 | |
CN103313384B (zh) | 一种基于信息一致性的无线传感网络目标跟踪方法 | |
CN114858166B (zh) | 基于最大相关熵卡尔曼滤波器的imu姿态解算方法 | |
CN115828533A (zh) | 一种基于Student’s t分布的交互多模型鲁棒滤波方法 | |
CN113391285B (zh) | 一种量测随机延迟下带闪烁噪声的目标跟踪平滑方法 | |
CN112800889B (zh) | 一种基于分布式矩阵加权融合高斯滤波的目标跟踪方法 | |
CN108681621A (zh) | 基于Chebyshev正交多项式扩展RTS Kalman平滑方法 | |
CN109474892B (zh) | 基于信息形式的强鲁棒传感器网络目标跟踪方法 | |
CN111695617A (zh) | 一种基于改进的协方差交叉算法的分布式火控融合方法 |
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 |