yunxing2d.m

这些程序都是经过本人和许许多多工作过学习过的老师同学

%***********加上x4,x5,x6后，ex,ey,ez,sWfx,sWfy,sWfz扩充为状态变量的情况下的常微分方程曲线图***********

[t,y]=ode45('observability2d',[0:2:35*3600],[3*pi/(60*180);3*pi/(60*180);5*pi/(60*180);5*pi/(60*180);5*pi/(60*180);6*pi/(60*180);0;0;2*pi/(60*180);0.01*pi/(180*3600);0.01*pi/(180*3600);0.01*pi/(180*3600);0;0;0]);

yy=zeros(501,15);

%每隔126点保存一次，放在矩阵yy

yy(1,:)=y(1,:);

for j=1:500
    
    for i=2:127
        
        yy(j+1,:)=y(126*j+1,:);
        
    end
    
end   

x1=yy(:,1)*180*60/pi;
x2=yy(:,2)*180*60/pi;
x3=yy(:,3)*180*60/pi;
x4=yy(:,4)*180*60/pi;
x5=yy(:,5)*180*60/pi;
x6=yy(:,6)*180*60/pi;
x7=yy(:,7);
x8=yy(:,8);
x9=yy(:,9)*180*60/pi;
x10=yy(:,10)*180*3600/pi;
x11=yy(:,11)*180*3600/pi;
x12=yy(:,12)*180*3600/pi;
x13=yy(:,13);
x14=yy(:,14);
x15=yy(:,15);

t=0:252/3600:35;

%舰体姿态误差角

figure(1)

subplot(3,3,1)
plot(t,x1,'r');
xlabel('时间t');
grid on;
subplot(3,3,2)
plot(t,x2,'r');
xlabel('时间t');
grid on;
subplot(3,3,3)
plot(t,x3,'r');
xlabel('时间t');
grid on;

%弹体误差角

subplot(3,3,4)
plot(t,x4,'r');
xlabel('时间t');
grid on;
subplot(3,3,5)
plot(t,x5,'r');
xlabel('时间t');
grid on;
subplot(3,3,6)
plot(t,x6,'r');
xlabel('时间t');
grid on;

%速度误差

subplot(3,3,7)
plot(t,x7,'r');
xlabel('时间t');
grid on;
subplot(3,3,8)
plot(t,x1,'r');
xlabel('时间t');
grid on;

%经度误差角

subplot(3,3,9)
plot(t,x9,'r');
xlabel('时间t');
grid on;

%扩充的状态变量

figure(2)

subplot(2,3,1)
plot(t,x10,'r');
xlabel('时间t');
grid on;
subplot(2,3,2)
plot(t,x11,'r');
xlabel('时间t');
grid on;
subplot(2,3,3)
plot(t,x12,'r');
xlabel('时间t');
grid on;
subplot(2,3,4)
plot(t,x13,'r');
xlabel('时间t');
grid on;
subplot(2,3,5)
plot(t,x14,'r');
xlabel('时间t');
grid on;
subplot(2,3,6)
plot(t,x15,'r');
xlabel('时间t');
grid on;