faligment.m

请不要用做非法用途

wd=45.6679;
PI=3.1415926;
wie=7.29e-5;
R=6378.393*1000;
g=9.8;
t=1.0;
k=0.0005;
b=-1;
vx=0;
vy=0;
wz=wie*sin(wd*PI/180.0);
%A=[0 1 0 0
%   -g*k^b 0 wz 0
 %  0 0 0 1
 % 0 -wz -g*k^b 0];
 A=[0 1 0 0
   -g/R 0 0 wz
   0 0 0 1
   0 -wz -g/R 0];
x=[1.5
   0
   1
   0];
for i=1:25000; 
   da(i)=x(1);
   da1(i)=x(3);
   vx=(-g*x(3)-k*vx)*t+vx;
   vy=(g*x(1)-k*vy)*t+vy;
   u=[0
   k/R*vy
   0
   -k/R*vx];
   x=(A*x+u)*t+x; 
end;
m=1:25000;
plot(m,da(m),'R',m,da1(m),'G',m,0);