4#include "global_body_planner/graph_class.h"
6using namespace planning_utils;
8typedef std::pair<double, int> Distance;
A general directed graph class.
Definition graph_class.h:24
Definition planner_class.h:17
int getNearestNeighbor(State q) const
Get the closest verticex to the specified state by Euclidean distance.
Definition planner_class.cpp:79
int direction_
Direction.
Definition planner_class.h:62
std::vector< int > neighborhoodN(State s, int N) const
Get the closest N vertices to the specified state by Euclidean distance.
Definition planner_class.cpp:46
std::vector< int > neighborhoodDist(State q, double dist) const
Get the vertices within the specified Euclidean distance of the specified state.
Definition planner_class.cpp:65
State randomState(const PlannerConfig &planner_config)
Generate a random state by sampling from within the bounds of the terrain.
Definition planner_class.cpp:22
std::shared_ptr< std::lognormal_distribution< double > > vel_distribution_
Lognormal distribution for velocity sampling.
Definition planner_class.h:65
Planner Configuration.
Definition planning_utils.h:36
Define state with Eigen data.
Definition planning_utils.h:184