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](https://pastebin.com/xW6ED33h)). 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).
[URDF file here](https://github.com/ardop2/ardop2/blob/master/ardop_description/urdf/ardop_description.urdf).
[My MoveIt Config package here.](https://github.com/ardop2/ardop2/tree/master/ardop_moveit_config)
Image of my robot for reference:
↧