MoveIt cannot plan for pose goal
Hello! I am moving the Elfin5 robot arm found here using the Move Group Python Interface. I am using the exact example found for the panda arm on MoveIt tutorials and simply changed the group name.
While moving using a joint state goal everything works with no issues at all. I can see the robot moving on Gazebo and it does it correctly. However, while trying to move using pose goal, I get the following error:
ABORTED: No motion plan found. No execution attempted.
The values I am passing are:
pose_goal.orientation.w = 1.0
pose_goal.position.x = 0.0
pose_goal.position.y = 0.3
pose_goal.position.z = 0.15
pose_goal.orientation.x = 0.0
pose_goal.orientation.y = 0.0
pose_goal.orientation.z = 0.0
which I know are correct and the arm is capable to reach this pose in real life. This is the full output I am getting:
*[ INFO] [1677436892.543747070]: IK Using joint elfin_link1 -3.14 3.14
[ INFO] [1677436892.543834021]: IK Using joint elfin_link2 -2.35 2.35
[ INFO] [1677436892.543876383]: IK Using joint elfin_link3 -2.61 2.61
[ INFO] [1677436892.543915523]: IK Using joint elfin_link4 -3.14 3.14
[ INFO] [1677436892.543951155]: IK Using joint elfin_link5 -2.56 2.56
[ INFO] [1677436892.543993124]: IK Using joint elfin_link6 -3.14 3.14
[ INFO] [1677436892.544037068]: Looking in common namespaces for param name: elfin_arm/position_only_ik
[ INFO] [1677436892.546758173]: Looking in common namespaces for param name: elfin_arm/solve_type
[ INFO] [1677436892.549264962]: Using solve type Speed
[ INFO] [1677436893.749406127]: Ready to take commands for planning group elfin_arm.
============ Planning frame: world
============ End effector link: elfin_end_link
============ Available Planning Groups: ['elfin_arm', 'elfin_end_group']
============ Printing robot state
joint_state:
header:
seq: 0
stamp:
secs: 0
nsecs: 0
frame_id: "world"
name:
- elfin_joint1
- elfin_joint2
- elfin_joint3
- elfin_joint4
- elfin_joint5
- elfin_joint6
position: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
velocity: []
effort: []
multi_dof_joint_state:
header:
seq: 0
stamp:
secs: 0
nsecs: 0
frame_id: "world"
joint_names: []
transforms: []
twist: []
wrench: []
attached_collision_objects: []
is_diff: False
============ Press `Enter` to execute a movement using a joint state goal ...
============ Press `Enter` to execute a movement using a pose goal ...
[ INFO] [1677436920.931482722]: ABORTED: No motion plan found. No execution attempted.*
What could be the issue? Any help is appreciated.