Merge pull request #60 from jensenb/patchedIndigo

Update KDL SegmentMap interface to optionally use shared pointers
This commit is contained in:
Ioan A Sucan 2014-07-21 14:52:52 -07:00
commit 7ed4ca8cd7
1 changed files with 4 additions and 4 deletions

View File

@ -46,13 +46,13 @@ using namespace urdf;
void printLink(const SegmentMap::const_iterator& link, const std::string& prefix) 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; cout << prefix << "- Segment " << GetTreeElementSegment(link->second).getName() << " has "
for (unsigned int i=0; i<link->second.children.size(); i++) << GetTreeElementChildren(link->second).size() << " children" << endl;
printLink(link->second.children[i], prefix + " "); for (unsigned int i=0; i < GetTreeElementChildren(link->second).size(); i++)
printLink(GetTreeElementChildren(link->second)[i], prefix + " ");
} }
int main(int argc, char** argv) int main(int argc, char** argv)
{ {
if (argc < 2){ if (argc < 2){