Function mppi::utils::findClosestPathPt

• Defined in File utils.hpp

Function Documentation

inline unsigned int mppi::utils::findClosestPathPt(const std::vector<float> &vec, const float dist, const unsigned int init = 0u)

Compare to trajectory points to find closest path point along integrated distances.

Parameters:

vec – Vect to check

Returns:

dist Distance to look for

Returns:

init Starting index to indec from