mllwenu.m

GPS TOOLBOX包含以下内容： 1、GPS相关常量和转换因子； 2、角度变换； 3、坐标系转换： &#61656 点变换； &#61656 矩阵变换； &#61656 向量变换

%                                mllwenu.m
%  Scope:   This MATLAB macro constructs the transformation matrix from LLWA 
%           (Local Level Wander Azimuth) frame to ENU (East, North, Up) frame.
%  Usage:   moutput = mllwenu(waz)
%  Description of parameters:
%           waz      -  input, wander azimuth angle in radians
%           moutput  -  output, two-dimensional real array containing the 
%                       transformation matrix from LLWA frame to ENU frame
%  Remark:  The coordinate axes for local level wander azimuth 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/05/00
%  Copyright (C) 1996-00 by LL Consulting. All Rights Reserved.

function   moutput = mllwenu(waz)

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

moutput(1,1) =   cwaz;
moutput(1,2) = - swaz;
moutput(1,3) =     0.;
moutput(2,1) =   swaz;
moutput(2,2) =   cwaz;
moutput(2,3) =     0.;
moutput(3,1) =     0.;
moutput(3,2) =     0.;
moutput(3,3) =     1.;