# error This library requires C++
#endif
-
#include <simgear/compiler.h>
-#include STL_STRING
#include <vector>
-SG_USING_STD(string);
-SG_USING_STD(vector);
+using std::vector;
#include <simgear/route/waypoint.hxx>
route_list route;
int current_wp;
+ void update_distance_and_track(int index);
+
public:
/** Constructor */
}
/**
- * Add a waypoint.
+ * Add waypoint (default), or insert waypoint at position n.
* @param wp a waypoint
*/
- inline void add_waypoint( const SGWayPoint &wp ) {
- route.push_back( wp );
-
- int size = route.size();
- if ( size > 1 ) {
- SGWayPoint next_to_last = route[ size - 2 ];
- double tmpd, tmpc;
- wp.CourseAndDistance( next_to_last, &tmpc, &tmpd );
- route[size - 1].set_distance( tmpd );
- }
- }
-
+ void add_waypoint( const SGWayPoint &wp, int n = -1 );
/**
* Get the number of waypoints (i.e. route length )
* @return route length
return SGWayPoint( 0.0, 0.0, 0.0, SGWayPoint::WGS84, "invalid" );
}
}
+
+ inline SGWayPoint get_previous() const {
+ if ( (current_wp > 0) && (current_wp < (int)route.size()) ) {
+ return route[current_wp - 1];
+ } else {
+ return SGWayPoint( 0.0, 0.0, 0.0, SGWayPoint::WGS84, "invalid" );
+ }
+ }
+
+ inline SGWayPoint get_next() const {
+ if ( (current_wp + 1) < (int)route.size() ) {
+ return route[current_wp+1];
+ } else {
+ return SGWayPoint( 0.0, 0.0, 0.0, SGWayPoint::WGS84, "invalid" );
+ }
+ }
/**
* Set the current waypoint
}
}
+ inline int current_index() const {
+ return current_wp;
+ }
+
/** Increment the current waypoint pointer. */
inline void increment_current() {
if ( current_wp < (int)route.size() - 1 ) {
inline void delete_first() { delete_waypoint(0); }
/** Delete waypoint waypoint with index n (last one if n < 0) */
- void delete_waypoint( int n = 0 ) {
- if ( !route.size() )
- return;
- if ( n < 0 || n > (int)route.size() - 1 )
- n = route.size() - 1;
-
- route.erase( route.begin() + n );
- }
-
+ void delete_waypoint( int n = 0 );
+
/**
- * Calculate perpendicular distance from the current route segment
- * This routine assumes all points are laying on a flat plane and
- * ignores the altitude (or Z) dimension. For most accurate
- * results, use with CARTESIAN way points.
+ * Helper, sum the distance members of each waypoint
*/
- double distance_off_route( double x, double y ) const;
+ double total_distance() const;
};