1 // Copyright (C) 2006 Mathias Froehlich - Mathias.Froehlich@web.de
3 // This library is free software; you can redistribute it and/or
4 // modify it under the terms of the GNU Library General Public
5 // License as published by the Free Software Foundation; either
6 // version 2 of the License, or (at your option) any later version.
8 // This library is distributed in the hope that it will be useful,
9 // but WITHOUT ANY WARRANTY; without even the implied warranty of
10 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 // Library General Public License for more details.
13 // You should have received a copy of the GNU General Public License
14 // along with this program; if not, write to the Free Software
15 // Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
21 #include <simgear/constants.h>
23 // #define SG_GEOC_NATIVE_DEGREE
25 /// Class representing a geocentric location
28 /// Default constructor, initializes the instance to lat = lon = lat = 0
31 /// Factory from angular values in radians and radius in ft
32 static SGGeoc fromRadFt(double lon, double lat, double radius);
33 /// Factory from angular values in degrees and radius in ft
34 static SGGeoc fromDegFt(double lon, double lat, double radius);
35 /// Factory from angular values in radians and radius in m
36 static SGGeoc fromRadM(double lon, double lat, double radius);
37 /// Factory from angular values in degrees and radius in m
38 static SGGeoc fromDegM(double lon, double lat, double radius);
39 /// Factory to convert position from a cartesian position assumed to be
40 /// in wgs84 measured in meters
41 /// Note that this conversion is relatively expensive to compute
42 static SGGeoc fromCart(const SGVec3<double>& cart);
43 /// Factory to convert position from a geodetic position
44 /// Note that this conversion is relatively expensive to compute
45 static SGGeoc fromGeod(const SGGeod& geod);
47 /// Return the geocentric longitude in radians
48 double getLongitudeRad(void) const;
49 /// Set the geocentric longitude from the argument given in radians
50 void setLongitudeRad(double lon);
52 /// Return the geocentric longitude in degrees
53 double getLongitudeDeg(void) const;
54 /// Set the geocentric longitude from the argument given in degrees
55 void setLongitudeDeg(double lon);
57 /// Return the geocentric latitude in radians
58 double getLatitudeRad(void) const;
59 /// Set the geocentric latitude from the argument given in radians
60 void setLatitudeRad(double lat);
62 /// Return the geocentric latitude in degrees
63 double getLatitudeDeg(void) const;
64 /// Set the geocentric latitude from the argument given in degrees
65 void setLatitudeDeg(double lat);
67 /// Return the geocentric radius in meters
68 double getRadiusM(void) const;
69 /// Set the geocentric radius from the argument given in meters
70 void setRadiusM(double radius);
72 /// Return the geocentric radius in feet
73 double getRadiusFt(void) const;
74 /// Set the geocentric radius from the argument given in feet
75 void setRadiusFt(double radius);
77 SGGeoc advanceRadM(double course, double distance) const;
78 static double courseRad(const SGGeoc& from, const SGGeoc& to);
79 static double courseDeg(const SGGeoc& from, const SGGeoc& to);
80 static double distanceM(const SGGeoc& from, const SGGeoc& to);
83 /// This one is private since construction is not unique if you do
84 /// not know the units of the arguments, use the factory methods for
86 SGGeoc(double lon, double lat, double radius);
88 /// The actual data, angles in degree, radius in meters
89 /// The rationale for storing the values in degrees is that most code places
90 /// in flightgear/terragear use degrees as a nativ input and output value.
91 /// The places where it makes sense to use radians is when we convert
92 /// to other representations or compute rotation matrices. But both tasks
93 /// are computionally intensive anyway and that additional 'toRadian'
94 /// conversion does not hurt too much
101 SGGeoc::SGGeoc(void) :
102 _lon(0), _lat(0), _radius(0)
107 SGGeoc::SGGeoc(double lon, double lat, double radius) :
108 _lon(lon), _lat(lat), _radius(radius)
114 SGGeoc::fromRadFt(double lon, double lat, double radius)
116 #ifdef SG_GEOC_NATIVE_DEGREE
117 return SGGeoc(lon*SGD_RADIANS_TO_DEGREES, lat*SGD_RADIANS_TO_DEGREES,
118 radius*SG_FEET_TO_METER);
120 return SGGeoc(lon, lat, radius*SG_FEET_TO_METER);
126 SGGeoc::fromDegFt(double lon, double lat, double radius)
128 #ifdef SG_GEOC_NATIVE_DEGREE
129 return SGGeoc(lon, lat, radius*SG_FEET_TO_METER);
131 return SGGeoc(lon*SGD_DEGREES_TO_RADIANS, lat*SGD_DEGREES_TO_RADIANS,
132 radius*SG_FEET_TO_METER);
138 SGGeoc::fromRadM(double lon, double lat, double radius)
140 #ifdef SG_GEOC_NATIVE_DEGREE
141 return SGGeoc(lon*SGD_RADIANS_TO_DEGREES, lat*SGD_RADIANS_TO_DEGREES,
144 return SGGeoc(lon, lat, radius);
150 SGGeoc::fromDegM(double lon, double lat, double radius)
152 #ifdef SG_GEOC_NATIVE_DEGREE
153 return SGGeoc(lon, lat, radius);
155 return SGGeoc(lon*SGD_DEGREES_TO_RADIANS, lat*SGD_DEGREES_TO_RADIANS,
162 SGGeoc::fromCart(const SGVec3<double>& cart)
165 SGGeodesy::SGCartToGeoc(cart, geoc);
171 SGGeoc::fromGeod(const SGGeod& geod)
174 SGGeodesy::SGGeodToCart(geod, cart);
176 SGGeodesy::SGCartToGeoc(cart, geoc);
182 SGGeoc::getLongitudeRad(void) const
184 #ifdef SG_GEOC_NATIVE_DEGREE
185 return _lon*SGD_DEGREES_TO_RADIANS;
193 SGGeoc::setLongitudeRad(double lon)
195 #ifdef SG_GEOC_NATIVE_DEGREE
196 _lon = lon*SGD_RADIANS_TO_DEGREES;
204 SGGeoc::getLongitudeDeg(void) const
206 #ifdef SG_GEOC_NATIVE_DEGREE
209 return _lon*SGD_RADIANS_TO_DEGREES;
215 SGGeoc::setLongitudeDeg(double lon)
217 #ifdef SG_GEOC_NATIVE_DEGREE
220 _lon = lon*SGD_DEGREES_TO_RADIANS;
226 SGGeoc::getLatitudeRad(void) const
228 #ifdef SG_GEOC_NATIVE_DEGREE
229 return _lat*SGD_DEGREES_TO_RADIANS;
237 SGGeoc::setLatitudeRad(double lat)
239 #ifdef SG_GEOC_NATIVE_DEGREE
240 _lat = lat*SGD_RADIANS_TO_DEGREES;
248 SGGeoc::getLatitudeDeg(void) const
250 #ifdef SG_GEOC_NATIVE_DEGREE
253 return _lat*SGD_RADIANS_TO_DEGREES;
259 SGGeoc::setLatitudeDeg(double lat)
261 #ifdef SG_GEOC_NATIVE_DEGREE
264 _lat = lat*SGD_DEGREES_TO_RADIANS;
270 SGGeoc::getRadiusM(void) const
277 SGGeoc::setRadiusM(double radius)
284 SGGeoc::getRadiusFt(void) const
286 return _radius*SG_METER_TO_FEET;
291 SGGeoc::setRadiusFt(double radius)
293 _radius = radius*SG_FEET_TO_METER;
298 SGGeoc::advanceRadM(double course, double distance) const
301 SGGeodesy::advanceRadM(*this, course, distance, result);
307 SGGeoc::courseRad(const SGGeoc& from, const SGGeoc& to)
309 return SGGeodesy::courseRad(from, to);
314 SGGeoc::courseDeg(const SGGeoc& from, const SGGeoc& to)
316 return SGMiscd::rad2deg(courseRad(from, to));
321 SGGeoc::distanceM(const SGGeoc& from, const SGGeoc& to)
323 return SGGeodesy::distanceM(from, to);
326 /// Output to an ostream
327 template<typename char_type, typename traits_type>
329 std::basic_ostream<char_type, traits_type>&
330 operator<<(std::basic_ostream<char_type, traits_type>& s, const SGGeoc& g)
332 return s << "lon = " << g.getLongitudeDeg()
333 << ", lat = " << g.getLatitudeDeg()
334 << ", radius = " << g.getRadiusM();