Moveit-Problem with RRT*-approximate solutions
I am facing a strange issue while planning using RRTstarkConfigDefault planner in moveit. Sometimes,while planning for a goal target the planner seems to find an approximate solution according to logs.It also says that solution was found by one or more thread in the specified time.But then,no execution is attempted.
Can soemone please explain what approximate solution actually is and why can't it be executed.Also,Is there an option to force moveit to execute the approximate solution?
My setup is a UR5 mounted on a pedestal ,and the environment has collision objects in it. Ubuntu 14.04 ROS Indigo moveit.
Attaching moveit logs for the same below:-
[ INFO] [1507280698.348545594]: Combined planning and execution request received for MoveGroup action. Forwarding to planning and execution pipeline.
[ INFO] [1507280698.348666202]: Planning attempt 1 of at most 1
[ERROR] [1507280698.348754174]: Found empty JointState message
[ERROR] [1507280698.348780671]: Found empty JointState message
[ERROR] [1507280698.349093940]: Found empty JointState message
[ERROR] [1507280698.350262806]: Found empty JointState message
[ INFO] [1507280698.350590933]: No optimization objective specified, defaulting to PathLengthOptimizationObjective
[ INFO] [1507280698.350630246]: Planner configuration 'manipulator[RRTstarkConfigDefault]' will use planner 'geometric::RRTstar'. Additional configuration parameters will be set when the planner is constructed.
[ INFO] [1507280698.350689544]: manipulator[RRTstarkConfigDefault]: problem definition is not set, deferring setup completion...
[ INFO] [1507280698.350838742]: manipulator[RRTstarkConfigDefault]: problem definition is not set, deferring setup completion...
[ INFO] [1507280698.350862872]: manipulator[RRTstarkConfigDefault]: problem definition is not set, deferring setup completion...
[ INFO] [1507280698.350885261]: manipulator[RRTstarkConfigDefault]: problem definition is not set, deferring setup completion...
[ INFO] [1507280698.350907908]: manipulator[RRTstarkConfigDefault]: problem definition is not set, deferring setup completion...
[ INFO] [1507280698.351071265]: manipulator[RRTstarkConfigDefault]: Starting planning with 1 states already in datastructure
[ INFO] [1507280698.351086324]: manipulator[RRTstarkConfigDefault]: Initial k-nearest value of 3
[ INFO] [1507280698.354906766]: manipulator[RRTstarkConfigDefault]: Starting planning with 1 states already in datastructure
[ INFO] [1507280698.354987262]: manipulator[RRTstarkConfigDefault]: Initial k-nearest value of 3
[ INFO] [1507280698.357250876]: manipulator[RRTstarkConfigDefault]: Starting planning with 1 states already in datastructure
[ INFO] [1507280698.357358566]: manipulator[RRTstarkConfigDefault]: Initial k-nearest value of 3
[ INFO] [1507280698.360848714]: manipulator[RRTstarkConfigDefault]: Starting planning with 1 states already in datastructure
[ INFO] [1507280698.360891911]: manipulator[RRTstarkConfigDefault]: Initial k-nearest value of 3
[ INFO] [1507280703.350975734]: ProblemDefinition: Adding approximate solution from planner manipulator[RRTstarkConfigDefault]
[ INFO] [1507280703.351005586]: manipulator[RRTstarkConfigDefault]: Created 82 new states. Checked 912 rewire options. 0 goal states in tree.
[ INFO] [1507280703.356613843]: ProblemDefinition: Adding approximate solution from planner manipulator[RRTstarkConfigDefault]
[ INFO] [1507280703.356692535]: manipulator[RRTstarkConfigDefault]: Created 144 new states. Checked 1839 rewire options. 0 goal states in tree.
[ INFO] [1507280703.360130203]: ProblemDefinition: Adding approximate solution from planner manipulator[RRTstarkConfigDefault]
[ INFO] [1507280703.360175768]: manipulator[RRTstarkConfigDefault]: Created 130 new states. Checked 1618 rewire options. 0 goal states in tree.
[ INFO] [1507280703.360449584]: ProblemDefinition: Adding approximate solution from planner manipulator[RRTstarkConfigDefault]
[ INFO] [1507280703.360471566]: manipulator[RRTstarkConfigDefault]: Created 85 new states. Checked 954 rewire options. 0 goal states in tree.
[ INFO] [1507280703.360524287]: ProblemDefinition: Adding approximate solution from planner PathHybridization
[ INFO] [1507280703.360546064]: ParallelPlan::solve(): Solution found by one or more threads in 5.009625 seconds ...
Please do not use images to show us console text. Copy-paste the text from the console into your question, select it, and press the Preformatted Text button (the one with
101010on it).cool..!! My bad.!!
I have not worked with RRTstar myself, because we noticed a latent segfault with it every so often (see https://github.com/ros-planning/movei... ) What kind of goal do you specify? I'm confused by
0 goal states in tree. If the system doesn't know where to go, how can it find a solution?I specified the goal using RVIZ in the above case i.e Motion Planning->Select Goal sate->random valid ->update.
However,I have also noticed the same behaviour when i specified goal using move_group.setJointValueTarget() , and the joint values given were reachable,within limits and collision free.
Regarding the segfault problem in kinetic,I observed the same too. My current system run indigo and I have replaced RRT* with PRM* for the time being,both of them being asymptotically optimal,haven't noticed 0 goal state and approximate solution problem with PRM*.
@Anirudh_s: Did you find a solution for this behavior? I have the same issue with RRT*, I am using it with baxter simulator, ubuntu 14.04 ROS Indigo also