MoveIt found solution, but is unable to solve the planning problem
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!