Edge defining the cost function for keeping a minimum distance from obstacles. More...
#include <edge_velocity_obstacle_ratio.h>
Public Member Functions | |
void | computeError () |
Actual cost function. More... | |
EdgeVelocityObstacleRatio () | |
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... | |
![]() | |
ErrorVector & | getError () |
Compute and return error / cost value. More... | |
virtual bool | read (std::istream &is) |
Read values from input stream. More... | |
virtual void | resize (size_t size) |
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... | |
![]() | |
const TebConfig * | cfg_ |
Store TebConfig class for parameters. More... | |
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 66 of file edge_velocity_obstacle_ratio.h.
|
inline |
Construct edge.
Definition at line 73 of file edge_velocity_obstacle_ratio.h.
|
inline |
Actual cost function.
Definition at line 83 of file edge_velocity_obstacle_ratio.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 129 of file edge_velocity_obstacle_ratio.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 149 of file edge_velocity_obstacle_ratio.h.
|
inline |
Set pointer to the robot model.
robot_model | Robot model required for distance calculation |
Definition at line 138 of file edge_velocity_obstacle_ratio.h.
|
protected |
Store pointer to robot_model.
Definition at line 158 of file edge_velocity_obstacle_ratio.h.