trajectory::InterpolatedPtr planSnap(const statespace::ConstStateSpacePtr &stateSpace, const statespace::StateSpace::State *startState, const statespace::StateSpace::State *goalState, const std::shared_ptr< statespace::Interpolator > &interpolator, const std::shared_ptr< constraint::Testable > &constraint, planner::PlanningResult &planningResult)
Plan a trajectory from startState to goalState by using interpolator to interpolate between them.