latlonhgttoxyz.m

地心地固坐标系到大地坐标系的转换算法

function [x,y,z] = LatLonHgtToXYZ(lat,lon,hgt)
    a = 6378137.0E0;
    e = 0.0818191908426E0;
    ome2 = 0.99330562000987;
    clat = cos(lat);
    slat = sin(lat);
    clon = cos(lon);
    slon = sin(lon);
    d = e*slat;

    n = a/sqrt(1.0E0-d*d);
    nph = n + hgt;

    x = nph*clat*clon;
    y = nph*clat*slon;
    z = (ome2*n+hgt)*slat;