diff --git a/src/parsers/urdf/model.cpp b/src/parsers/urdf/model.cpp index 9284ec16e8b5f74ec81b5969b383e426408bb7d0..5ec63c01c6144392a29100a24f1e6c5faf6fc52b 100644 --- a/src/parsers/urdf/model.cpp +++ b/src/parsers/urdf/model.cpp @@ -403,14 +403,7 @@ namespace se3 // -add fixed body in model to display it in gepetto-viewer joint_info << "fixed joint"; - // FIXME: This should be: - // appendBodyToJoint(model, parent_joint_id, Y, link_name); - // but I do not understand why the two placement arguments are - // different. - if (link->inertial) { - model.appendBodyToJoint(parent_joint_id, convertFromUrdf(*Y), jointPlacement, link->name); //Modify the parent inertia in the model - } else - model.addFrame(link->name, parent_joint_id, nextPlacementOffset, BODY); + appendBodyToJoint(model, parent_joint_id, Y, jointPlacement, link_name); //transformation of the current placement offset nextPlacementOffset = jointPlacement;