/usr/include/simgear/math/sg_geodesy.hxx is in libsimgear-dev 3.4.0-3.
This file is owned by root:root, with mode 0o644.
The actual contents of the file can be viewed below.
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 | #ifndef _SG_GEODESY_HXX
#define _SG_GEODESY_HXX
#include "SGMath.hxx"
// Compatibility header.
// Please use the SGGeodesy and SGMath functions directly.
/**
* Convert from geodetic coordinates to geocentric coordinates.
* WARNING: this function is non-reversible. Due to the fact that
* "up" is a different direction for geocentric and geodetic frames,
* you can not simply add your "alt" parameter to the "sl_radius"
* result and get back (via sgGeodToGeoc()) to the coordinates you
* started with. The error under normal conditions will be of
* centimeter order; whether that is important or not is application
* dependent. Consider using sgGeodToCart() instead.
*
* @param lat_geod (in) Geodetic latitude, radians, + = North
* @param alt (in) C.G. altitude above mean sea level (meters)
* @param sl_radius (out) SEA LEVEL radius to earth center (meters)
* @param lat_geoc (out) Geocentric latitude, radians, + = North
*/
inline void sgGeodToGeoc(double lat_geod, double alt,
double *sl_radius, double *lat_geoc)
{
SGVec3<double> cart;
SGGeod geod = SGGeod::fromRadM(0, lat_geod, alt);
SGGeodesy::SGGeodToCart(geod, cart);
SGGeoc geoc;
SGGeodesy::SGCartToGeoc(cart, geoc);
*lat_geoc = geoc.getLatitudeRad();
*sl_radius = SGGeodesy::SGGeodToSeaLevelRadius(geod);
}
/**
* Convert a cartesian point to a geodetic lat/lon/altitude.
*
* @param xyz (in) Pointer to cartesian point.
* @param lat (out) Latitude, in radians
* @param lon (out) Longitude, in radians
* @param alt (out) Altitude, in meters above the WGS84 ellipsoid
*/
inline void sgCartToGeod(const double* xyz, double* lat, double* lon, double* alt)
{
SGGeod geod;
SGGeodesy::SGCartToGeod(SGVec3<double>(xyz), geod);
*lat = geod.getLatitudeRad();
*lon = geod.getLongitudeRad();
*alt = geod.getElevationM();
}
/**
* Convert a geodetic lat/lon/altitude to a cartesian point.
*
* @param lat (in) Latitude, in radians
* @param lon (in) Longitude, in radians
* @param alt (in) Altitude, in meters above the WGS84 ellipsoid
* @param xyz (out) Pointer to cartesian point.
*/
inline void sgGeodToCart(double lat, double lon, double alt, double* xyz)
{
SGVec3<double> cart;
SGGeodesy::SGGeodToCart(SGGeod::fromRadM(lon, lat, alt), cart);
xyz[0] = cart(0);
xyz[1] = cart(1);
xyz[2] = cart(2);
}
/**
* Given a starting position and an offset radial and distance,
* calculate an ending positon on a wgs84 ellipsoid.
* @param alt (in) meters (unused)
* @param lat1 (in) degrees
* @param lon1 (in) degrees
* @param az1 (in) degrees
* @param s (in) distance in meters
* @param lat2 (out) degrees
* @param lon2 (out) degrees
* @param az2 (out) return course in degrees
*/
inline int geo_direct_wgs_84 ( double lat1, double lon1, double az1,
double s, double *lat2, double *lon2,
double *az2 )
{
SGGeod p2;
if (!SGGeodesy::direct(SGGeod::fromDeg(lon1, lat1), az1, s, p2, *az2))
return 1;
*lat2 = p2.getLatitudeDeg();
*lon2 = p2.getLongitudeDeg();
return 0;
}
inline int geo_direct_wgs_84 ( double alt, double lat1,
double lon1, double az1,
double s, double *lat2, double *lon2,
double *az2 )
{ return geo_direct_wgs_84(lat1, lon1, az1, s, lat2, lon2, az2); }
/**
* Given a starting position and an offset radial and distance,
* calculate an ending positon on a wgs84 ellipsoid.
* @param p1 (in) geodetic position
* @param az1 (in) degrees
* @param s (in) distance in meters
* @param p2 (out) geodetic position
* @param az2 (out) return course in degrees
*/
inline int geo_direct_wgs_84(const SGGeod& p1, double az1,
double s, SGGeod& p2, double *az2 )
{
return !SGGeodesy::direct(p1, az1, s, p2, *az2);
}
/**
* Given an altitude and two sets of (lat, lon) calculate great circle
* distance between them as well as the starting and ending azimuths.
* @param alt (in) meters (unused)
* @param lat1 (in) degrees
* @param lon1 (in) degrees
* @param lat2 (in) degrees
* @param lon2 (in) degrees
* @param az1 (out) start heading degrees
* @param az2 (out) end heading degrees
* @param s (out) distance meters
*/
inline int geo_inverse_wgs_84( double lat1, double lon1, double lat2,
double lon2, double *az1, double *az2,
double *s )
{
return !SGGeodesy::inverse(SGGeod::fromDeg(lon1, lat1),
SGGeod::fromDeg(lon2, lat2), *az1, *az2, *s);
}
inline int geo_inverse_wgs_84( double alt, double lat1,
double lon1, double lat2,
double lon2, double *az1, double *az2,
double *s )
{ return geo_inverse_wgs_84(lat1, lon1, lat2, lon2, az1, az2, s); }
/**
* Given an altitude and two sets of (lat, lon) calculate great circle
* distance between them as well as the starting and ending azimuths.
* @param p1 (in) first position
* @param p2 (in) fsecond position
* @param az1 (out) start heading degrees
* @param az2 (out) end heading degrees
* @param s (out) distance meters
*/
inline int geo_inverse_wgs_84(const SGGeod& p1, const SGGeod& p2,
double *az1, double *az2, double *s )
{
return !SGGeodesy::inverse(p1, p2, *az1, *az2, *s);
}
#endif // _SG_GEODESY_HXX
|