Edge defining the cost function for keeping a minimum distance from inflated obstacles. More...
#include <edge_obstacle.h>

Public Member Functions | |
| void | computeError () |
| Actual cost function. More... | |
| EdgeInflatedObstacle () | |
| Construct edge. More... | |
| void | setObstacle (const Obstacle *obstacle) |
| Set pointer to associated obstacle for the underlying cost function. More... | |
| void | setParameters (const TebConfig &cfg, const Obstacle *obstacle) |
| Set all parameters at once. More... | |
Public Member Functions inherited from teb_local_planner::BaseTebUnaryEdge< 2, const Obstacle *, VertexPose > | |
| 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... | |
Additional Inherited Members | |
Protected Attributes inherited from teb_local_planner::BaseTebUnaryEdge< 2, const Obstacle *, VertexPose > | |
| const TebConfig * | cfg_ |
| Store TebConfig class for parameters. More... | |
Edge defining the cost function for keeping a minimum distance from inflated obstacles.
The edge depends on a single vertex
and minimizes:
.
Additional, a second penalty is provided with
. It is assumed that inflation_dist > min_obstacle_dist and weight_inflation << weight_inflation. dist2point denotes the minimum distance to the point obstacle.
penaltyBelow denotes the penalty function, see penaltyBoundFromBelow()
Definition at line 233 of file edge_obstacle.h.
|
inline |
Construct edge.
Definition at line 240 of file edge_obstacle.h.
|
inline |
Actual cost function.
Definition at line 248 of file edge_obstacle.h.
|
inline |
Set pointer to associated obstacle for the underlying cost function.
| obstacle | 2D position vector containing the position of the obstacle |
Definition at line 280 of file edge_obstacle.h.
|
inline |
Set all parameters at once.
| cfg | TebConfig class |
| obstacle | 2D position vector containing the position of the obstacle |
Definition at line 290 of file edge_obstacle.h.