vs85ecef.m

来自「GPS TOOLBOX包含以下内容： 1、GPS相关常量和转换因子； 2、角」· M 代码 · 共 25 行

%                              vs85ecef.m
%  Scope:   This MATLAB macro performs the transformation from SGS-85 (Soviet 
%           Geodetic System 1985) frame to ECEF WGS-84 frame coordinates for a 
%           given position vector with components expressed in meters.
%  Usage:   pecef = vs85ecef(psgs85)
%  Description of parameters:
%           psgs85 -  input, SGS-85 frame position vector, with components in 
%                     meters
%           pecef  -  output, ECEF (WGS-84) position vector with components in 
%                     meters
%  Reference:
%           [1] Misra, P. N., Abbott, R. I., SGS85 - WGS84 transformation. 
%               Manuscripta geodaetica, Vol. 19, 1994, pp. 300-308.
%  Last update:  04/04/00
%  Copyright (C) 1997-00 by LL Consulting. All Rights Reserved.

function   pecef = vs85ecef(psgs85)

rotangle = 3.0e-6;       %  rotation angle in radians
d = 4.0;                 %  translation distance in meters

pecef = zeros(3,1);
pecef(1) = psgs85(1) - psgs85(2) * rotangle;
pecef(2) = psgs85(1) * rotangle + psgs85(2);
pecef(3) = psgs85(3) + d;