37 #include <ompl/base/SpaceInformation.h>
38 #include <ompl/base/spaces/SE3StateSpace.h>
39 #include <ompl/geometric/planners/rrt/RRTConnect.h>
40 #include <ompl/geometric/SimpleSetup.h>
42 #include <ompl/config.h>
45 namespace ob = ompl::base;
46 namespace og = ompl::geometric;
63 return (
void*)rot != (
void*)pos;
82 si->setStateValidityChecker(boost::bind(&isStateValid, _1));
96 pdef->setStartAndGoalStates(start, goal);
102 planner->setProblemDefinition(pdef);
109 si->printSettings(std::cout);
112 pdef->print(std::cout);
122 std::cout <<
"Found solution:" << std::endl;
125 path->print(std::cout);
128 std::cout <<
"No solution found" << std::endl;
131 void planWithSimpleSetup(
void)
147 ss.setStateValidityChecker(boost::bind(&isStateValid, _1));
158 ss.setStartAndGoalStates(start, goal);
169 std::cout <<
"Found solution:" << std::endl;
171 ss.simplifySolution();
172 ss.getSolutionPath().print(std::cout);
175 std::cout <<
"No solution found" << std::endl;
178 int main(
int,
char **)
180 std::cout <<
"OMPL version: " << OMPL_VERSION << std::endl;
184 std::cout << std::endl << std::endl;
186 planWithSimpleSetup();