37 #include "ompl/base/goals/GoalRegion.h"
38 #include "ompl/base/SpaceInformation.h"
48 return isSatisfied(st, NULL);
53 double d2g = distanceGoal(st);
56 return d2g < threshold_;
61 out <<
"Goal region, threshold = " << threshold_ <<
", memory address = " <<
this << std::endl;
Abstract definition of goals.
This bit is set if casting to goal regions (ompl::base::GoalRegion) is possible.
virtual void print(std::ostream &out=std::cout) const
Print information about the goal data structure to a stream.
Definition of an abstract state.
virtual bool isSatisfied(const State *st) const
Equivalent to calling isSatisfied(const State *, double *) with a NULL second argument.
GoalRegion(const SpaceInformationPtr &si)
Create a goal region.