libmove3d-planners
 All Classes Namespaces Files Functions Variables Enumerations Enumerator Friends Macros Groups Pages
Public Member Functions | List of all members
HRICS_RRT Class Reference

Special RRT implentation for the HRICS. More...

#include <HRICS_rrt.hpp>

Inheritance diagram for HRICS_RRT:
RRT TreePlanner Planner

Public Member Functions

 HRICS_RRT (Robot *R, Graph *G)
 Basic constructor.
 
void setGrid (HRICS::Grid *G)
 Sets the grid pointer.
 
void setCellPath (std::vector< API::ThreeDCell * > cellPath)
 Sets the cell path.
 
virtual unsigned init ()
 Initialzation of the plannificator. More...
 
bool connectNodeToCompco (Node *node, Node *compNode)
 Intents to connect a node to the compco. More...
 
NodenearestNeighbourInCell (Node *node, std::vector< Node * > neigbour)
 Finds the nearest neighbour in the cell. More...
 
API::ThreeDCellgetCellFromNode (Node *node)
 Gets Cell in grid from a given node. More...
 
- Public Member Functions inherited from RRT
 RRT (Robot *robot, Graph *graph)
 Constructor.
 
virtual ~RRT ()
 Destructor.
 
virtual unsigned run ()
 Main function of RRT. More...
 
virtual bool trajFound ()
 Check whether RRT has found a trajectory in the graph it is building. More...
 
void addConnectibleNode ()
 
unsigned int getNbConnectibleNodes ()
 
- Public Member Functions inherited from TreePlanner
 TreePlanner (Robot *R, Graph *G)
 Constructor.
 
 ~TreePlanner ()
 Destructor.
 
virtual bool preConditions ()
 Checks out the Pre-conditions. More...
 
virtual bool connectNodeToComp (Node *N, Node *CompNode)
 Tries to connect a node to the other connected component of the graph. More...
 
virtual bool connectionToTheOtherCompco (Node *toNode)
 Main function to connect to the other Connected Component. More...
 
virtual unsigned int expandOneStep (Node *fromComp)
 Expands tree from component fromComp. More...
 
bool goalBias () const
 Decide whether the goal bias should be applied, based on a random trial. More...
 
double getTime ()
 Return time in algorithm: this function must be called after ChronoTimeOfDayOn() More...
 
int getRunId ()
 Get the run Id.
 
void setRunId (int id)
 Set the run Id.
 
unsigned int getNumberOfConsecutiveFail ()
 Return the number of consecutive failures observed during planification.
 
unsigned int getNumberOfExpansion ()
 Return the number of expansions performed during planification.
 
unsigned int getNumberOfFailedExpansion ()
 Return the number of expansion that failed during planification.
 
unsigned int getNumberOfInitialNodes ()
 Return the initial number of nodes.
 
NodegetLastNode ()
 Return the last node added to the graph.
 
double getDistanceGap ()
 
- Public Member Functions inherited from Planner
 Planner ()
 Plain Constructor of the class.
 
 Planner (Robot *rob, Graph *graph)
 Constructor of the class. More...
 
virtual ~Planner ()
 Destructeur de la classe.
 
RobotgetActivRobot ()
 retourne le Robot activ More...
 
void setRobot (Robot *R)
 place le Robot utilisé pour la planification More...
 
GraphgetActivGraph ()
 obtient le Graph actif pour la planification More...
 
void setGraph (Graph *G)
 modifie le Graph actif pour la planification More...
 
bool setInit (confPtr_t Cs)
 place le Node initial de la planification More...
 
bool setGoal (confPtr_t Cg)
 place le Node final de la planification More...
 
NodegetInit ()
 obtient le Node intial de la planification More...
 
NodegetGoal ()
 obtient le Node final de la planification More...
 
confPtr_t getInitConf ()
 Get init configuration.
 
confPtr_t getGoalConf ()
 Get goal configuration.
 
bool getInitialized ()
 test si le Planner est initialisé pour la planification More...
 
void setInitialized (bool b)
 modifie la valeur du Booleen de test d'initialisation More...
 
int getRunId ()
 Get the run Id.
 
void setRunId (int id)
 Set the run Id.
 
double getTime ()
 return time in algorithm this function must be called after ChronoTimeOfDayOn() More...
 
void chronoStart ()
 
void chronoStop ()
 
void chronoUpdate ()
 

Additional Inherited Members

- Protected Member Functions inherited from RRT
virtual unsigned expandOneStep (ConnectedComponent *fromComp)
 Perform a single expansion step of RRT, growing the given connected component. More...
 
bool checkStopConditions ()
 Check the stopping conditions of RRT. More...
 
virtual API::TrajectoryextractTrajectory ()
 Extract a trajectory from Start to Goal.
 
- Protected Attributes inherited from RRT
RRTExpansionexpansion
 access point to the expansion procedure of RRT
 
std::vector< double > trajCosts
 
- Protected Attributes inherited from TreePlanner
int m_runId
 
unsigned int m_nbConscutiveFailures
 
unsigned int m_nbExpansion
 
unsigned int m_nbFailedExpansion
 
unsigned int m_nbInitNodes
 
double m_DistanceGap
 
Nodem_last_node
 
- Protected Attributes inherited from Planner
int(* _stop_func )()
 
void(* _draw_func )()
 
confPtr_t _q_start
 
confPtr_t _q_goal
 
Node_Start
 Le Node initial de la planification.
 
Node_Goal
 Le Node final de la planification.
 
Robot_Robot
 Le Robot pour lequel la recherche va se faire.
 
Graph_Graph
 Le Graph qui va être utilisé
 
bool _Init
 Le Planner a été initialisé
 
bool m_fail
 
int m_runId
 
double m_time
 

Detailed Description

Special RRT implentation for the HRICS.

Member Function Documentation

bool HRICS_RRT::connectNodeToCompco ( Node node,
Node compNode 
)

Intents to connect a node to the compco.

Tries to connect a node to a given component First checks that the node is note in the compco and the if their is a neighbour in the same cell.

Returns
: TRUE if the node and the componant have been connected.
API::ThreeDCell * HRICS_RRT::getCellFromNode ( Node node)

Gets Cell in grid from a given node.

Returns
the cell in which is the given node
unsigned HRICS_RRT::init ( void  )
virtual

Initialzation of the plannificator.

Initializes an RRT Planner.

Returns
the number of node added during the init phase

Reimplemented from RRT.

Node * HRICS_RRT::nearestNeighbourInCell ( Node node,
std::vector< Node * >  neigbour 
)

Finds the nearest neighbour in the cell.

Gets the cell in which the Node is Then from a vector of all nodes in the connected component makes a vector of nodes in the cell, returns nearest.

Returns
Other wise returns NULL

The documentation for this class was generated from the following files: