C++ (Cpp) distanceGoal Exemples

Exemple #1

Fichier : SpaceInformationKinematic.cpp Projet : janfrs/kwc-ros-pkg

bool ompl::SpaceInformationKinematic::GoalRegionKinematic::isSatisfied(State_t s, double *distance)
{
    double d2g = distanceGoal(static_cast<StateKinematic_t>(s));
    if (distance)
	*distance = d2g;
    return d2g < threshold;
}

Exemple #2

Fichier : KauthamDEGoalRegion.cpp Projet : iocroblab/kautham

bool KauthamDEGoalRegion::isSatisfied(const ob::State *st, double *distance) const
{
    double d2g = distanceGoal(st);
    if (distance)
        *distance = d2g;
    return d2g < threshold_;
}