Function mppi::utils::findPathFurthestReachedPoint

• Defined in File utils.hpp

Function Documentation

inline size_t mppi::utils::findPathFurthestReachedPoint(const CriticData &data)

Evaluate furthest point idx of data.path which is nearset to some trajectory in data.trajectories.

Parameters:

data – Data to use

Returns:

Idx of furthest path point reached by a set of trajectories