[Solved] Moveit Pick - Grapper closes into collision object and fails to grap

asked 2020-08-15 12:05:00 -0600

Fatalon gravatar image

updated 2020-12-05 10:54:23 -0600

I am using a Franka Emika robot with a gripper mounted as eef and control his movements in the simulation environment gazebo via the moveit package. I rebuilt the entire scene in rviz (including all collision objects) to estimate valid actions in moveit.

But when I try to grap a collision object (in my case it is a hanoi tower token, which is put onto a pipe) - the robot moves into the appropriate pose, opens the gripper - and closes it ignoring the properties of the token - resulting in an abort and pushing the token in gazebo away.

I followed the tutorial instructions (http://docs.ros.org/kinetic/api/movei...) and also tried to adjust the max contact force or directly change the properties of the closedGrapper, but nothing really worked out. The gripper touches the token and the token starts to fly away, bug or wobbles around, but it is not really grapped..

The complete sourcecode is provided at https://gitlab.com/Fatalon/pandarobot..., but the most important parts should be the hanoi_planner/src/PlannerNode.cpp containing the pick and place instructions. If further source code (like gazebo setup) is required, let me know and i will post the requested parts below this question, but everything is based on https://github.com/erdalpekel image description image description

edit retag flag offensive close merge delete

Comments

kind of solved by switching to effort based controller (but they had problems applying any force) therefore i switched back again to position based Controller and fine tuning the position in which the grapper should stop closing

Fatalon gravatar imageFatalon ( 2020-12-05 10:53:57 -0600 )edit