Edge defining the cost function for keeping a minimum distance from obstacles. More...
#include <edge_obstacle.h>
Public Member Functions | |
void | computeError () |
Actual cost function. | |
EdgeObstacle () | |
Construct edge. | |
void | setObstacle (const Obstacle *obstacle) |
Set pointer to associated obstacle for the underlying cost function. | |
void | setParameters (const TebConfig &cfg, const BaseRobotFootprintModel *robot_model, const Obstacle *obstacle) |
Set all parameters at once. | |
void | setRobotModel (const BaseRobotFootprintModel *robot_model) |
Set pointer to the robot model. | |
Protected Attributes | |
const BaseRobotFootprintModel * | robot_model_ |
Store pointer to robot_model. |
Edge defining the cost function for keeping a minimum distance from obstacles.
The edge depends on a single vertex and minimizes:
.
dist2point denotes the minimum distance to the point obstacle.
weight can be set using setInformation().
penaltyBelow denotes the penalty function, see penaltyBoundFromBelow()
Definition at line 70 of file edge_obstacle.h.
teb_local_planner::EdgeObstacle::EdgeObstacle | ( | ) | [inline] |
Construct edge.
Definition at line 77 of file edge_obstacle.h.
void teb_local_planner::EdgeObstacle::computeError | ( | ) | [inline] |
Actual cost function.
Definition at line 85 of file edge_obstacle.h.
void teb_local_planner::EdgeObstacle::setObstacle | ( | const Obstacle * | obstacle | ) | [inline] |
Set pointer to associated obstacle for the underlying cost function.
obstacle | 2D position vector containing the position of the obstacle |
Definition at line 146 of file edge_obstacle.h.
void teb_local_planner::EdgeObstacle::setParameters | ( | const TebConfig & | cfg, |
const BaseRobotFootprintModel * | robot_model, | ||
const Obstacle * | obstacle | ||
) | [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 166 of file edge_obstacle.h.
void teb_local_planner::EdgeObstacle::setRobotModel | ( | const BaseRobotFootprintModel * | robot_model | ) | [inline] |
Set pointer to the robot model.
robot_model | Robot model required for distance calculation |
Definition at line 155 of file edge_obstacle.h.
const BaseRobotFootprintModel* teb_local_planner::EdgeObstacle::robot_model_ [protected] |
Store pointer to robot_model.
Definition at line 175 of file edge_obstacle.h.