1 // route.cxx -- Class to manage a list of waypoints (route)
3 // Written by Curtis Olson, started October 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>
40 /** Update the length of the leg ending at waypoint index */
41 void SGRoute::update_distance_and_track(int index)
43 SGWayPoint& curr = route[ index ];
50 const SGWayPoint& prev = route[index - 1];
51 curr.CourseAndDistance( prev, &course, &dist );
54 curr.set_distance(dist);
55 curr.set_track(course);
59 * Add waypoint (default), or insert waypoint at position n.
60 * @param wp a waypoint
62 void SGRoute::add_waypoint( const SGWayPoint &wp, int n ) {
63 int size = route.size();
64 if ( n < 0 || n >= size ) {
66 route.push_back( wp );
68 route.insert( route.begin() + n, 1, wp );
69 // update distance of next leg if not at end of route
70 update_distance_and_track( n + 1 );
72 update_distance_and_track( n );
75 /** Delete waypoint with index n (last one if n < 0) */
76 void SGRoute::delete_waypoint( int n ) {
77 int size = route.size();
80 if ( n < 0 || n >= size )
83 route.erase( route.begin() + n );
84 // update distance of next leg if not at end of route
86 update_distance_and_track( n );
89 double SGRoute::total_distance() const {
91 for (unsigned int i=0; i<route.size(); ++i) {
92 total += route[i].get_distance();