vllwecef.m

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

%                              vllwecef.m
%  Scope:   This MATLAB macro performs the transformation from wander azimuth 
%           local level frame to ECEF frame for a given position vector and
%           reference latitude/longitude/wander azimuth angles. 
%  Usage:   pecef = vllwecef(pllw,lat,lon,waz)
%  Description of parameters:
%           pllw  -  input, local level wander azimuth position vector (with 
%                    components in meters) 
%           lat   -  input, reference latitude in radians
%           lon   -  input, reference longitude in radians
%           waz   -  input, reference wander azimuth angle in radians
%           pecef -  output, ECEF position vector, with components in same 
%                    units as the input local level wander azimuth position 
%                    vector
% Remark:   The coordinate axes for wander azimuth local level frame are 
%           defined as follows:
%           x - axis at wander azimuth angle counter-clockwise from East in
%               local level plane,
%           y - axis at wander azimuth angle counter-clockwise from North in
%               local level plane,
%           z - axis upward along local normal
%  Last update:  04/04/00
%  Copyright (C) 1996-00 by LL Consulting. All Rights Reserved.

function   pecef = vllwecef(pllw,lat,lon,waz)

slat = sin(lat);
clat = cos(lat);
slon = sin(lon);
clon = cos(lon);
swaz = sin(waz);
cwaz = cos(waz);

temp1 = swaz * pllw(1) + cwaz * pllw(2);
temp2 = cwaz * pllw(1) - swaz * pllw(2);
temp3 = - slat * temp1 + clat * pllw(3);

pecef = zeros(3,1);
pecef(1) = - slon * temp2 + clon * temp3;
pecef(2) = slon * temp3 + clon * temp2;
pecef(3) = clat * temp1 + slat * pllw(3);