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 BaseRobotFootprintModel *robot_model, const Obstacle *obstacle) |
| Set all parameters at once. More... | |
| void | setRobotModel (const BaseRobotFootprintModel *robot_model) |
| Set pointer to the robot model. 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... | |
Protected Attributes | |
| const BaseRobotFootprintModel * | robot_model_ |
| Store pointer to robot_model. More... | |
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 209 of file edge_obstacle.h.
|
inline |
Construct edge.
Definition at line 216 of file edge_obstacle.h.
|
inline |
Actual cost function.
Definition at line 224 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 256 of file edge_obstacle.h.
|
inline |
Set all parameters at once.
| cfg | TebConfig class |
| robot_model | Robot model required for distance calculation |
| obstacle | 2D position vector containing the position of the obstacle |
Definition at line 276 of file edge_obstacle.h.
|
inline |
Set pointer to the robot model.
| robot_model | Robot model required for distance calculation |
Definition at line 265 of file edge_obstacle.h.
|
protected |
Store pointer to robot_model.
Definition at line 285 of file edge_obstacle.h.