常用数据关联方法:最邻近(NNDA)、概率数据关联(PDA)、交互多模型(IMM)
一、测试程序
% PDA-FA算法实现
% 何友《雷达数据处理及应用》P116
% 二维空间匀速直线运动,状态向量为X=[x,vx,y,vy]
% x1=x0+vxT
% y1=y0+vyT
% 仿真:
% 1、改变虚假量测数量nc:公式求取、手动设置
% 2、改变量测噪声R=[r 0; 0 r],即r
% 3、改变虚假量测位置q,偏离真实位置的程度
% 4、关联概率计算
clc;
clear;
close all;
%************************************************
% 参数设置
%************************************************
I=eye(4);
T = 1; %采样间隔
simTime = 100 ; %仿真步数
A=[1 T 0 0;0 1 0 0;0 0 1 T;0 0 0 1]; %实际模型:CV
H=[1 0 0 0;0 0 1 0]; %测量模型
Q=0; %实际过程噪声
G = [T^2/2 0; T 0; 0 T^2/2; 0 T]; %噪声加权矩阵
r=200;
R=[r 0; 0 r]; %量测噪声
X0=[200;0;10000;-15]; %初始状态
X(:,1)=X0;
Vk=[sqrt(r)*randn;sqrt(r)*randn];
Zk(:,1)=H*X(:,1)+Vk;
gama=16;
lamda=0.0004;
%************************************************
% 量测生成
%************************************************
for i=2:1:simTime
X(:,i)=A*X(:,i-1); % 真实状态
Vk=[sqrt(r)*randn;sqrt(r)*randn];
Zk(:,i)=H*X(:,i)+Vk; %生成量测值
end
%************************************************
% PDA初始化
%************************************************
Xk_PDA=[200;0;10100;-16]; %初始状态、与实际值略有差别
R11=r; R22=r; R12=0; R21=0;
Pkk_PDA=[R11 R11/T R12 R12/T;
NNDA算法Matlab程序_信息与通信_工程科技_专业资料。常用数据关联方法:最邻近(NNDA)、概率数据关联(PDA)、交互多模型(IMM)一、测试程序 % NNDA-FA % 何友《...
IMMKF算法Matlab程序_IT/计算机_专业资料。常用数据关联方法:最邻近(NNDA)、概率数据关联(PDA)、交互多模型(IMM)一、IMM主程序 % % 基于IMM算法的目标跟踪 % ...
matlab遗传算法程序_IT/计算机_专业资料。介绍详细% 下面举例说明遗传算法 % % 求下列函数的最大值 % % f(x)=10*sin(5x)+7*cos(4x) x∈[0,10] % ...
差分演化算法matlab程序_计算机软件及应用_IT/计算机_专业资料 暂无评价0人阅读0次下载举报文档 差分演化算法matlab程序_计算机软件及应用_IT/计算机_专业资料。...
(pd)break;end %存在一条负回路, 终止程序 end %程序结束 利用 Ford--Fulkerson 标号法求最大流算法 的MATLAB 程序代码如下: n=8;C=[0 5 4 3 0 0 0...
蚁群算法程序(matlab)_工学_高等教育_教育专区。% 以下是蚁群算法MATLAB程序,请尊重原作者劳动,引用时请注明出处。 % 已经运行过,无误。 % 蚁群算法MATLAB程序 ...
遗传算法matlab源程序_工学_高等教育_教育专区。遗传算法matlab源程序外加习题。问题:求 f ( x) =
图论算法及matlab程序的三个案例_理学_高等教育_教育专区。Dijkstra算法,动态规划解决,同时还附带源程序,方便大家使用。图论实验三个案例 单源最短路径问题 1.1 ...
遗传算法及其 MATLAB 实现主要参考书: MATLAB 6.5 辅助优化计算与设计 飞思科技产品研发中心编著 电子工业出版社 2003.1 遗传算法及其应用 陈国良等编著 人民邮电...
求单源最短路径的 Dijkstra 算法的 Matlab 程序 function [d index1 index2]=Dijkf(a) M=max(max(a)); pb(1:length(a))=0; pb(1)=1; index1=1;...
热门文档