Collision between gripper flange and robot flange detected
Hi!
At the moment I am trying to attach a gripper to my FANUC robot. The gripper appears in the visualization at the correct place but the moveit motion planning did not work anymore. I am thinking the problem is a detected collision between the gripper base body (base_gripper) and the gripper fingers (left_gripper) of the robot.
[ INFO] [1633519835.487152730]: Found a contact between 'base_gripper' (type 'Robot link') and 'left_gripper' (type 'Robot link'), which constitutes a collision. Contact information is not stored. [ INFO] [1633519835.487205588]: Collision checking is considered complete (collision was found and 0 contacts are stored) [ INFO] [1633519835.487263046]: Start state appears to be in collision with respect to group manipulator
Following the definition of the combination of gripper and robot:
<?xml version="1.0" ?>
<robot name="fanuc_cr7ial" xmlns:xacro="http://wiki.ros.org/xacro">
<xacro:include filename="$(find fanuc_cr7ia_support)/urdf/cr7ial_macro.xacro"/>
<xacro:fanuc_cr7ial prefix=""/>
<xacro:include filename="$(find laborroboter)/urdf/gripper_macro.xacro"/>
<xacro:gripper prefix=""/>
<!-- attach gripper to Cr7iAl model -->
<joint name="robot_flange-top_link" type="fixed">
<origin xyz="0 0 0" rpy="${pi} ${-pi/2} 0" />
<parent link="flange" />
<child link="top_link" />
</joint>
</robot>
How can I add contact information for this joint?
Thanks in advance!
nico
Doesn't the error message say something else? Specifically:
those are both not
flange
, but different links.Probably in your gripper model.
Also: why are you not using a
prefix
for the robot and the gripper models?You are right. I tested it without the gripperfingers and than the error was like descripted. Sorry for this misconception. The fault is the same, a collision between to parts of the robot which are fixed together.
I do not use a prefix because I do not understand the reason for this. My robot is really simple. In a first step I try it to work and I will understand it on the way to this. ;)
Then please either update your description, or update the error message to agree with what you describe.
Right now it's just confusing.
In any case: did you re-run the MoveIt Setup Assistant (MSA) after changing your
.xacro
? And more specifically: did you update the Allowed Collision Matrix using the MSA?I updated it.
MSA: No, I just edited and created the xacro files and after that I started ros with "roslaunch...".
Now, I am in the process of re-run it. But do I have to configure the standard FANUC CR-7iaL complete on my one at the first time? I can not load an Moveit configuration package at the standard pkg folder of the fanuc pkg.
As I tried to make clear in your previous question (#q387430), you need to tell MoveIt about your specific setup.
You cannot reuse an existing MoveIt configuration package with a different or new robot (well, you can, but it would require runtime changes, and if you're just starting out that may not be the approach I'd recommend to try first).
Adding a gripper to an existing robot model is essentially the same as "a new robot".
MoveIt not being aware of two links always being in contact because they are right next to each other due to how the robot is constructed is exactly one of those things which the MoveIt Setup Assistant will discover and then store in your MoveIt configuration package.
In this case you need to update the ACM.
Hi! I am sorry for my late reply. For me, it is not possible to work fulltime at this project, but I am still track on it.
In the last days, it was possible for me to create a new (own) robot with gripper, based on the FANUC package. For this I created two more packages (rebuild multiple times):
After this warm feeling of success I get new problems… I think the geometry is correct. The output of
urdf_to_graphiz
shows a smooth and logical structure.I carried out the MSA accordingly to this tutorial: https://ros-planning.github.io/moveit...
A first test of the new moveit package with the command “roslaunch laborroboter_moveit_config demo.launch” starts successfully and I can move and plan the robot. But I get some error messages in the background (extract of messages):
Do you have an idea whats the problem? Best regards!
nico
Those appear to be different problems. It's not a good idea to post (follow-up) questions in comments.
You should post a new question.
If you've solved your current one, please post an answer and accept your own answer.