diff --git a/kdl_parser/src/check_kdl_parser.cpp b/kdl_parser/src/check_kdl_parser.cpp index 4d33480a..1dd0a6d2 100644 --- a/kdl_parser/src/check_kdl_parser.cpp +++ b/kdl_parser/src/check_kdl_parser.cpp @@ -46,13 +46,13 @@ using namespace urdf; void printLink(const SegmentMap::const_iterator& link, const std::string& prefix) { - cout << prefix << "- Segment " << link->second.segment.getName() << " has " << link->second.children.size() << " children" << endl; - for (unsigned int i=0; isecond.children.size(); i++) - printLink(link->second.children[i], prefix + " "); + cout << prefix << "- Segment " << GetTreeElementSegment(link->second).getName() << " has " + << GetTreeElementChildren(link->second).size() << " children" << endl; + for (unsigned int i=0; i < GetTreeElementChildren(link->second).size(); i++) + printLink(GetTreeElementChildren(link->second)[i], prefix + " "); } - int main(int argc, char** argv) { if (argc < 2){