Function hateb_local_planner::average_angles

• Defined in File misc.h

Function Documentation

inline double hateb_local_planner::average_angles(const std::vector<double> &angles)

Return the average angle of an arbitrary number of given angles [rad].

Parameters:

angles – vector containing all angles

Returns:

average / mean angle, that is normalized to [-pi, pi]