C++ (Cpp) distanceGoal示例

示例#1

文件： SpaceInformationKinematic.cpp 项目： 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;
}

示例#2

文件： KauthamDEGoalRegion.cpp 项目： iocroblab/kautham

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