dcmelgen.m

惯性导航系统传递对准系统模型程序

function DCMel_prof = dcmelgen(lat_prof, lon_prof, tc_prof)
if nargin<2,error('insufficient number of input arguments'),end

for i = 1:max(size(tc_prof)),
   
   alpha = 0;                        % North-pointing case
   DCMel = llw2dcm([lat_prof(i) lon_prof(i) alpha]);

   DCMel_prof(i,1) = DCMel(1,1);
   DCMel_prof(i,2) = DCMel(1,2);
   DCMel_prof(i,3) = DCMel(1,3);
   DCMel_prof(i,4) = DCMel(2,1);
   DCMel_prof(i,5) = DCMel(2,2);
   DCMel_prof(i,6) = DCMel(2,3);
   DCMel_prof(i,7) = DCMel(3,1);
   DCMel_prof(i,8) = DCMel(3,2);
   DCMel_prof(i,9) = DCMel(3,3);
   
end