Class EdgePreferRotDir

Inheritance Relationships

Base Type

Class Documentation

class EdgePreferRotDir : public hateb_local_planner::BaseTebBinaryEdge<1, double, VertexPose, VertexPose>

Edge defining the cost function for penalzing a specified turning direction, in particular left resp. right turns.

The edge depends on two consecutive vertices \( \mathbf{s}_i, \mathbf{s}_{i+1} \) and penalizes a given rotation direction based on the weight and dir ( \( dir \in \{-1,1\} \)) dir should be +1 to prefer left rotations and -1 to prefer right rotations weight can be set using setInformation().

See also

TebOptimalPlanner::AddEdgePreferRotDir

Public Functions

inline EdgePreferRotDir()

Construct edge.

inline void computeError() override

Actual cost function.

inline void setRotDir(double dir)

Specify the prefered direction of rotation.

Parameters:

dir – +1 to prefer the left side, -1 to prefer the right side

inline void preferRight()

Prefer rotations to the right

inline void preferLeft()

Prefer rotations to the right