IMM交互多模型Matlab算法实现

应用背景 交互多模型Matlab实现，包含左转，右转和常速度模型。采用Kalman滤波预测估计。效果很好，带有多种误差评价方法及显示结果。 适用目标跟踪，状态空间为位置速度 包含：运动目标跟踪，模型转移概率更新，卡尔曼滤波等文件 关键技术% 基于IMM算法的目标跟踪 % %=============================== %建立模型 %=============================== % 仿真参数 simTime=100; %仿真迭代次数 T=1; %采样时间 w2=3*2*pi/360; %模型2转弯率3度 w3=-3*2*pi/360; %模型3转弯率-3度 H=[1,0,0,0;0,0,1,0]; %模型量测矩阵 G=[T^2/2,0;T,0;0,T^2/2;0,T]; %模型过程噪声加权矩阵 r=200; %20 2000 R=[r,0;0,r]; %模型量测噪声协方差矩阵 Q=[10,0;0,10]; %模型过程噪声协方差矩阵 F1=[1,T,0,0;0,1,0,0;0,0,1,T;0,0,0,1]; %模型1状态转移矩阵 F2=[1,sin(w2*T)/w2,0,(cos(w2*T)-1)/w2; 0,cos(w2*T),0,sin(w2*T); 0,(1-cos(w2*T))/w2,1,sin(w2*T)/w2; 0,-sin(w2*T),0,cos(w2*T)]; %模型2状态转移矩阵 左转弯 F3=[1,sin(w3*T)/w3,0,(cos(w3*T)-1)/w3; 0,cos(w3*T),0,sin(w3

IMM
immKF.m
Kalman.m
Model_mix.m
Model_P_up.m