producerealstatemain.m

文件夹中NPFMain.m为滤波算法主运行程序

%RealState.m
clc;
clear all;
close all;
PtAcc=60;
%状态方程和观测方程中各矩阵和参数的定义
global T;
global Phi;
global G;
global Beta;
global g;
global q;

T=2;  %定义采样间隔
Phi=[1 T 0 0; 0 1 0 0; 0 0 1 T; 0 0 0 1]; %定义了状态转移矩阵
G=[T^2/2, T, 0, 0; 0, 0, T^2/2, T]'; 
H=[1 0 0 0; 0 0 1 0];
Beta=40000; %定义了真实的弹道系数
g=9.81; %定义了重力加速度
q=5; %定义了过程噪声强度
RealState(:,1)=[232000, 2290*cos(190*pi/180), 88000, 2290*sin(190*pi/180)]'; %状态起始值
RealState(:,2)=NextState(RealState(:,1));

for PtNum=3:PtAcc
    RealState(:,PtNum)=NextState(RealState(:,PtNum-1)); %航迹更新
end

filename='RealStateNonGaussianNoManeu.mat'; 
save(filename,'RealState');%将真实轨迹保存为文件