Implementé una función de distancia WGS84 usando la media de la altitud de inicio y final como la altitud constante. Si está seguro de que habrá relativamente poca variación de altitud a lo largo de su camino, esto funciona aceptablemente bien (el error es relativo a la diferencia de altitud de sus dos puntos LLA).
Aquí está mi código (C#):
/// <summary>
/// Gets the geodesic distance between two pathpoints in the current mode's coordinate system
/// </summary>
/// <param name="point1">First point</param>
/// <param name="point2">Second point</param>
/// <param name="mode">Coordinate mode that both points are in</param>
/// <returns>Distance between the two points in the current coordinate mode</returns>
public static double GetGeodesicDistance(PathPoint point1, PathPoint point2, CoordMode mode) {
// calculate proper geodesics for LLA paths
if (mode == CoordMode.LLA) {
// meeus approximation
double f = (point1.Y + point2.Y)/2 * LatLonAltTransformer.DEGTORAD;
double g = (point1.Y - point2.Y)/2 * LatLonAltTransformer.DEGTORAD;
double l = (point1.X - point2.X)/2 * LatLonAltTransformer.DEGTORAD;
double sinG = Math.Sin(g);
double sinL = Math.Sin(l);
double sinF = Math.Sin(f);
double s, c, w, r, d, h1, h2;
// not perfect but use the average altitude
double a = (LatLonAltTransformer.A + point1.Z + LatLonAltTransformer.A + point2.Z)/2.0;
sinG *= sinG;
sinL *= sinL;
sinF *= sinF;
s = sinG * (1 - sinL) + (1 - sinF) * sinL;
c = (1 - sinG) * (1 - sinL) + sinF * sinL;
w = Math.Atan(Math.Sqrt(s/c));
r = Math.Sqrt(s * c)/w;
d = 2 * w * a;
h1 = (3 * r - 1)/2/c;
h2 = (3 * r + 1)/2/s;
return d * (1 + (1/LatLonAltTransformer.RF) * (h1 * sinF * (1 - sinG) - h2 * (1 - sinF) * sinG));
}
PathPoint diff = new PathPoint(point2.X - point1.X, point2.Y - point1.Y, point2.Z - point1.Z, 0);
return Math.Sqrt(diff.X * diff.X + diff.Y * diff.Y + diff.Z * diff.Z);
}
En la práctica hemos encontrado que la diferencia de altitud rara vez se hace una gran diferencia, nuestros caminos son típicamente 1-2 km de largo con la altitud que varía del orden de 100 metros y vemos aproximadamente ~ 5m de cambio en promedio versus el uso del elipsoide WGS84 sin modificar.
Editar:
Para añadir a esto, si lo hace esperar grandes cambios de altitud, puede convertir su coordenadas WGS84 a ECEF (tierra centrada tierra fija) y evaluar trayectorias en línea recta como se muestra en la parte inferior de mi función. Conversión de un punto a ECEF es simple de hacer:
/// <summary>
/// Converts a point in the format (Lon, Lat, Alt) to ECEF
/// </summary>
/// <param name="point">Point as (Lon, Lat, Alt)</param>
/// <returns>Point in ECEF</returns>
public static PathPoint WGS84ToECEF(PathPoint point) {
PathPoint outPoint = new PathPoint(0);
double lat = point.Y * DEGTORAD;
double lon = point.X * DEGTORAD;
double e2 = 1.0/RF * (2.0 - 1.0/RF);
double sinLat = Math.Sin(lat), cosLat = Math.Cos(lat);
double chi = A/Math.Sqrt(1 - e2 * sinLat * sinLat);
outPoint.X = (chi + point.Z) * cosLat * Math.Cos(lon);
outPoint.Y = (chi + point.Z) * cosLat * Math.Sin(lon);
outPoint.Z = (chi * (1 - e2) + point.Z) * sinLat;
return outPoint;
}
Edición 2:
me preguntó acerca de algunas de las otras variables en mi código:
// RF is the eccentricity of the WGS84 ellipsoid
public const double RF = 298.257223563;
// A is the radius of the earth in meters
public const double A = 6378137.0;
LatLonAltTransformer
es una clase Solía para convertir de coordenadas LatLonAlt a coordenadas ECEF y define las constantes anteriores.
No he visto las ecuaciones WGS84, así que no estoy escribiendo esto como una respuesta. Dicho esto, me parece que deberías poder ajustar un radio o dos para hacer que tus puntos de medición sean la "nueva" superficie. Esto probablemente funcione mejor si sus mediciones de altitud están basadas en GPS; si se basa en medios mecánicos (por ejemplo, presión del aire), entonces el "nivel del mar" puede tener muy poca relación con el modelo de geoide. – kdgregory
¿Alguna vez se le ocurrió una buena solución para esto? – lnafziger