mecefenu.m

来自「功能极全的GPS开发工具箱」· M 代码 · 共 28 行

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

function   moutput = mecefenu(lat,lon)

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

moutput(1,1) = - slon;
moutput(1,2) =   clon;
moutput(1,3) =   0.;
moutput(2,1) = - slat * clon;
moutput(2,2) = - slat * slon;
moutput(2,3) =   clat;
moutput(3,1) =   clat * clon;
moutput(3,2) =   clat * slon;
moutput(3,3) =   slat;