在Unity3D中将纬度/经度/高度转换为XYZ坐标

using UnityEngine;

public class GPSToXYZConverter : MonoBehaviour
{
    // 地球的半长轴
    private const double EarthSemiMajorAxis = 6378137.0;
    // 地球的扁率
    private const double EarthFlattening = 1 / 298.257223563;

    // 将纬度/经度/高度转换为XYZ坐标
    public Vector3 ConvertGPSToXYZ(double latitude, double longitude, double altitude)
    {
        // 将纬度/经度/高度转换为WGS84坐标系
        double x = (altitude + EarthSemiMajorAxis) * Mathf.Cos((float)latitude) * Mathf.Cos((float)longitude);
        double y = (altitude + EarthSemiMajorAxis) * Mathf.Cos((float)latitude) * Mathf.Sin((float)longitude);
        double z = (altitude + EarthSemiMajorAxis * (1 - EarthFlattening)) * Mathf.Sin((float)latitude);

        // 将WGS84坐标转换为ECEF坐标
        double sinLat = Mathf.Sin((float)latitude);
        double cosLat = Mathf.Cos((float)latitude);
        double sinLon = Mathf.Sin((float)longitude);
        double cosLon = Mathf.Cos((float)longitude);
        double ecefX = (EarthSemiMajorAxis * cosLat * cosLon) + x;
        double ecefY = (EarthSemiMajorAxis * cosLat * sinLon) + y;
        double ecefZ = (EarthSemiMajorAxis * (1 - EarthFlattening) * sinLat) + z;

        // 将ECEF坐标转换为Unity3D中的XYZ坐标
        float unityX = (float)ecefZ;
        float unityY = (float)-ecefX;
        float unityZ = (float)ecefY;

        return new Vector3(unityX, unityY, unityZ);
    }
}