关于ENU与LLA坐标系互相转换的python代码

原创

于 2024-08-24 10:24:35 发布

· 358 阅读

3 ·

版权

文章标签：

#python #开发语言

关于ENU与LLA坐标系互相转换的python代码

import math

# WGS84 ellipsoid parameters
WGS_PARAMS = {
   
    'a': 6378137,
    'f': 1 / 298.257223563,
    'b': 6378137 * (1 - 1 / 298.257223563),
}
wgs84_a = 6378137
wgs84_b = 6378137 * (1 - 1 / 298.257223563)
wgs84_f = 1 / 298.257223563
# wgs84_f = 1.0 / 298.257223563
pow_e_2 = wgs84_f * (2.0 - wgs84_f)
def deg2radian(deg):
    return (deg * math.pi) / 180.0
def radian2deg(rad):
    return (rad * 180.0) / math.pi
def wgs2ecef(wgs):
    lng_r = deg2radian(wgs['lng'])
    lat_r = deg2radian(wgs['lat'])
    a = WGS_PARAMS['a']
    b = WGS_PARAMS['b']
    N = a ** 2 / math.sqrt(a ** 2 * math.cos(lat_r) ** 2 + b ** 2 * math.sin(lat_r) ** 2)
    x = (N + wgs['alt']) * math.cos(lat_r) * math.cos(lng_r)
    y = (N + wgs['alt']) * math.cos(lat_r) * math.sin(lng_r)
    z = (N * (b / a) ** 2 + wgs['alt']) * math.sin(lat_r)
    return {
   'x': x, 'y': y, 'z': z}

def ecef2wgs(x, y, z):
    a = WGS_PARAMS['a']
    b = WGS_PARAMS[