%  程序说明：目标跟踪程序，实现运动弹头对运动物体的三维跟踪，主函数
%  状态方程： x(t)=Ax(t-1)+Bu(t-1)+w(t）
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
 clc;
 clear;
 close all;

delta_t=0.01;     %测量周期，采样周期
longa=10000;      %机动时间常数的倒数，即机动频率
tf=6;   
T=tf/delta_t;     %时间长度3.7s，一共采用T=370次
%状态转移矩阵，用F表示
......................