摘要:
我们可设飞机轨迹为z=t.^2+10*t 1 T=0.05; 2 R=0.15; 3 N=30; 4 m=2:31;%预测采样点 5 n=1:40;t=n*T; 6 I=eye(3); 7 H=[1,0,0]; % 8 X0=[0,0,0.2]'; 9 P0=[10,0,0;0,12,0;0,0,5];10 Q=[1,T,T^2/2;0,1,T;0,0,1];11 R=0.2;12 z=t.^2+10*t;13 14 s=zeros(1,30);15 v=zeros(1,30);16 a=zeros(1,30);17 Fore_s=zeros(1,30);18 Fore_v=zeros 阅读全文