From 9dd95e8e6522bbb4a56ebd4776eda30eedf30b86 Mon Sep 17 00:00:00 2001
From: Tom Noble <t.s.noble@outlook.com>
Date: Wed, 4 Dec 2024 19:35:29 +0000
Subject: [PATCH] Adds debug prints

---
 moveit_core/robot_state/test/attached_body_test.cpp | 7 +++++--
 1 file changed, 5 insertions(+), 2 deletions(-)

diff --git a/moveit_core/robot_state/test/attached_body_test.cpp b/moveit_core/robot_state/test/attached_body_test.cpp
index e75aa320c8..6def7adb58 100644
--- 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;