Function mppi::utils::findFirstPathInversion

• Defined in File utils.hpp

Function Documentation

inline unsigned int mppi::utils::findFirstPathInversion(nav_msgs::msg::Path &path)

Find the iterator of the first pose at which there is an inversion on the path,.

Parameters:

path – to check for inversion

Returns:

the first point after the inversion found in the path