dcm2llw.asv

来自「惯性导航系统传递对准系统模型程序」· ASV 代码 · 共 10 行

function llw_vect = dcm2llw(DCMel)
  if nargin<1,error('insufficient number of input arguments'),end
%
  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;