1 // waypoint.cxx -- Class to hold data and return info relating to a waypoint
3 // Written by Curtis Olson, started September 2000.
5 // Copyright (C) 2000 Curtis L. Olson - curt@hfrl.umn.edu
7 // This program is free software; you can redistribute it and/or
8 // modify it under the terms of the GNU General Public License as
9 // published by the Free Software Foundation; either version 2 of the
10 // License, or (at your option) any later version.
12 // This program is distributed in the hope that it will be useful, but
13 // WITHOUT ANY WARRANTY; without even the implied warranty of
14 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 // General Public License for more details.
17 // You should have received a copy of the GNU General Public License
18 // along with this program; if not, write to the Free Software
19 // Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
24 # include <simgear_config.h>
27 #include <simgear/math/polar3d.hxx>
28 #include <simgear/math/sg_geodesy.hxx>
30 #include "waypoint.hxx"
35 SGWayPoint::SGWayPoint( const double lon, const double lat, const double alt,
36 const modetype m, const string& s, const string& n ) :
38 pos(SGGeod::fromDegM(lon, lat, alt)),
45 SGWayPoint::SGWayPoint(const SGGeod& geod, const string& s, const string& n ) :
55 SGWayPoint::~SGWayPoint() {
58 void SGWayPoint::CourseAndDistance(const SGGeod& cur, double& course, double& dist ) const {
59 if ( mode == WGS84 ) {
61 SGGeodesy::inverse(cur, pos, course, reverse, dist);
62 } else if ( mode == SPHERICAL ) {
63 Point3D currentPoint(cur.getLongitudeRad(), cur.getLatitudeRad(), 0.0 );
64 Point3D targetPoint(pos.getLongitudeRad(), pos.getLatitudeRad(), 0.0 );
65 calc_gc_course_dist( currentPoint, targetPoint, &course, &dist );
66 course = 360.0 - course * SGD_RADIANS_TO_DEGREES;
70 // Calculate course and distances. For WGS84 and SPHERICAL
71 // coordinates lat, lon, and course are in degrees, alt and distance
72 // are in meters. For CARTESIAN coordinates x = lon, y = lat. Course
73 // is in degrees and distance is in what ever units x and y are in.
74 void SGWayPoint::CourseAndDistance( const double cur_lon,
77 double *course, double *dist ) const {
78 CourseAndDistance(SGGeod::fromDegM(cur_lon, cur_lat, cur_alt), *course, *dist);
81 // Calculate course and distances between two waypoints
82 void SGWayPoint::CourseAndDistance( const SGWayPoint &wp,
83 double *course, double *dist ) const {
84 CourseAndDistance( wp.get_target(), *course, *dist );