fine.m

请不要用做非法用途

wd=45.6679;
PI=3.1415926;
wie=7.29e-5;
R=6378.393*1000;
g=9.8;
t=0.1;
x=[1
   0
   0];
y=[0.75
   1
   0
   0];
k1=0.0324;
k2=300.7;
k3=1.632;
kz=-wie*cos(wd*PI/180.0)*2.0;
kc=[0 -(k2+1)/R -1
    g -k1 0.0
    0.0 k3/R 0.0];
kc1=[0 -PI*wie*cos(wd*PI/180.0)/180.0 -(1+k2)/R 0
   0 0 0 1
  g 0 -k1 0
   0 0 kz -k3];
for i=1:10000;
   dx=kc*x;
   x=dx*t+x;
   data(i)=x(1);
end; 
for i=1:10000;
   dy=kc1*y;
   y=dy*t+y;
   data2(i)=y(1);
   data1(i)=y(2);
end;
figure(1);
n=1:10000;
plot(n/10,data(n));
figure(2);
n=1:10000;
plot(n/10,data1(n));
figure(3);
n=1:10000;
plot(n/10,data2(n));