Base edge connecting two vertices in the TEB optimization problem. More...
#include <base_teb_edges.h>
Public Member Functions | |
BaseTebMultiEdge () | |
Construct edge. | |
ErrorVector & | getError () |
Compute and return error / cost value. | |
virtual bool | read (std::istream &is) |
Read values from input stream. | |
virtual void | resize (size_t size) |
void | setTebConfig (const TebConfig &cfg) |
Assign the TebConfig class for parameters. | |
virtual bool | write (std::ostream &os) const |
Write values to an output stream. | |
virtual | ~BaseTebMultiEdge () |
Destruct edge. | |
Protected Attributes | |
const TebConfig * | cfg_ |
Store TebConfig class for parameters. |
Base edge connecting two vertices in the TEB optimization problem.
This edge defines a base edge type for the TEB optimization problem. It is derived from the corresponding g2o base classes augmented with additional information for the dedicated TEB problem (e.g. config). The destructor erases the edge in all attached vertices in order to allow keeping the vertices valid in subsequent g2o optimization calls. Memory of edges should be freed by calling the clearEdge method of the g2o optimzier class.
Definition at line 249 of file base_teb_edges.h.
teb_local_planner::BaseTebMultiEdge< D, E >::BaseTebMultiEdge | ( | ) | [inline] |
Construct edge.
Definition at line 259 of file base_teb_edges.h.
virtual teb_local_planner::BaseTebMultiEdge< D, E >::~BaseTebMultiEdge | ( | ) | [inline, virtual] |
Destruct edge.
We need to erase vertices manually, since we want to keep them even if TebOptimalPlanner::clearGraph() is called. This is necessary since the vertices are managed by the Timed_Elastic_Band class.
Definition at line 271 of file base_teb_edges.h.
ErrorVector& teb_local_planner::BaseTebMultiEdge< D, E >::getError | ( | ) | [inline] |
Compute and return error / cost value.
This method is called by TebOptimalPlanner::computeCurrentCost to obtain the current cost.
Definition at line 295 of file base_teb_edges.h.
virtual bool teb_local_planner::BaseTebMultiEdge< D, E >::read | ( | std::istream & | is | ) | [inline, virtual] |
Read values from input stream.
Definition at line 304 of file base_teb_edges.h.
virtual void teb_local_planner::BaseTebMultiEdge< D, E >::resize | ( | size_t | size | ) | [inline, virtual] |
Definition at line 281 of file base_teb_edges.h.
void teb_local_planner::BaseTebMultiEdge< D, E >::setTebConfig | ( | const TebConfig & | cfg | ) | [inline] |
Assign the TebConfig class for parameters.
cfg | TebConfig class |
Definition at line 323 of file base_teb_edges.h.
virtual bool teb_local_planner::BaseTebMultiEdge< D, E >::write | ( | std::ostream & | os | ) | const [inline, virtual] |
Write values to an output stream.
Definition at line 313 of file base_teb_edges.h.
const TebConfig* teb_local_planner::BaseTebMultiEdge< D, E >::cfg_ [protected] |
Store TebConfig class for parameters.
Definition at line 333 of file base_teb_edges.h.