MoveIt cannot plan for pose goal

asked 2023-02-25 10:42:18 -0500

reuge gravatar image

updated 2023-02-26 12:47:25 -0500

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.

edit retag flag offensive close merge delete