#xff00c;是否也被检测到了
发布时间:2025-06-24 19:04:48 作者:北方职教升学中心 阅读量:317
不同的概率质量函数(也就是说, 本文介绍了JPDA算法的原理和步骤,同时对其核心思想进行了总结。#xff00c;是否也被检测到了。
目录。最多一个量测以其为源。,为每个航迹的下一刻滤波器提供正确的测量值。
引用文献。仿真验证。
2.确认矩阵拆分。后续将逐步介绍其他数据关联算法,读者可以根据自己的需要修改代码。#xff00c;其他列最多只能有一个非零元素。
前言。在联合事件中表示。)[1]:
泊松分布:
其中,
泊松分布参数,c是归一化常数 。模拟实验结合算法步骤进行c;结果验证了算法的有效性和实用性。
协方差更新:
二、拆分原则。
在互联矩阵中c;除第一列外,
![\beta _{jt}\left ( k \right )=P_{r}\left ( \theta _{jt}\left ( k \right )\mid Z^{k} \right )=P_{r}\left ( \bigcup_{i=1}^{n_{k}}\theta _{jt}^{i}\left ( k \right ) \mid Z^{k}\right )=\sum_{i=1}^{m_{k}}\omega _{jt}^{i}\left [ \theta _{k} \right ]P_{r}\left ( \theta _{i}\left ( k \right ) \mid Z^{k}\right )](https://latex.csdn.net/eq?%5Cbeta%20_%7Bjt%7D%5Cleft%20%28%20k%20%5Cright%20%29%3DP_%7Br%7D%5Cleft%20%28%20%5Ctheta%20_%7Bjt%7D%5Cleft%20%28%20k%20%5Cright%20%29%5Cmid%20Z%5E%7Bk%7D%20%5Cright%20%29%3DP_%7Br%7D%5Cleft%20%28%20%5Cbigcup_%7Bi%3D1%7D%5E%7Bn_%7Bk%7D%7D%5Ctheta%20_%7Bjt%7D%5E%7Bi%7D%5Cleft%20%28%20k%20%5Cright%20%29%20%5Cmid%20Z%5E%7Bk%7D%5Cright%20%29%3D%5Csum_%7Bi%3D1%7D%5E%7Bm_%7Bk%7D%7D%5Comega%20_%7Bjt%7D%5E%7Bi%7D%5Cleft%20%5B%20%5Ctheta%20_%7Bk%7D%20%5Cright%20%5DP_%7Br%7D%5Cleft%20%28%20%5Ctheta%20_%7Bi%7D%5Cleft%20%28%20k%20%5Cright%20%29%20%5Cmid%20Z%5E%7Bk%7D%5Cright%20%29)
假设按照拆分原则确认矩阵最终拆分为。判断num = 0;for i = 1:n_total c_judge = []; for j = 1 : n1 c_judge = [c_judge;c_lib{j}{index(i,j)}]; end f = sum(c_judge(:,2:end)); if max(f)<= 1 num = num+1; A(:,:,num) = c_judge; end endA1 = A(:,:,1:num);
3.互联概率的计算。
二、
。

(一)模型构建。
)落入目标t(t = 0……T)跟踪波门,
表示量测j未落入目标t跟踪波门,当t=0时表示测量杂波或虚警,没有目标且。
有两个原则可以确认矩阵拆分: 基本假设。 在每行确认矩阵中只选择一个1作为互联矩阵的唯一非零元素。
https://blog.csdn.net/h320130/article/details/135141783。
设置杂波密度,跟踪门限参数,具体代码如下:
sim_time=150; %仿真时间T=1; %T为采样间隔n_sim = sim_time/T; %模拟次数MC_number=5; %Monte Carlo仿真次数n_target=2; %Initial_目标数量v=[1500 30 500 40; 500 40 1500 30];%nf的初始目标状态 = 0.1; %P0过程噪声强度 = 1*eye(4); %cluttter_每个目标的初始跟踪误差density = 0.000001; %杂波密度R = 1*eye(2); %目标测量误差%生成目标的运动X_location = cell(1,n_target);X_location(:) = {zeros(4,n_sim)};for q = 1:n_target [X_location{q},F,Q] = track(initial_v(q,:)',n_sim,T,nf,P0);end。多目标数据互联是多目标跟踪中一个重要但难以处理的问题,当回波落入多个目标的跟踪波门时,在数据关联过程中, 数据互联算法主要用于解决航迹开始后点迹与航迹的正确互联问题,也就是要。
获得最终连接概率矩阵后使用卡尔曼滤波器更新目标状态,以下公式:
状态向量更新:
其中,用j个量测量组合目标t的新息向量为k时刻。
![\sigma _{j}\left [ \theta _{i}\left ( k \right ) \right ]=\sum_{i=1}^{m_{k}}\omega _{jt}^{i}\left ( \theta _{i}\left ( k \right ) \right )=\left\{\begin{matrix} 1\\ 0 \end{matrix}\right.](https://latex.csdn.net/eq?%5Csigma%20_%7Bj%7D%5Cleft%20%5B%20%5Ctheta%20_%7Bi%7D%5Cleft%20%28%20k%20%5Cright%20%29%20%5Cright%20%5D%3D%5Csum_%7Bi%3D1%7D%5E%7Bm_%7Bk%7D%7D%5Comega%20_%7Bjt%7D%5E%7Bi%7D%5Cleft%20%28%20%5Ctheta%20_%7Bi%7D%5Cleft%20%28%20k%20%5Cright%20%29%20%5Cright%20%29%3D%5Cleft%5C%7B%5Cbegin%7Bmatrix%7D%201%5C%5C%200%20%5Cend%7Bmatrix%7D%5Cright.)
它是否与真正的目标联系在一起。#xff1a;

相应的代码程序:
m1 = 0;[~,n_z_total] = size(Z);Q1 = zeros(10000,n_target+1); %每时每刻所有量测点的数量不得超过1000,提前准备好矩阵indexcal = [];z_mid = [];for k = 1:n_z_total flag = 0; for q = 1:n_target d= Z(:,k) - Z_mid_pre(:,q); D(k,q) = d'*inv(S_mid_pre{q})*d; if D(k,q)<= g_sigma flag = 1; Q1(m1+1,1)=1; %杂波虚警只有回波落入门,可能是虚警 Q1(m1+1,q+1)=1; %如果落入回波内进行相应的滤波 end end if flag == 1 m1 = m1+1; z_mid = [z_mid,Z(:,k)]; index_cal = [index_cal,k]; endendQ2 = Q1(1:m1,1:n_target+1);
2.确认矩阵拆分。[1]雷达数据处理和应用,何友..., p160。(一)算法步骤。(二)仿真结果。
联合事件第j量测与目标互联的概率为:

其中,

在第一个联合事件中,
矩阵,则表示有。1的时间概率相乘,交集);然后进行归一化(即使所有联合事件的概率相加于1);然后计算出来自目标t的测量j的概率(即将到来的所有联合事件都涉及到量测j来自目标q的概率加,并集)#xfff0;。
假测量的数量。
确认矩阵定义如下:
![\Omega =[w_{jt}]=\begin{bmatrix} w_{10}&\cdots &w_{1T} \\ \vdots & \cdots & \vdots \\ w_{m_{k}0} & \cdots & w_{m_{k}T} \end{bmatrix}](https://latex.csdn.net/eq?%5COmega%20%3D%5Bw_%7Bjt%7D%5D%3D%5Cbegin%7Bbmatrix%7D%20w_%7B10%7D%26%5Ccdots%20%26w_%7B1T%7D%20%5C%5C%20%5Cvdots%20%26%20%5Ccdots%20%26%20%5Cvdots%20%5C%5C%20w_%7Bm_%7Bk%7D0%7D%20%26%20%5Ccdots%20%26%20w_%7Bm_%7Bk%7DT%7D%20%5Cend%7Bbmatrix%7D)
其中,
表示量测j(j = 1……。
本文主要介绍联合概率数据互联(JPDA)算法,该算法是联合概率数据互联(PDA)是在发展的基础上开发的c;但PDA主要用于解决杂波条件下单雷达单目标问题,JPDA主要用于适用。总结。

其中,
为测量测量的维数,
具体形式为:。。点击和航迹的数据互联算法主要包括两种,类似数据互联算法和贝叶斯类数据互联算法c;我们主要研究贝叶斯数据互联算法,包括以下算法:最近的邻域算法(NNSF)
概率数据互联算法(PDA)
综合概率数据互联算法(IPDA)
联合概率数据互联算法(JPDA)
全邻模糊聚类数据互联算法#xff08;ANFC)
……。 。(二)仿真结果。
4.更新状态和协方差。
互联网概率计算: 。
CV模型建立两个匀速目标c;模型的具体构建方法见之前的博客:
(四、 从仿真结果中可以看出JPDA可以实现杂波中点迹与航迹的良好互联,解决了目标跟踪过程中量测的不确定性问题,但联合概率数据互联网无法实现航迹管理,使用需要与航迹管理算法合作c;本文将详细介绍航迹管理算法的原理和使用情况。 。 均匀分布:
其中,c是归一化常数 ,V是确认区域的体积。
本文主要针对数据关联算法中的联合概率数据互联算法(JPDA)分析介绍,介绍了相应的原理和算法步骤,并对两个杂波下的匀速运动目标进行了模拟实验,验证了算法的准确性和有效性。杂波的分布方式不同。
![\tau _{j}\left [ \theta _{i}\left ( k \right ) \right ]=\sum_{i=1}^{T}\omega _{jt}^{i}\left ( \theta _{i}\left ( k \right ) \right )=\left\{\begin{matrix} 1\\ 0 \end{matrix}\right.](https://latex.csdn.net/eq?%5Ctau%20_%7Bj%7D%5Cleft%20%5B%20%5Ctheta%20_%7Bi%7D%5Cleft%20%28%20k%20%5Cright%20%29%20%5Cright%20%5D%3D%5Csum_%7Bi%3D1%7D%5E%7BT%7D%5Comega%20_%7Bjt%7D%5E%7Bi%7D%5Cleft%20%28%20%5Ctheta%20_%7Bi%7D%5Cleft%20%28%20k%20%5Cright%20%29%20%5Cright%20%29%3D%5Cleft%5C%7B%5Cbegin%7Bmatrix%7D%201%5C%5C%200%20%5Cend%7Bmatrix%7D%5Cright.)
这一部分的核心思想是:首先计算每个联合事件的概率(在即将到来的联合事件中,#xff09;交互式多模型(IMM)CV//中二维平面CA构建/CT模型。
。
1.确认矩阵计算。
(二)仿真结果。
。
1.确认矩阵计算。1000000);%拼接每个库,解决量测的不确定性问题。
3.计算互联概率。
有两个原则可以确认矩阵拆分:
基本假设。
联合概率数据互联是计算每个测量和多个目标互联的概率,假设。
,
表示量测来源于虚警或杂波。
一、仿真验证。测量的不确定性主要来自虚假航迹、 上述矩阵可分为以下༚
相应的代码是:
%计算每个库for i = 1 : n1 k = 0; for j = 1:n2 d = zeros(1,n2); if Q2(i,j) == 1 k = k+1; d(1,j) = 1; c_lib{i}{k} = d; end endend%%A = zeros(N1,JPDA原理及算法步骤。
公式表示计算联合事件i的概率。
目标检测指示:
![\phi _{j}\left [ \theta _{i}\left ( k \right ) \right ]=\sum_{j=1}^{m_{k}}\left ( 1- \tau _{j}\left [ \theta _{i}\left ( k \right ) \right ]\right )](https://latex.csdn.net/eq?%5Cphi%20_%7Bj%7D%5Cleft%20%5B%20%5Ctheta%20_%7Bi%7D%5Cleft%20%28%20k%20%5Cright%20%29%20%5Cright%20%5D%3D%5Csum_%7Bj%3D1%7D%5E%7Bm_%7Bk%7D%7D%5Cleft%20%28%201-%20%5Ctau%20_%7Bj%7D%5Cleft%20%5B%20%5Ctheta%20_%7Bi%7D%5Cleft%20%28%20k%20%5Cright%20%29%20%5Cright%20%5D%5Cright%20%29)
公式表示联合事件中任意测量。JPDA原理及算法步骤。
总结。
每个测量都有一个独特的源,不考虑不可分辨的情况。(一)算法步骤。
联合概率数据互联是指计算每个测量与多个目标互联的概率,假设。引用文献。如下图所示,
。
对于一个给定目标,
前言。量测j起源于目标t事件,
表示第一个联合事件。
一、
(一)模型构建。N2,目标虚警和多目标点迹判断。
根据单目标概率数据互联网中的条件概率定义为:
则其满足。
假测量量量:
。
测量互联指示: 公式表示量测j在。
表示量测j来自目标t的事件,其中。
JPDA联合概率数据计算有两种形式,根据假量测量数量。
相应的代码是:
% target_indicator = %Pr目标指示器 = zeros(1,num);for i1 = 1:num %计算每个相关矩阵的概率 False_num = m1; N=1; for j = 1:m1 mea_indicator = sum(A_matrix(j,2:end,i1));%观测指示器 if mea_indicator ==1 False_num = False_num-1; m0 = find(A_matrix(j,2:end,i1)); b=(z_mid(:,j)-Z_mid_pre(:,m0))'*inv(S_mid_pre{m0})*(z_mid(:,j)-Z_mid_pre(:,m0)); N=N/sqrt(det((2*pi)^(nz/2)*S_mid_pre{m0}))*exp(-1/2*b); end end if Pd==1 a=1; else a=1; for j=1:c target_indicator=sum(A_matrix(:,j+1,i)); %中国参考文献4-49 a=a*Pd^target_indicator*(1-Pd)^(1-target_indicator); %检测概率的计算 end end % V = sum(ellipse_Volume)*clutter_density; %表示整个空域的体积 Pr(i1)=N*a*(0.00000000000000000000000001)^False_num;endPr=Pr/sum(Pr);

4.更新状态和协方差。多目标数据在杂波条件下进行互联。
是否与目标t互联, 公式表示第一个联合事件,如果测量j来自目标q,为1,否则为0。应考虑各目标航迹对测量值的竞争。
在获得最终的互联概率矩阵后,使用卡尔曼滤波器更新目标状态,以下公式:
状态向量更新:
![P^{t}\left ( k\mid k \right )=P^{t}\left ( k\mid k-1 \right )-(1-\beta _{0t})K^{t}\left ( k \right )S^{t}\left ( k \right )\left [ K^{t}\left ( k \right ) \right ]^{top}+K^{t}\left ( k \right )\left [ \sum_{j=0}^{m_{k}}\beta _{jt}(k)V_{j}^{t}\left ( k \right )\left (V_{j}^{t}\left ( k \right )\right )^{top} -V^{t}\left ( k \right )\left (V^{t}\left ( k \right )\right )^{top} \right ]\left ( K^{t}\left ( k \right ) \right )^{top}](https://latex.csdn.net/eq?P%5E%7Bt%7D%5Cleft%20%28%20k%5Cmid%20k%20%5Cright%20%29%3DP%5E%7Bt%7D%5Cleft%20%28%20k%5Cmid%20k-1%20%5Cright%20%29-%281-%5Cbeta%20_%7B0t%7D%29K%5E%7Bt%7D%5Cleft%20%28%20k%20%5Cright%20%29S%5E%7Bt%7D%5Cleft%20%28%20k%20%5Cright%20%29%5Cleft%20%5B%20K%5E%7Bt%7D%5Cleft%20%28%20k%20%5Cright%20%29%20%5Cright%20%5D%5E%7B%5Ctop%20%7D+K%5E%7Bt%7D%5Cleft%20%28%20k%20%5Cright%20%29%5Cleft%20%5B%20%5Csum_%7Bj%3D0%7D%5E%7Bm_%7Bk%7D%7D%5Cbeta%20_%7Bjt%7D%28k%29V_%7Bj%7D%5E%7Bt%7D%5Cleft%20%28%20k%20%5Cright%20%29%5Cleft%20%28V_%7Bj%7D%5E%7Bt%7D%5Cleft%20%28%20k%20%5Cright%20%29%5Cright%20%29%5E%7B%5Ctop%20%7D%20-V%5E%7Bt%7D%5Cleft%20%28%20k%20%5Cright%20%29%5Cleft%20%28V%5E%7Bt%7D%5Cleft%20%28%20k%20%5Cright%20%29%5Cright%20%29%5E%7B%5Ctop%20%7D%20%5Cright%20%5D%5Cleft%20%28%20K%5E%7Bt%7D%5Cleft%20%28%20k%20%5Cright%20%29%20%5Cright%20%29%5E%7B%5Ctop%20%7D)
其中,
用j个量测量将目标t组合成k时间的新息向量。
在互联矩阵中c;除第一列外,
假设按照拆分原则确认矩阵最终拆分为。判断num = 0;for i = 1:n_total c_judge = []; for j = 1 : n1 c_judge = [c_judge;c_lib{j}{index(i,j)}]; end f = sum(c_judge(:,2:end)); if max(f)<= 1 num = num+1; A(:,:,num) = c_judge; end endA1 = A(:,:,1:num);3.互联概率的计算。
二、 。
(一)模型构建。)落入目标t(t = 0……T)跟踪波门,
表示量测j未落入目标t跟踪波门,当t=0时表示测量杂波或虚警,没有目标且。
https://blog.csdn.net/h320130/article/details/135141783。
设置杂波密度,跟踪门限参数,具体代码如下:
sim_time=150; %仿真时间T=1; %T为采样间隔n_sim = sim_time/T; %模拟次数MC_number=5; %Monte Carlo仿真次数n_target=2; %Initial_目标数量v=[1500 30 500 40; 500 40 1500 30];%nf的初始目标状态 = 0.1; %P0过程噪声强度 = 1*eye(4); %cluttter_每个目标的初始跟踪误差density = 0.000001; %杂波密度R = 1*eye(2); %目标测量误差%生成目标的运动X_location = cell(1,n_target);X_location(:) = {zeros(4,n_sim)};for q = 1:n_target [X_location{q},F,Q] = track(initial_v(q,:)',n_sim,T,nf,P0);end。多目标数据互联是多目标跟踪中一个重要但难以处理的问题,当回波落入多个目标的跟踪波门时,在数据关联过程中,数据互联算法主要用于解决航迹开始后点迹与航迹的正确互联问题,也就是要。
获得最终连接概率矩阵后使用卡尔曼滤波器更新目标状态,以下公式:
状态向量更新:其中,用j个量测量组合目标t的新息向量为k时刻。
它是否与真正的目标联系在一起。#xff1a;
相应的代码程序:
m1 = 0;[~,n_z_total] = size(Z);Q1 = zeros(10000,n_target+1); %每时每刻所有量测点的数量不得超过1000,提前准备好矩阵indexcal = [];z_mid = [];for k = 1:n_z_total flag = 0; for q = 1:n_target d= Z(:,k) - Z_mid_pre(:,q); D(k,q) = d'*inv(S_mid_pre{q})*d; if D(k,q)<= g_sigma flag = 1; Q1(m1+1,1)=1; %杂波虚警只有回波落入门,可能是虚警 Q1(m1+1,q+1)=1; %如果落入回波内进行相应的滤波 end end if flag == 1 m1 = m1+1; z_mid = [z_mid,Z(:,k)]; index_cal = [index_cal,k]; endendQ2 = Q1(1:m1,1:n_target+1);
2.确认矩阵拆分。[1]雷达数据处理和应用,何友..., p160。(一)算法步骤。(二)仿真结果。
联合事件第j量测与目标互联的概率为:
其中,
在第一个联合事件中,矩阵,则表示有。1的时间概率相乘,交集);然后进行归一化(即使所有联合事件的概率相加于1);然后计算出来自目标t的测量j的概率(即将到来的所有联合事件都涉及到量测j来自目标q的概率加,并集)#xfff0;。
假测量的数量。
确认矩阵定义如下:
其中,表示量测j(j = 1……。
本文主要介绍联合概率数据互联(JPDA)算法,该算法是联合概率数据互联(PDA)是在发展的基础上开发的c;但PDA主要用于解决杂波条件下单雷达单目标问题,JPDA主要用于适用。总结。
其中,
为测量测量的维数,
具体形式为:。。点击和航迹的数据互联算法主要包括两种,类似数据互联算法和贝叶斯类数据互联算法c;我们主要研究贝叶斯数据互联算法,包括以下算法:最近的邻域算法(NNSF)
概率数据互联算法(PDA)
综合概率数据互联算法(IPDA)
联合概率数据互联算法(JPDA)
全邻模糊聚类数据互联算法#xff08;ANFC)
……。 。(二)仿真结果。
4.更新状态和协方差。
互联网概率计算: 。
CV模型建立两个匀速目标c;模型的具体构建方法见之前的博客:
(四、 从仿真结果中可以看出JPDA可以实现杂波中点迹与航迹的良好互联,解决了目标跟踪过程中量测的不确定性问题,但联合概率数据互联网无法实现航迹管理,使用需要与航迹管理算法合作c;本文将详细介绍航迹管理算法的原理和使用情况。 。 均匀分布:
其中,c是归一化常数 ,V是确认区域的体积。
本文主要针对数据关联算法中的联合概率数据互联算法(JPDA)分析介绍,介绍了相应的原理和算法步骤,并对两个杂波下的匀速运动目标进行了模拟实验,验证了算法的准确性和有效性。杂波的分布方式不同。
![\tau _{j}\left [ \theta _{i}\left ( k \right ) \right ]=\sum_{i=1}^{T}\omega _{jt}^{i}\left ( \theta _{i}\left ( k \right ) \right )=\left\{\begin{matrix} 1\\ 0 \end{matrix}\right.](https://latex.csdn.net/eq?%5Ctau%20_%7Bj%7D%5Cleft%20%5B%20%5Ctheta%20_%7Bi%7D%5Cleft%20%28%20k%20%5Cright%20%29%20%5Cright%20%5D%3D%5Csum_%7Bi%3D1%7D%5E%7BT%7D%5Comega%20_%7Bjt%7D%5E%7Bi%7D%5Cleft%20%28%20%5Ctheta%20_%7Bi%7D%5Cleft%20%28%20k%20%5Cright%20%29%20%5Cright%20%29%3D%5Cleft%5C%7B%5Cbegin%7Bmatrix%7D%201%5C%5C%200%20%5Cend%7Bmatrix%7D%5Cright.)
这一部分的核心思想是:首先计算每个联合事件的概率(在即将到来的联合事件中,#xff09;交互式多模型(IMM)CV//中二维平面CA构建/CT模型。
。
1.确认矩阵计算。
(二)仿真结果。
。
1.确认矩阵计算。1000000);%拼接每个库,解决量测的不确定性问题。
3.计算互联概率。
最近的邻域算法(NNSF)
概率数据互联算法(PDA)
综合概率数据互联算法(IPDA)
联合概率数据互联算法(JPDA)
全邻模糊聚类数据互联算法#xff08;ANFC)
……。 。(二)仿真结果。
4.更新状态和协方差。 互联网概率计算: 。
CV模型建立两个匀速目标c;模型的具体构建方法见之前的博客:
(四、 从仿真结果中可以看出JPDA可以实现杂波中点迹与航迹的良好互联,解决了目标跟踪过程中量测的不确定性问题,但联合概率数据互联网无法实现航迹管理,使用需要与航迹管理算法合作c;本文将详细介绍航迹管理算法的原理和使用情况。 。 均匀分布: 其中,c是归一化常数 ,V是确认区域的体积。
本文主要针对数据关联算法中的联合概率数据互联算法(JPDA)分析介绍,介绍了相应的原理和算法步骤,并对两个杂波下的匀速运动目标进行了模拟实验,验证了算法的准确性和有效性。杂波的分布方式不同。
这一部分的核心思想是:首先计算每个联合事件的概率(在即将到来的联合事件中,#xff09;交互式多模型(IMM)CV//中二维平面CA构建/CT模型。。
1.确认矩阵计算。
(二)仿真结果。 。
1.确认矩阵计算。1000000);%拼接每个库,解决量测的不确定性问题。
3.计算互联概率。
有两个原则可以确认矩阵拆分:
基本假设。 , 表示量测来源于虚警或杂波。 一、仿真验证。测量的不确定性主要来自虚假航迹、 上述矩阵可分为以下༚ %计算每个库for i = 1 : n1 k = 0; for j = 1:n2 d = zeros(1,n2); if Q2(i,j) == 1 k = k+1; d(1,j) = 1; c_lib{i}{k} = d; end endend%%A = zeros(N1,JPDA原理及算法步骤。 公式表示计算联合事件i的概率。 目标检测指示: 公式表示联合事件中任意测量。JPDA原理及算法步骤。 总结。 |
每个测量都有一个独特的源,不考虑不可分辨的情况。 (一)算法步骤。 |
对于一个给定目标,
前言。量测j起源于目标t事件,
表示第一个联合事件。
一、
(一)模型构建。N2,目标虚警和多目标点迹判断。 根据单目标概率数据互联网中的条件概率定义为:
则其满足。
假测量量量:
。
测量互联指示: 公式表示量测j在。
表示量测j来自目标t的事件,其中。
JPDA联合概率数据计算有两种形式,根据假量测量数量。
相应的代码是:
% target_indicator = %Pr目标指示器 = zeros(1,num);for i1 = 1:num %计算每个相关矩阵的概率 False_num = m1; N=1; for j = 1:m1 mea_indicator = sum(A_matrix(j,2:end,i1));%观测指示器 if mea_indicator ==1 False_num = False_num-1; m0 = find(A_matrix(j,2:end,i1)); b=(z_mid(:,j)-Z_mid_pre(:,m0))'*inv(S_mid_pre{m0})*(z_mid(:,j)-Z_mid_pre(:,m0)); N=N/sqrt(det((2*pi)^(nz/2)*S_mid_pre{m0}))*exp(-1/2*b); end end if Pd==1 a=1; else a=1; for j=1:c target_indicator=sum(A_matrix(:,j+1,i)); %中国参考文献4-49 a=a*Pd^target_indicator*(1-Pd)^(1-target_indicator); %检测概率的计算 end end % V = sum(ellipse_Volume)*clutter_density; %表示整个空域的体积 Pr(i1)=N*a*(0.00000000000000000000000001)^False_num;endPr=Pr/sum(Pr);
4.更新状态和协方差。多目标数据在杂波条件下进行互联。
是否与目标t互联, 公式表示第一个联合事件,如果测量j来自目标q,为1,否则为0。应考虑各目标航迹对测量值的竞争。
在获得最终的互联概率矩阵后,使用卡尔曼滤波器更新目标状态,以下公式:
状态向量更新:
其中,
用j个量测量将目标t组合成k时间的新息向量。