Function hateb_local_planner::penaltyBoundToInterval(const double&, const double&, const double&, const double&)

• Defined in File penalties.h

Function Documentation

inline double hateb_local_planner::penaltyBoundToInterval(const double &var, const double &a, const double &b, const double &epsilon)

Linear penalty function for bounding var to the interval \( a < var < b \).

See also

penaltyBoundToIntervalDerivative

Parameters:

• var – The scalar that should be bounded

• a – lower bound

• b – upper bound

• epsilon – safty margin (move bound to the interior of the interval)

Returns:

Penalty / cost value that is nonzero if the constraint is not satisfied