debugfine.m

组合导航的程序

for k =1:600*6/T 
  if k<20
      
      Ky = 20*Ky0;
      Kz = 20*Kz0;
      Kdy = 20*Kdy0; 
      Kdz = 20*Kdz0;
      
   elseif k>=20&k<200
      
      Ky = 10*Ky0;
      Kz = 10*Kz0;
      Kdy = 10*Kdy0; 
      Kdz = 10*Kdz0;
      
   else
       
      Ky = Ky0;
      Kz = Kz0;
      Kdy = Kdy0; 
      Kdz = Kdz0;
      
      
   end