minsecef.m

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

%                                minsecef.m
%  Scope:   This MATLAB macro constructs the transformation matrix from INS 
%           (Wander / North West Up) frame to ECEF frame.
%  Usage:   moutput = minsecef(lat,lon,waz)
%  Description of parameters:
%           lat      -  input, reference latitude in radians
%           lon      -  input, reference longitude in radians
%           waz      -  input, wander azimuth angle in radians
%           moutput  -  output, two-dimensional real array containing the 
%                       transformation matrix from INS frame to ECEF frame
%  Last update: 04/05/00
%  Copyright (C) 1996-00 by LL Consulting. All Rights Reserved.

function   moutput = minswecef(lat,lon,waz)

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

moutput(1,1) = - cwaz * clon * slat + swaz * slon; 
moutput(1,2) =   swaz * clon * slat + cwaz * slon;
moutput(1,3) =   clon * clat;
moutput(2,1) = - cwaz * slon * slat - swaz * clon;
moutput(2,2) =   swaz * slon * slat - cwaz * clon;
moutput(2,3) =   slon * clat;
moutput(3,1) =   cwaz * clat;
moutput(3,2) = - swaz * clat;
moutput(3,3) =   slat;