ecef_g.m

来自「RAIM 完好性分析」· M 代码 · 共 11 行

function [xg,yg,zg]=ecef_g(long,lat,xe,ye,ze)

%*********************************
% ** 将用户坐标从地心地固转到用户水平坐标系
% ** long经度 lat纬度 
% **********************************

trans=2*pi/360;
xg=cos(trans*long)*ye-sin(trans*long)*xe;                % 公式
yg=cos(trans*lat)*ze-sin(trans*lat)*cos(trans*long)*xe-sin(trans*lat)*sin(trans*long)*ye;
zg=cos(trans*lat)*cos(trans*long)*xe+cos(trans*lat)*sin(trans*long)*ye+sin(trans*lat)*ze-6378137;