使用matlab 将BLH转化为XYZ

BLH表示地球上某一点的纬度、经度和高度，XYZ表示该点在空间直角坐标系中的坐标。将BLH转化为XYZ需要进行以下步骤：

1. 将BLH转化为地心直角坐标系坐标（ECEF坐标）。ECEF坐标系是以地球中心为原点，以地球自转轴为Z轴建立的直角坐标系，其X轴指向本初子午线交点，Y轴指向东经90度，Z轴指向北极点。

2. 将ECEF坐标系坐标转化为空间直角坐标系坐标（XYZ坐标）。空间直角坐标系是以地球自转轴为Z轴，以地球与太阳的连线为X轴建立的直角坐标系，Y轴为X和Z轴的叉积。

以下是使用matlab进行BLH到XYZ坐标的转换示例代码：

% 输入BLH坐标
lat = 39.9; % 纬度，单位：度
lon = 116.4; % 经度，单位：度
h = 50; % 高度，单位：米

% 参数设置
a = 6378137; % 长轴半径，单位：米
b = 6356752.3142; % 短轴半径，单位：米
f = (a - b) / a; % 扁率
e = sqrt(2 * f - f^2); % 第一偏心率
e_ = sqrt(a^2 / b^2 - 1); % 第二偏心率

% 计算地球自转角速度
w = 7.292115e-5; % 地球自转角速度，单位：弧度/秒

% 将BLH转化为弧度
lat = deg2rad(lat);
lon = deg2rad(lon);

% 计算子午线曲率半径
N = a / sqrt(1 - e^2 * sin(lat)^2);

% 计算ECEF坐标系坐标
x = (N + h) * cos(lat) * cos(lon);
y = (N + h) * cos(lat) * sin(lon);
z = (N * (1 - e^2) + h) * sin(lat);

% 计算空间直角坐标系坐标
X = x * cos(w) + y * sin(w);
Y = -x * sin(w) + y * cos(w);
Z = z;

% 输出XYZ坐标
disp(['X: ', num2str(X)]);
disp(['Y: ', num2str(Y)]);
disp(['Z: ', num2str(Z)]);