bkinnightskytw
/
kdl_parser
mirror of https://github.com/existedinnettw/kdl_parser.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Fix values in kdl_parser test

This commit is contained in:
Jackie Kay 2015-12-09 16:32:45 -08:00
parent 9869a67924
commit 612d433920
1 changed files with 5 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
kdl_parser/test/test_kdl_parser.cpp
View File

@ -71,13 +71,13 @@ TEST_F(TestParser, test)
}
ASSERT_TRUE(treeFromFile(g_argv[g_argc-1], my_tree));
ASSERT_EQ(my_tree.getNrOfJoints(), 3);
ASSERT_EQ(my_tree.getNrOfSegments(), 4);
ASSERT_TRUE(my_tree.getSegment("link1") == my_tree.getRootSegment());
ASSERT_EQ(my_tree.getNrOfJoints(), 8);
ASSERT_EQ(my_tree.getNrOfSegments(), 16);
ASSERT_TRUE(my_tree.getSegment("dummy_link") == my_tree.getRootSegment());
ASSERT_EQ(my_tree.getRootSegment()->second.children.size(), (unsigned int)1);
ASSERT_TRUE(my_tree.getSegment("base_link")->second.parent == my_tree.getRootSegment());
ASSERT_EQ(my_tree.getSegment("base_link")->second.segment.getInertia().getMass(), 116.0);
ASSERT_NEAR(my_tree.getSegment("base_link")->second.segment.getInertia().getRotationalInertia().data[0], 15.6107, 0.001);
ASSERT_EQ(my_tree.getSegment("base_link")->second.segment.getInertia().getMass(), 10.0);
ASSERT_NEAR(my_tree.getSegment("base_link")->second.segment.getInertia().getRotationalInertia().data[0], 1.000, 0.001);
SUCCEED();
}