]> git.mxchange.org Git - simgear.git/blob - simgear/route/waypoint.cxx
Added route.[ch]xx which maintains a list of waypoints (i.e. a route)
[simgear.git] / 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., 675 Mass Ave, Cambridge, MA 02139, USA.
20 //
21 // $Id$
22
23
24 #include <simgear/math/polar3d.hxx>
25 #include <simgear/math/sg_geodesy.hxx>
26
27 #include "waypoint.hxx"
28
29
30 // Constructor
31 SGWayPoint::SGWayPoint( const double lon, const double lat, const double alt,
32                         const modetype m, const string s ) {
33     target_lon = lon;
34     target_lat = lat;
35     target_alt = alt;
36     mode = m;
37     id = s;
38 }
39
40
41 SGWayPoint::SGWayPoint() {
42     SGWayPoint( 0.0, 0.0, 0.0, WGS84, "" );
43 }
44
45
46 // Destructor
47 SGWayPoint::~SGWayPoint() {
48 }
49
50
51 // Calculate course and distances.  For WGS84 and SPHERICAL
52 // coordinates lat, lon, and course are in degrees, alt and distance
53 // are in meters.  For CARTESIAN coordinates x = lon, y = lat.  Course
54 // is in degrees and distance is in what ever units x and y are in.
55 void SGWayPoint::CourseAndDistance( const double cur_lon,
56                                     const double cur_lat,
57                                     const double cur_alt,
58                                     double *course, double *distance ) {
59     if ( mode == WGS84 ) {
60         double reverse;
61         geo_inverse_wgs_84( cur_alt, cur_lat, cur_lon, target_lat, target_lon,
62                             course, &reverse, distance );
63     } else if ( mode == SPHERICAL ) {
64         Point3D current( cur_lon * DEG_TO_RAD, cur_lat * DEG_TO_RAD, 0.0 );
65         Point3D target( target_lon * DEG_TO_RAD, target_lat * DEG_TO_RAD, 0.0 );
66         calc_gc_course_dist( current, target, course, distance );
67         *course = 360.0 - *course * RAD_TO_DEG;
68     } else if ( mode == CARTESIAN ) {
69         double dx = target_lon - cur_lon;
70         double dy = target_lat - cur_lat;
71         *course = -atan2( dy, dx ) * RAD_TO_DEG - 90;
72         while ( *course < 0 ) {
73             *course += 360.0;
74         }
75         while ( *course > 360.0 ) {
76             *course -= 360.0;
77         }
78         *distance = sqrt( dx * dx + dy * dy );
79     }
80 }