GNSS xyz转经纬高 Qt代码

以下是一个简单的示例代码，可以将GNSS的xyz坐标转换为经纬高：

#include <QtCore>
#include <QtMath>

struct XYZ {
    double x;
    double y;
    double z;
};

struct LLA {
    double lat;
    double lon;
    double alt;
};

LLA xyzToLla(const XYZ& xyz)
{
    const double a = 6378137.0;
    const double b = 6356752.314245;
    const double f = (a - b) / a;
    const double e = sqrt(1 - pow(b / a, 2));

    double p = sqrt(pow(xyz.x, 2) + pow(xyz.y, 2));
    double theta = atan2(xyz.z * a, p * b);

    double lon = atan2(xyz.y, xyz.x);
    double lat = atan2(xyz.z + pow(e, 2) * b * pow(sin(theta), 3),
                       p - pow(e, 2) * a * pow(cos(theta), 3));
    double N = a / sqrt(1 - pow(e, 2) * pow(sin(lat), 2));
    double alt = p / cos(lat) - N;

    lat *= 180 / M_PI;
    lon *= 180 / M_PI;

    return {lat, lon, alt};
}

int main()
{
    XYZ xyz = {1000000, 2000000, 3000000};
    LLA lla = xyzToLla(xyz);

    qDebug() << "Latitude:" << lla.lat << "Longitude:" << lla.lon << "Altitude:" << lla.alt;

    return 0;
}

在这个示例中，我们使用WGS84椭球模型来计算经纬高。可以根据实际情况更改模型。