From 9869a67924989bc132a5a0873fc8d2e1e5db4141 Mon Sep 17 00:00:00 2001 From: Jackie Kay Date: Wed, 9 Dec 2015 16:21:38 -0800 Subject: [PATCH] Revert debug statements in kdl_parser.cpp --- kdl_parser/src/kdl_parser.cpp | 8 ++------ 1 file changed, 2 insertions(+), 6 deletions(-) diff --git a/kdl_parser/src/kdl_parser.cpp b/kdl_parser/src/kdl_parser.cpp index ee41acf..4b8c3ab 100644 --- a/kdl_parser/src/kdl_parser.cpp +++ b/kdl_parser/src/kdl_parser.cpp @@ -168,19 +168,15 @@ bool treeFromXml(TiXmlDocument *xml_doc, Tree& tree) bool treeFromUrdfModel(const urdf::ModelInterface& robot_model, Tree& tree) { tree = Tree(robot_model.getRoot()->name); - ROS_INFO("constructed tree"); // warn if root link has inertia. KDL does not support this if (robot_model.getRoot()->inertial) ROS_WARN("The root link %s has an inertia specified in the URDF, but KDL does not support a root link with an inertia. As a workaround, you can add an extra dummy link to your URDF.", robot_model.getRoot()->name.c_str()); // add all children - for (size_t i=0; ichild_links.size(); i++) { - ROS_INFO("Adding link to KDL tree"); - if (!addChildrenToTree(robot_model.getRoot()->child_links[i], tree)) { + for (size_t i=0; ichild_links.size(); i++) + if (!addChildrenToTree(robot_model.getRoot()->child_links[i], tree)) return false; - } - } return true; }