ecef_g.m

北京到广州铁路路线仿真

function [xg,yg,zg]=ecef_g(long,lat,xe,ye,ze,xu,yu,zu)
%将用户坐标从地心地固转到用户水平坐标系
trans=2*pi/360;

xg=cos(trans*long)*(ye-yu)-sin(trans*long)*(xe-xu);                % 公式
yg=cos(trans*lat)*(ze-zu)-sin(trans*lat)*cos(trans*long)*(xe-xu)-sin(trans*lat)*sin(trans*long)*(ye-yu);
zg=cos(trans*lat)*cos(trans*long)*(xe-xu)+cos(trans*lat)*sin(trans*long)*(ye-yu)+sin(trans*lat)*(ze-zu);