4 #include <ompl/base/spaces/ReedsSheppStateSpace.h>
5 #include <ompl/base/spaces/DubinsStateSpace.h>
6 #include <ompl/base/spaces/SE2StateSpace.h>
7 #include <ompl/base/State.h>
8 #include <ompl/base/ScopedState.h>
10 typedef ompl::base::SE2StateSpace::StateType State;
14 #include "visualize.h"
15 #include "collisiondetection.h"
19 namespace HybridAStar {
A three dimensional node class that is at the heart of the algorithm.
Definition: node3d.h:14
A class that encompasses the functions central to the search.
Definition: algorithm.h:27
The CollisionDetection class determines whether a given configuration q of the robot will result in a...
Definition: collisiondetection.h:31
static Node3D * hybridAStar(Node3D &start, const Node3D &goal, Node3D *nodes3D, Node2D *nodes2D, int width, int height, CollisionDetection &configurationSpace, float *dubinsLookup, Visualize &visualization)
The heart of the planner, the main algorithm starting the search for a collision free and drivable pa...
Definition: algorithm.cpp:31
A two dimensional node class used for the holonomic with obstacles heuristic.
Definition: node2d.h:14
A class for visualizing the hybrid A* search.
Definition: visualize.h:23
Algorithm()
The deault constructor.
Definition: algorithm.h:30
This is a collection of helper functions that are used throughout the project.