Manipulator with multiple tip_links in SRDF.
I have a robot manipulator with one effector and two tip links (tool0,tool1). My tool has 4 fingers mounted in 2 pairs in a 90-degree angle. So there is no actuated joint between those two tip links, both finger pairs are actuated by the same gripper.
What I want to achieve is to make planning to both tip links possible in MoveIt. I managed to get both displayed in RViz by specifying 2 end-effectors. However, I get some complaints on the console output.
[ WARN] [1571994439.576069188]: Could not identify parent group for end-effector 'gripper0'
[ WARN] [1571994439.576094887]: Could not identify parent group for end-effector 'gripper1'
[ERROR] [1571994439.576049115]: Group 'manipulator' was specified as parent group for end-effector 'gripper0' but it does not include the parent link 'tool0'
[ERROR] [1571994439.576085790]: Group 'manipulator' was specified as parent group for end-effector 'gripper1' but it does not include the parent link 'tool1'
My SRDF looks as follows.
<group name="manipulator">
<chain base_link="borunte_stand_link" tip_link="flange" />
</group>
<group name="gripper0">
<joint name="flange-tool0"/>
<link name="tool0" />
</group>
<group name="gripper1">
<joint name="flange-tool1"/>
<link name="tool1" />
</group>
<!--END EFFECTOR: Purpose: Represent information about an end effector.-->
<end_effector name="gripper0" parent_link="tool0" group="gripper0" parent_group="manipulator"/>
<!--<end_effector name="gripper0" parent_link="flange" group="gripper0" parent_group="manipulator" />-->
<end_effector name="gripper1" parent_link="tool1" group="gripper1" parent_group="manipulator" />
Here is how it looks in RViz
Any ideas on how to make this work correctly?
NOTE: I noticed that I can make one of the error messages go away by specifying tool0 as the tip_link in the manipulator chain. However, adding and the additional link tool1 or joint breaks the kinematic chain.
The whole SRDF can be found here: SRDF and the URDF here: URDF files
just a comment: it's not accepted yet (nor submitted), but see Coordinate Frames for Serial Industrial Manipulators: Application-Specific Tool Frames for why using
toolNfor actual application tool frames is strongly discouraged.Edit: if you just happen to use the name
tool0andtool1for frames on your robot, but are not concerned by any of the ideas described in that REP, then please ignore my comment of course.Thanks. So the way to go is to move tool0 to the flange position and to convert the application EEF to the tool0 frame before planning? Would I drag around tool0 or one of the EEF's in RViz?
Note that this question might be related to: https://answers.ros.org/question/3136...
The Moveit RViz plugin always seems to position the virtual marker at the end effector parent_link. That explains why my first attempt at defining two end effectors with the actual tool eefs as parent_link worked for the visualization RViz.
I'm still not sure what is the correct way to make this work with Moveit and RViz.
if that is where your robot controller has its "unconfigured / all-zeros" toolframe, then: yes.
tool0should correspond to the all-zeros toolframe position.If you mean: manually transforms all target poses for the EEF to
tool0, then: no.My suggestion would be to remove your
tool1, add two new toolframes with appropriate names (or perhapsgripper0andgripper1already capture the semantics of those toolframes sufficiently) and makeflangethe parent of both those new toolframes.That would get everything compliant with the (future) REP (on the tool side, I don't know about the rest of your robot).
Okay, this makes sense. However, I couldn't get Moveit to use those 2 EEFs, at least not in RViz.
Did you find a solution @machinekoder? My robot also has two tip links and I could't find the best way to make planning with both of them