c++enu转ecef代码

以下是C语言实现ENU转ECEF的代码示例：

#include <stdio.h>
#include <math.h>

#define PI 3.14159265358979323846
#define a 6378137.0
#define f 0.0033528106647474805
#define b (a * (1 - f))

void ENUtoECEF(double lat, double lon, double alt, double E, double N, double U, double *x, double *y, double *z)
{
    double sinLat = sin(lat * PI / 180);
    double cosLat = cos(lat * PI / 180);
    double sinLon = sin(lon * PI / 180);
    double cosLon = cos(lon * PI / 180);
    double e2 = f * (2 - f);
    double N_phi = a / sqrt(1 - e2 * sinLat * sinLat);
    double x_phi = (N_phi + alt) * cosLat * cosLon;
    double y_phi = (N_phi + alt) * cosLat * sinLon;
    double z_phi = (N_phi * (1 - e2) + alt) * sinLat;
    *x = -sinLon * E - cosLon * sinLat * N + cosLon * cosLat * U + x_phi;
    *y = cosLon * E - sinLon * sinLat * N + cosLat * sinLon * U + y_phi;
    *z = cosLat * N + sinLat * U + z_phi;
}

int main()
{
    double lat = 30.0; // 纬度
    double lon = 120.0; // 经度
    double alt = 100.0; // 高度
    double E = 1000.0; // 东向距离
    double N = 2000.0; // 北向距离
    double U = 3000.0; // 天向距离
    double x, y, z;
    ENUtoECEF(lat, lon, alt, E, N, U, &x, &y, &z);
    printf("ECEF坐标：%.6f, %.6f, %.6f\n", x, y, z);
    return 0;
}

该代码使用WGS84椭球模型进行ENU转ECEF计算。其中，a、f分别代表椭球长半轴和扁率，b代表椭球短半轴。ENUtoECEF函数接受一个ENU坐标和一个经纬度高程，返回对应的ECEF坐标。在主函数中，我们将输入的经纬度和ENU坐标作为参数传递给函数，并输出计算结果。