simgear/route/waypoint.cxx

   1 // waypoint.cxx -- Class to hold data and return info relating to a waypoint
   2 //
   3 // Written by Curtis Olson, started September 2000.
   4 //
   5 // Copyright (C) 2000  Curtis L. Olson  - curt@hfrl.umn.edu
   6 //
   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.
  11 //
  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.
  16 //
  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.
  20 //
  21 // $Id$
  22
  23 #ifdef HAVE_CONFIG_H
  24 #  include <simgear_config.h>
  25 #endif
  26
  27 #include <simgear/math/polar3d.hxx>
  28 #include <simgear/math/sg_geodesy.hxx>
  29
  30 #include "waypoint.hxx"
  31
  32 using std::string;
  33
  34 // Constructor
  35 SGWayPoint::SGWayPoint( const double lon, const double lat, const double alt,
  36                         const modetype, const string& s, const string& n ) :
  37   pos(SGGeod::fromDegM(lon, lat, alt)),
  38   id(s),
  39   name(n),
  40   _distance(0.0),
  41   _track(0.0),
  42   _speed(0.0)
  43 {
  44 }
  45
  46 SGWayPoint::SGWayPoint(const SGGeod& geod, const string& s, const string& n ) :
  47   pos(geod),
  48   id(s),
  49   name(n),
  50   _distance(0.0),
  51   _track(0.0),
  52   _speed(0.0)
  53 {
  54 }
  55
  56 // Destructor
  57 SGWayPoint::~SGWayPoint() {
  58 }
  59
  60 void SGWayPoint::CourseAndDistance(const SGGeod& cur, double& course, double& dist ) const {
  61   double reverse;
  62   SGGeodesy::inverse(cur, pos, course, reverse, dist);
  63 }
  64
  65 // Calculate course and distances.  For WGS84 and SPHERICAL
  66 // coordinates lat, lon, and course are in degrees, alt and distance
  67 // are in meters.  For CARTESIAN coordinates x = lon, y = lat.  Course
  68 // is in degrees and distance is in what ever units x and y are in.
  69 void SGWayPoint::CourseAndDistance( const double cur_lon,
  70                                     const double cur_lat,
  71                                     const double cur_alt,
  72                                     double *course, double *dist ) const {
  73   CourseAndDistance(SGGeod::fromDegM(cur_lon, cur_lat, cur_alt), *course, *dist);
  74 }
  75
  76 // Calculate course and distances between two waypoints
  77 void SGWayPoint::CourseAndDistance( const SGWayPoint &wp,
  78                         double *course, double *dist ) const {
  79     CourseAndDistance( wp.get_target(), *course, *dist );
  80 }