Function mppi::utils::findClosestPathPt

• Defined in File utils.hpp

Function Documentation

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

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

Parameters:

vec – Vect to check

Returns:

dist Distance to look for