ct2lg.m

GPS相关工具

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