tiaoping1.m

组合导航的程序

clear all;
Rad_D = 0.01745329; % Rad_Degree 

alpha(1) = 100*Rad_D/60.0;%  角分
 beta(1) = 100*Rad_D/60.0;%  角分 
  gama =  0*Rad_D;     %  方位角

step = 1;
k = 0.1;

  
 for j =1:100/step
    
      f_alpha(j) = -k*cos(gama)*alpha(j) + k*sin(gama)*beta(j);
      f_beta(j) = -k*sin(gama)*alpha(j) - k*cos(gama)*beta(j);
      
      alpha(j+1) = alpha(j) + f_alpha(j)*step;
      beta(j+1) = beta(j) + f_beta(j)*step;
 end     
 
 i=1:1:100/step;

plot(i,alpha(i)*60/Rad_D,'r',i,beta(i)*60/Rad_D,'--')