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

• Defined in File penalties.h

Function Documentation

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

Derivative of the linear penalty function for bounding var to the interval \( -a < var < a \).

See also

penaltyBoundToInterval

Parameters:

• var – The scalar that should be bounded

• a – lower and upper absolute bound

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

Returns:

Derivative of the penalty function w.r.t. var