lg2ct.m

来自「gps matlab 仿真程序（A collection of geodetic」· M 代码 · 共 32 行

function [dX,dY,dZ]=lg2ct(dx,dy,dz,lat,lon)
% LG2CT  Converts local geodetic coordinates to CT.
%   Local origin at lat,lon,h.  If astronomic lat,lon
%   input, then output is in local astronomic system.
%   Vectorized.  See also CT2LG.
% Version: 18 Jan 96
% Useage:  [dX,dY,dZ]=lg2ct(dx,dy,dz,lat,lon)
% Input:   dx  - x coordinate in local system (N)
%          dy  - y coordinate in local system (E)
%          dz  - z coordinate in local system (ht)
% Output:  dX  - X coordinate difference in CT
%          dY  - Y coordinate difference in CT
%          dZ  - Z coordinate difference in CT
%          lat - lat of local system origin (rad)
%          lon - lon of local system origin (rad)
R=zeros(3,3);
R(1,1)=-sin(lat).*cos(lon);
R(2,1)=-sin(lat).*sin(lon);
R(3,1)=cos(lat);
R(1,2)=-sin(lon);
R(2,2)=cos(lon);
R(3,2)=0;
R(1,3)=cos(lat).*cos(lon);
R(2,3)=cos(lat).*sin(lon);
R(3,3)=sin(lat);
dX=R(1,:)*[dx';dy';dz'];
dY=R(2,:)*[dx';dy';dz'];
dZ=R(3,:)*[dx';dy';dz'];
dX=dX';
dY=dY';
dZ=dZ';