高斯投影正反算快速实现

代码中有详细的注释，大家可以参考着看

import math
# 建立大地坐标系转换为空间坐标系的函数方法
def LatLon2XY(latitude, longitude):
    a = 6378137.0  # 长轴
    e2 = 0.0066943799013  # 第一偏心率的平方
# 将经纬度转换为弧度
    latitude2Rad = (math.pi / 180.0) * latitude
    beltNo = int((longitude + 1.5) / 3.0)  # 计算3度带投影度带号
    L = beltNo * 3  # 计算中央经线
    l0 = longitude - L  # 经差
    tsin = math.sin(latitude2Rad)
    tcos = math.cos(latitude2Rad)
    t = math.tan(latitude2Rad)
    m = (math.pi / 180.0) * l0 * tcos
    et2 = e2 * pow(tcos, 2)
    et3 = e2 * pow(tsin, 2)
    X = 111132.9558 * latitude - 16038.6496 * math.sin(2 * latitude2Rad) + 16.8607 * math.sin(4 * latitude2Rad) - 0.0220 * math.sin(6 * latitude2Rad)
    N = a / math.sqrt(1 - et3)
    x = X + N * t * (0.5 * pow(m, 2) + (5.0 - pow(t, 2) + 9.0 * et2 + 4 * pow(et2, 2)) * pow(m, 4) / 24.0 + (
        61.0 - 58.0 * pow(t, 2) + pow(t, 4)) * pow(m, 6) / 720.0)
    y = 500000 + N * (m + (1.0 - pow(t, 2) + et2) * pow(m, 3) / 6.0 + (
        5.0 - 18.0 * pow(t, 2) + pow(t, 4) + 14.0 * et2 - 58.0 * et2 * pow(t, 2)) * pow(m, 5) / 120.0)
    return x, y

# 建立空间坐标系转换为大地坐标系
def XY2LatLon(X, Y, L0):
    iPI = 0.0174532925199433
    a = 6378137.0
    f = 0.00335281006247
    ZoneWide = 3 # 按3度带进行投影
    ProjNo = int(Y / 1000000)
    L0 = L0 * iPI
    X0 = ProjNo * 1000000 + 500000  # 加500KM
    Y0 = 0
    xval = Y - X0
    yval = X - Y0
    e2 = 2 * f - f * f  # 第一偏心率平方
    e1 = (1.0 - math.sqrt(1 - e2)) / (1.0 + math.sqrt(1 - e2))
    ee = e2 / (1 - e2)  # 第二偏心率平方
    M = yval
    u = M / (a * (1 - e2 / 4 - 3 * e2 * e2 / 64 - 5 * e2 * e2 * e2 / 256))
    fi = u + (3 * e1 / 2 - 27 * e1 * e1 * e1 / 32) * math.sin(2 * u) \
            + (21 * e1 * e1 / 16 - 55 * e1 * e1 * e1 * e1 / 32) * math.sin(4 * u) \
            + (151 * e1 * e1 * e1 / 96) * math.sin(6 * u)\
            + (1097 * e1 * e1 * e1 * e1 / 512) * math.sin(8 * u)
    C = ee * math.cos(fi) * math.cos(fi)
    T = math.tan(fi) * math.tan(fi)
    NN = a / math.sqrt(1.0 - e2 * math.sin(fi) * math.sin(fi))
    R = a * (1 - e2) / math.sqrt(
        (1 - e2 * math.sin(fi) * math.sin(fi)) * (1 - e2 * math.sin(fi) * math.sin(fi)) * (1 - e2 * math.sin(fi) * math.sin(fi)))
    d = xval / NN
# 计算经纬度（弧度单位的经纬度）
    longitude1 = L0 + (d - (1 + 2 * T + C) * d * d * d / 6 + (
                5 - 2 * C + 28 * T - 3 * C * C + 8 * ee + 24 * T * T) * d * d * d * d * d / 120) / math.cos(fi)
    latitude1 = fi - (NN * math.tan(fi) / R) * (
                d * d / 2 - (5 + 3 * T + 10 * C - 4 * C * C - 9 * ee) * d * d * d * d / 24 + (
                61 + 90 * T + 298 * C + 45 * T * T - 256 * ee - 3 * C * C) * d * d * d * d * d * d / 720)
# 换换为deg
    longitude = longitude1 / iPI
    latitude = latitude1 / iPI
    return latitude, longitude


print("大地坐标系转换为空间坐标系：")
print(LatLon2XY(31, 116.33333334))
print("空间坐标系转换为大地坐标系：")
print(XY2LatLon(3431165.108007392, 436329.8127362341, 117.0))

实现的结果如下：

大地坐标系转换为空间坐标系：
(3431165.108007392, 436329.8127362341)
空间坐标系转换为大地坐标系：
(30.99999996427224, 116.33333334051636)