vllwenu.m

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

%                                vllwenu.m
%  Scope:   This MATLAB macro performs the transformation from wander azimuth 
%           local level frame to ENU (East, North, Up) frame for a given 
%           position vector and a reference wander azimuth angle.
%  Usage:   penu = vllwenu(pllw,waz)
%  Description of parameters:
%           pllw  -  input, local level wander azimuth position vector (with 
%                    components in meters)
%           waz   -  input, wander azimuth angle in radians
%           penu  -  output, ENU 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   penu = vllwenu(pllw,waz)

swaz = sin(waz);
cwaz = cos(waz);

penu = zeros(3,1);
penu(1) = cwaz * pllw(1) - swaz * pllw(2);
penu(2) = swaz * pllw(1) + cwaz * pllw(2);
penu(3) = pllw(3);