Unable to plan IK using MoveIt!
I'm using the LMA kinematics plugin to plan motion for a 6DOF arm. I'm able to use the interactive marker freely in Rviz (although some joints keep going in to invalid states or out of the defined joint limits sometimes and turn pink).
Now I am trying set pose targets from python (my script here). If I use get_random_pose()
and set this pose using set_pose_target()
, planning and executing works as expected. However, when I use the same random pose target values and create a custom geometry_msgs.msg.Pose()
object and the set the pose target, I keep getting the following warning:
Python:
[ WARN] [1524579808.359818083, 4184.338000000]: Fail: ABORTED: No motion plan found. No execution attempted.
Moveit:
Error: RRTConnect: Unable to sample any valid states for goal tree
at line 215 in /tmp/binarydeb/ros-kinetic-ompl-1.2.1/src/ompl/geometric/planners/rrt/src/RRTConnect.cpp
Info: RRTConnect: Created 1 states (1 start + 0 goal)
Could it be an issue with my python script or the inverse kinematics? How is planning working with random pose and fails to plan with the same position and orientation values when I create a custom pose object and assign these values? Tried increasing the planning time, attempts and goal tolerance with no luck!
PS: I was unable to use IK fast as it kept failing to solve the IK and with KDL, the interactive marker does not move properly (joints seem to stick at 90 degrees and movement is not free). Actually my arm is 5DOF and I had to include a dummy revolute joint with ilmits (0-0.01) to make the interactive marker work with LMA plugin. IK fast failed to generate for both 6DOF and 5DOF (Raghavan Roth equations too complex error).
My MoveIt Config package here.
Image of my robot for reference:
Have you found IKFAST solution for 5DOF? we are also getting same error like, 'Raghavan Roth equations too complex error'
Nope. You could try adding a dummy joint to make it a 6DOF manipulator and then try solving IK using KDL plugin.
Hello, OP. Did you manage to solve this issue, by any chance? Or at least to find a decent work-around?