Edge defining the cost function for keeping a distance from dynamic (moving) obstacles. More...
#include <edge_dynamic_obstacle.h>
Public Member Functions | |
void | computeError () |
Actual cost function. More... | |
EdgeDynamicObstacle () | |
Construct edge. More... | |
EdgeDynamicObstacle (double t) | |
Construct edge and specify the time for its associated pose (necessary for computeError). More... | |
void | setObstacle (const Obstacle *obstacle) |
Set Obstacle for the underlying cost function. More... | |
void | setParameters (const TebConfig &cfg, const Obstacle *obstacle) |
Set all parameters at once. More... | |
![]() | |
ErrorVector & | getError () |
Compute and return error / cost value. More... | |
virtual bool | read (std::istream &is) |
Read values from input stream. More... | |
void | setTebConfig (const TebConfig &cfg) |
Assign the TebConfig class for parameters. More... | |
virtual bool | write (std::ostream &os) const |
Write values to an output stream. More... | |
Protected Attributes | |
double | t_ |
Estimated time until current pose is reached. More... | |
![]() | |
const TebConfig * | cfg_ |
Store TebConfig class for parameters. More... | |
Edge defining the cost function for keeping a distance from dynamic (moving) obstacles.
The edge depends on two vertices and minimizes:
.
dist2obstacle denotes the minimum distance to the obstacle trajectory (spatial and temporal).
weight can be set using setInformation().
penaltyBelow denotes the penalty function, see penaltyBoundFromBelow().
Definition at line 112 of file edge_dynamic_obstacle.h.
|
inline |
Construct edge.
Definition at line 119 of file edge_dynamic_obstacle.h.
|
inline |
Construct edge and specify the time for its associated pose (necessary for computeError).
t_ | Estimated time until current pose is reached |
Definition at line 127 of file edge_dynamic_obstacle.h.
|
inline |
Actual cost function.
Definition at line 134 of file edge_dynamic_obstacle.h.
|
inline |
Set Obstacle for the underlying cost function.
Definition at line 152 of file edge_dynamic_obstacle.h.
|
inline |
Set all parameters at once.
cfg | TebConfig class |
obstacle | 2D position vector containing the position of the obstacle |
Definition at line 162 of file edge_dynamic_obstacle.h.
|
protected |
Estimated time until current pose is reached.
Definition at line 170 of file edge_dynamic_obstacle.h.