xyz与BLH坐标系转换python代码

以下是将xyz坐标系转换为BLH坐标系的Python代码：

import math

def xyz_to_blh(x, y, z):
    a = 6378137.0  # 地球长半轴
    b = 6356752.3142  # 地球短半轴
    e = math.sqrt(1 - (b / a) ** 2)  # 地球第一偏心率
    e2 = math.sqrt((a / b) ** 2 - 1)  # 地球第二偏心率

    p = math.sqrt(x ** 2 + y ** 2)  # 计算距离
    theta = math.atan2(z * a, p * b)  # 计算纬度角

    lon = math.atan2(y, x)  # 计算经度角
    lat = math.atan2(z + e2 ** 2 * b * math.sin(theta) ** 3, p - e ** 2 * a * math.cos(theta) ** 3)  # 计算纬度

    N = a / math.sqrt(1 - e ** 2 * math.sin(lat) ** 2)  # 计算子午圈半径

    h = p / math.cos(lat) - N  # 计算高度

    # 将弧度转换为角度
    lon = math.degrees(lon)
    lat = math.degrees(lat)

    return lat, lon, h

以下是将BLH坐标系转换为xyz坐标系的Python代码：

def blh_to_xyz(lat, lon, h):
    a = 6378137.0  # 地球长半轴
    b = 6356752.3142  # 地球短半轴
    e = math.sqrt(1 - (b / a) ** 2)  # 地球第一偏心率

    N = a / math.sqrt(1 - e ** 2 * math.sin(math.radians(lat)) ** 2)  # 计算子午圈半径

    x = (N + h) * math.cos(math.radians(lat)) * math.cos(math.radians(lon))  # 计算x坐标
    y = (N + h) * math.cos(math.radians(lat)) * math.sin(math.radians(lon))  # 计算y坐标
    z = (N * (1 - e ** 2) + h) * math.sin(math.radians(lat))  # 计算z坐标

    return x, y, z

注意，这两个函数中的经纬度坐标和高度单位为度和米。