WaypointGraph.cpp

Go to the documentation of this file.

 
 
#include "Headers/WaypointGraph.h"
 
#include "Utility/Headers/Localization.h"
 
namespace Divide::Navigation {
 
void WaypointGraph::addWaypoint(Waypoint* wp) {
    if (_waypoints.find(wp->ID()) != std::end(_waypoints)) {
        return;
    }
 
    insert(_waypoints, wp->ID(), wp);
    updateGraph();
}
 
void WaypointGraph::removeWaypoint(Waypoint* wp) {
    if (_waypoints.find(wp->ID()) != std::end(_waypoints)) {
        _waypoints.erase(wp->ID());
        updateGraph();
    } else {
        Console::printfn(LOCALE_STR("WARN_WAYPOINT_NOT_FOUND"), wp->ID(),
                         getID());
    }
}
 
void WaypointGraph::updateGraph() {
    efficient_clear( _positions );
    efficient_clear( _rotations );
    efficient_clear( _times );
    for (auto& waypoint : _waypoints) {
        _positions.push_back(waypoint.second->position());
        _rotations.push_back(waypoint.second->orientation());
        _times.push_back(waypoint.second->time());
    }
}
 
}  // namespace Divide::Navigation