Class EdgeObstacle

Inheritance Relationships

Base Type

Class Documentation

class EdgeObstacle : public hateb_local_planner::BaseTebUnaryEdge<1, const Obstacle*, VertexPose>

Edge defining the cost function for keeping a minimum distance from obstacles.

The edge depends on a single vertex \( \mathbf{s}_i \) and minimizes: \( \min \textrm{penaltyBelow}( dist2point ) \cdot weight \). dist2point denotes the minimum distance to the point obstacle. weight can be set using setInformation(). penaltyBelow denotes the penalty function, see penaltyBoundFromBelow()

See also

TebOptimalPlanner::AddEdgesObstacles, TebOptimalPlanner::EdgeInflatedObstacle

Remark

Do not forget to call setHATebConfig() and setObstacle()

Public Functions

inline EdgeObstacle()

Construct edge.

inline void computeError() override

Actual cost function.

inline void setParameters(const HATebConfig &cfg, const Obstacle *obstacle, const int type)

Set all parameters at once.

Parameters:

  • cfg – HATebConfig class

  • obstacle – 2D position vector containing the position of the obstacle

  • type – Agent type (0 - Robot, 1 - Human)

Protected Attributes

int type_