xyz坐标转blh坐标matlab代码

以下是 Matlab 代码，用于将 XYZ 坐标转换为 BLH 坐标：

function [lat,lon,h] = xyz2blh(x,y,z,a,e)
% XYZ to BLH conversion
% x, y, z: Cartesian coordinates (m)
% a: semi-major axis of the ellipsoid (m)
% e: eccentricity of the ellipsoid
% lat, lon: geodetic coordinates (deg)
% h: ellipsoidal height (m)

b = a*sqrt(1-e^2);          % semi-minor axis
p = sqrt(x^2 + y^2);        % distance from the origin to the XY projection
theta = atan2(z*a,p*b);     % inclination angle
lon = atan2(y,x);           % longitude
lat = atan2((z + e^2*b*sin(theta)^3),(p - e^2*a*cos(theta)^3)); % latitude
N = a./sqrt(1-e^2*sin(lat)^2);
h = p./cos(lat) - N;        % ellipsoidal height
lat = rad2deg(lat);         % convert to degrees
lon = rad2deg(lon);
end

其中 `x`、`y`、`z` 是输入的 XYZ 坐标（单位为米），`a` 是地球的半长轴（单位为米），`e` 是地球的第一偏心率。`lat`、`lon`、`h` 是输出的经度、纬度和高程（单位为度和米）。