Function hateb_local_planner::penaltyBoundToIntervalDerivative(const double&, 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 &b, const double &epsilon)

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

See also

penaltyBoundToInterval

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:

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