Adds debug prints

moveit · Dec 4, 2024 · 9dd95e8 · 9dd95e8
1 parent 4c3f01e
commit 9dd95e8
Showing 1 changed file with 5 additions and 2 deletions.
diff --git a/moveit_core/robot_state/test/attached_body_test.cpp b/moveit_core/robot_state/test/attached_body_test.cpp
@@ -41,11 +41,12 @@
 #include <urdf_parser/urdf_parser.h>
 #include <gtest/gtest.h>
 
-class SingleLinkRobot : public testing::Test
+class SingleLinkRobot : public ::testing::Test
 {
 public:
   virtual void SetUp() override
   {
+    std::cout << "SingleLinkRobot" << std::endl;
     static const std::string URDF_XML = R"(
       <?xml version="1.0" ?>
       <robot name="single_link_robot">
@@ -90,6 +91,7 @@ class SingleLinkRobot : public testing::Test
     auto srdf_model = std::make_shared<srdf::Model>();
     srdf_model->initString(*urdf_model, SRDF_XML);
     robot_model_ = std::make_shared<moveit::core::RobotModel>(urdf_model, srdf_model);
+    std::cout << robot_model_->getName() << std::endl;
   }
 
   virtual void TearDown() override
@@ -102,9 +104,10 @@ class SingleLinkRobot : public testing::Test
 
 class SingleAttachedBody : public SingleLinkRobot
 {
-public:
+protected:
   virtual void SetUp() override
   {
+    std::cout << "SingleAttachedBody" << std::endl;
     const moveit::core::LinkModel* link = robot_model_->getLinkModel("link");
     std::string name = "root_body";
     Eigen::Isometry3d pose;