Function mppi::utils::findPathTrajectoryInitialPoint

• Defined in File utils.hpp

Function Documentation

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

Evaluate closest point idx of data.path which is nearset to the start of the trajectory in data.trajectories.

Parameters:

data – Data to use

Returns:

Idx of closest path point at start of the trajectories