计算结果一直为egm96_geoid_height:1.43174e+07 代码算法不正确

非常抱歉给您造成了困扰，可能是因为代码中的一些问题导致了计算结果不正确。我们可以尝试使用另一种方法来计算大地高。

在C语言中，可以使用EGM96的高斯反算公式来计算大地高。以下是示例代码：

#include <math.h>

#define EGM96_A 6378136.3 // EGM96椭球体长半轴
#define EGM96_F 0.00335281969 // EGM96椭球体扁率

double egm96_geoid_height(double lat, double lon, double height) {
    double sin_lat = sin(lat);
    double cos_lat = cos(lat);
    double sin_lon = sin(lon);
    double cos_lon = cos(lon);
    double N = EGM96_A / sqrt(1.0 - EGM96_F * (2.0 - EGM96_F) * sin_lat * sin_lat);
    double X = (N + height) * cos_lat * cos_lon;
    double Y = (N + height) * cos_lat * sin_lon;
    double Z = (N * (1.0 - EGM96_F * EGM96_F) + height) * sin_lat;
    double X0, Y0, Z0;
    double dX, dY, dZ;
    double R;
    double lat0, lon0, h0;
    double sin_lat0, cos_lat0, sin_lon0, cos_lon0;

    // 定义EGM96的重心参数
    X0 = 0.0;
    Y0 = 0.0;
    Z0 = 0.0;

    // 定义EGM96椭球体参数
    double a = EGM96_A;
    double b = EGM96_A * (1.0 - EGM96_F);

    // 定义迭代精度
    double eps = 1e-9;

    // 迭代计算大地高
    do {
        lat0 = atan(Z / sqrt(X * X + Y * Y));
        sin_lat0 = sin(lat0);
        cos_lat0 = cos(lat0);
        lon0 = atan2(Y, X);
        sin_lon0 = sin(lon0);
        cos_lon0 = cos(lon0);
        R = sqrt(X * X + Y * Y + Z * Z);
        dX = -a * sin_lat0 * cos_lon0;
        dY = -a * sin_lat0 * sin_lon0;
        dZ = b * cos_lat0;
        X0 += dX;
        Y0 += dY;
        Z0 += dZ;
    } while (sqrt(dX * dX + dY * dY + dZ * dZ) > eps);

    h0 = sqrt(X0 * X0 + Y0 * Y0 + Z0 * Z0) - R;

    return h0;
}

这段代码中，`lat`为当前位置的纬度，`lon`为当前位置的经度，`height`为当前位置的WGS84椭球面高。函数返回当前位置的EGM96数值。

需要注意的是，这里使用的是EGM96模型，也可以使用其他的数学模型来描述大地水准面的形状，不同的模型之间可能会有一定的误差。

如果您仍然发现计算结果不正确，请告诉我更多信息，我将尽力帮助您解决问题。