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>
42 /** Update the length of the leg ending at waypoint index */
43 void SGRoute::update_distance_and_track(int index)
45 SGWayPoint& curr = route[ index ];
52 const SGWayPoint& prev = route[index - 1];
53 curr.CourseAndDistance( prev, &course, &dist );
56 curr.set_distance(dist);
57 curr.set_track(course);
61 * Add waypoint (default), or insert waypoint at position n.
62 * @param wp a waypoint
64 void SGRoute::add_waypoint( const SGWayPoint &wp, int n ) {
65 int size = route.size();
66 if ( n < 0 || n >= size ) {
68 route.push_back( wp );
70 route.insert( route.begin() + n, 1, wp );
71 // update distance of next leg if not at end of route
72 update_distance_and_track( n + 1 );
74 update_distance_and_track( n );
77 /** Delete waypoint with index n (last one if n < 0) */
78 void SGRoute::delete_waypoint( int n ) {
79 int size = route.size();
82 if ( n < 0 || n >= size )
85 route.erase( route.begin() + n );
86 // update distance of next leg if not at end of route
88 update_distance_and_track( n );
91 double SGRoute::total_distance() const {
93 for (unsigned int i=0; i<route.size(); ++i) {
94 total += route[i].get_distance();