ecef_g.m

GPS/GALILEO/BEIDOU兼容接收机自主完好性检测程序

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;