MoveIt found solution, but is unable to solve the planning problem

asked 2023-02-06 20:53:49 -0500

bach gravatar image

updated 2023-02-06 20:58:56 -0500

Hi,

I am facing a very strange problem. I am sending a goal in joint space with a real UR5 like

def go_with_joint_values(mgc, jvs):
    mgc.set_joint_value_target(jvs)
    success = mgc.go()
   mgc.stop()
   mgc.clear_pose_targets()
   rospy.sleep(rospy.Duration.from_sec(1))
   return success

But I get this output from MoveIt:

 [ INFO] [1675737816.007575299]: Combined planning and execution request received for MoveGroup action. Forwarding to planning and execution pipeline.
[ INFO] [1675737816.007613763]: Planning attempt 1 of at most 1
[ INFO] [1675737816.008352403]: Planner configuration 'leftarm' will use planner 'geometric::RRTConnect'. Additional configuration parameters will be set when the planner is constructed.
[ INFO] [1675737816.008571076]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1675737821.008607091]: RRTConnect: Created 1646 states (1006 start + 640 goal)
[ INFO] [1675737821.008640738]: ProblemDefinition: Adding approximate solution from planner RRTConnect
[ INFO] [1675737821.008651719]: Solution found in 5.000231 seconds
[ WARN] [1675737821.008661419]: Computed solution is approximate
[ INFO] [1675737821.008671372]: Unable to solve the planning problem

I really do not understand the problem (a couple of weeks ago it was all ok...). With rviz I am able to move the robot to a pose that is very close to the target one. Also using setting a goal in cartesian space works. I am using a dual arm system and the other robot has no problems.

Any suggestion on how to debug this error?

Thank you in advance!

edit retag flag offensive close merge delete