文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > IT/计算机 > PDA算法Matlab程序
侵权投诉

PDA算法Matlab程序

常用数据关联方法:最邻近(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;

第1页

你可能喜欢

热门文档

相关文档

  • NNDA算法Matlab程序

    NNDA算法Matlab程序_信息与通信_工程科技_专业资料。常用数据关联方法:最邻近(NNDA)、概率数据关联(PDA)、交互多模型(IMM)一、测试程序 % NNDA-FA % 何友《...

  • IMMKF算法Matlab程序

    IMMKF算法Matlab程序_IT/计算机_专业资料。常用数据关联方法:最邻近(NNDA)、概率数据关联(PDA)、交互多模型(IMM)一、IMM主程序 % % 基于IMM算法的目标跟踪 % ...

  • matlab遗传算法程序

    matlab遗传算法程序_IT/计算机_专业资料。介绍详细% 下面举例说明遗传算法 % % 求下列函数的最大值 % % f(x)=10*sin(5x)+7*cos(4x) x∈[0,10] % ...

  • 差分演化算法matlab程序

    差分演化算法matlab程序_计算机软件及应用_IT/计算机_专业资料 暂无评价0人阅读0次下载举报文档 差分演化算法matlab程序_计算机软件及应用_IT/计算机_专业资料。...

  • matlab图论程序算法大全

    (pd)break;end %存在一条负回路, 终止程序 end %程序结束 利用 Ford--Fulkerson 标号法求最大流算法 的MATLAB 程序代码如下: n=8;C=[0 5 4 3 0 0 0...

  • 蚁群算法程序(matlab)

    蚁群算法程序(matlab)_工学_高等教育_教育专区。% 以下是蚁群算法MATLAB程序,请尊重原作者劳动,引用时请注明出处。 % 已经运行过,无误。 % 蚁群算法MATLAB程序 ...

  • 遗传算法matlab源程序

    遗传算法matlab源程序_工学_高等教育_教育专区。遗传算法matlab源程序外加习题。问题:求 f ( x) =

  • 图论算法及matlab程序的三个案例

    图论算法及matlab程序的三个案例_理学_高等教育_教育专区。Dijkstra算法,动态规划解决,同时还附带源程序,方便大家使用。图论实验三个案例 单源最短路径问题 1.1 ...

  • 遗传算法及其MATLAB程序

    遗传算法及其 MATLAB 实现主要参考书: MATLAB 6.5 辅助优化计算与设计 飞思科技产品研发中心编著 电子工业出版社 2003.1 遗传算法及其应用 陈国良等编著 人民邮电...

  • 图论算法及其Matlab程序

    求单源最短路径的 Dijkstra 算法的 Matlab 程序 function [d index1 index2]=Dijkf(a) M=max(max(a)); pb(1:length(a))=0; pb(1)=1; index1=1;...

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email