Navigator.cpp File Reference

#include "Navigator.h"
#include <algorithm>
#include <chrono>
#include <cmath>
#include <cstddef>
#include <optional>
#include <thread>
#include <boost/graph/dijkstra_shortest_paths.hpp>
#include <boost/graph/named_function_params.hpp>
#include <boost/graph/properties.hpp>
#include <boost/graph/subgraph.hpp>
#include <Eigen/Geometry>
#include <SimoxUtility/math/convert/mat3f_to_rpy.h>
#include <VirtualRobot/Robot.h>
#include <ArmarXCore/core/time/StopWatch.h>
#include <ArmarXCore/core/exceptions/LocalException.h>
#include <ArmarXCore/core/exceptions/local/ExpressionException.h>
#include <ArmarXCore/core/logging/Logging.h>
#include <ArmarXCore/core/time/Clock.h>
#include <ArmarXCore/util/CPPUtility/trace.h>
#include <RobotAPI/libraries/ArmarXObjects/ObjectID.h>
#include <armarx/navigation/common/controller_types.h>
#include <armarx/navigation/memory/client/graph/Reader.h>
#include <armarx/navigation/client/PathBuilder.h>
#include <armarx/navigation/client/ice_conversions.h>
#include <armarx/navigation/client/types.h>
#include <armarx/navigation/core/Graph.h>
#include <armarx/navigation/core/LocationUtils.h>
#include <armarx/navigation/core/Trajectory.h>
#include <armarx/navigation/core/basic_types.h>
#include <armarx/navigation/core/events.h>
#include <armarx/navigation/core/types.h>
#include <armarx/navigation/global_planning/GlobalPlanner.h>
#include <armarx/navigation/local_planning/LocalPlanner.h>
#include <armarx/navigation/server/GraphBuilder.h>
#include <armarx/navigation/server/StackResult.h>
#include <armarx/navigation/server/monitoring/GoalReachedMonitor.h>
#include <armarx/navigation/server/scene_provider/SceneProviderInterface.h>
#include "range/v3/algorithm/reverse.hpp"
#include "range/v3/range/conversion.hpp"
#include <SemanticObjectRelations/Shapes/Shape.h>
#include <range/v3/view.hpp>
#include <range/v3/view/reverse.hpp>

Include dependency graph for Navigator.cpp:

Go to the source code of this file.

Namespaces
	armarx
	This file offers overloads of toIce() and fromIce() functions for STL container types.
	armarx::navigation
	This file is part of ArmarX.
	armarx::navigation::server
	This file is part of ArmarX.

Typedefs
using	GraphPath = std::vector< semrel::ShapeID >

Functions
GraphPath	findShortestPath (core::Graph graph, const core::Graph::ConstVertex &startVertex, const core::Graph::ConstVertex &goalVertex)
void	stopIfRunning (PeriodicTask< Navigator >::pointer_type &task)