venugd.m

来自「GPS software toolbox for GPS receiver de」· M 代码 · 共 25 行

%                                venugd.m
%  Scope:   This MATLAB macro performs the transformation from ENU (East, 
%           North, Up) to geodetic coordinates for a given position vector 
%           and a reference point.
%  Usage:   pgd = venugd(penu,pgdref)
%  Description of parameters:
%           penu  -  input, ENU position vector, with components in meters
%           pgdref - input, geodetic position of the reference point, where
%                    pgdref(1) = latitude in radians
%                    pgdref(2) = longitude in radians
%                    pgdref(3) = altitude in meters
%           pgd    - output, geodetic position of the final point, where
%                    pgd(1) = latitude in radians
%                    pgd(2) = longitude in radians
%                    pgd(3) = altitude in meters
%  External Matlab macros used:  tecefgd, tgdecef, venuecef
%  Last update:  04/04/00
%  Copyright (C) 1996-00 by LL Consulting. All Rights Reserved.

function   pgd = venugd(penu,pgdref)

pecef = venuecef(penu,pgdref(1),pgdref(2));
pecefref = tgdecef(pgdref(1),pgdref(2),pgdref(3));
temp = pecef + pecefref;
[pgd(1),pgd(2),pgd(3)] = tecefgd(temp);