geo22cart.m

用matlab将弹道坐标系转换为WGS84中的直角坐标

%地理坐标系想空间直角坐标系的转换
function  [x2,y2,z2]=geo22cart(X,Y,Z)

 
  bold=39.9583*pi/180;
  lold=116.3090*pi/180;
  hold=0;
  [x2old, y2old, z2old]=geo2cart(bold,lold,hold);
  Xold=0;
  Yold=0;
  Zold=0;
  
  x2=-sin(bold)*cos(lold)*(X-Xold) -sin(lold)*(Y-Yold)+cos(bold)*cos(lold)*( Z-Zold)+x2old;
  y2=-sin(bold)*sin(lold)*(X-Xold)+cos(lold)*(Y-Yold)+cos(bold)*sin(lold)*( Z-Zold)+y2old;
  z2=cos(bold)*(X-Xold)+ sin(bold)*( Z-Zold)+z2old;