Function mppi::utils::removePosesAfterFirstInversion

• Defined in File utils.hpp

Function Documentation

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

Find and remove poses after the first inversion in the path.

Parameters:

path – to check for inversion

Returns:

The location of the inversion, return 0 if none exist