predictstates.m

来自「阵列信号处理中常用的LS算法,用于估计目标的方位角等位置参数.」· M 代码 · 共 15 行

function xu = predictstates(x,segma);
% PURPOSE : Performs the prediction step of the sequential SIR algorithm for 
%         : the model described in the file pfbiradar.m.
% INPUTS  : - x = The state samples.当前时刻。列是状态变量，行是粒子数
%           - segma = The initial variance of the state estimate.
% OUTPUTS : - xu = The state samples after the prediction step.下一时刻。列是状态变量，行是采样粒子


T=0.1;
w=0.4;
Fai=[1 sin(w*T)/w 0 -(1-cos(w*T))/w
    0 cos(w*T) 0 -sin(w*T)
    0 (1-cos(w*T))/w 1 sin(w*T)/w
    0 sin(w*T) 0 cos(w*T)];
xu=Fai*x+sqrt(segma)*randn(4,size(x,2));