dcm2llw.m

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

function llw_vect = dcm2llw(DCMel)
  if nargin<1,error('insufficient number of input arguments'),end
%计算出载体所在的地理位置纬度lat、经度long和航向角alpha。输入值是当地地理系到地球系的方向余弦阵DCMel。
  lat = asin(DCMel(3,3));
  long = atan2(DCMel(3,2),DCMel(3,1));
  alpha = atan2(DCMel(1,3),DCMel(2,3));
  
  llw_vect(1) = lat;
  llw_vect(2) = long;
  llw_vect(3) = alpha;