From 453ee3c48beedf3e832e5d08e20ebee1f951071b Mon Sep 17 00:00:00 2001
From: jvallve <jvallve@iri.upc.edu>
Date: Thu, 13 Oct 2022 21:04:32 +0200
Subject: [PATCH] debuging messages
---
src/subscriber_landmarks.cpp | 4 +++-
1 file changed, 3 insertions(+), 1 deletion(-)
diff --git a/src/subscriber_landmarks.cpp b/src/subscriber_landmarks.cpp
index 5acb060..68cc76a 100644
--- a/src/subscriber_landmarks.cpp
+++ b/src/subscriber_landmarks.cpp
@@ -51,7 +51,7 @@ void SubscriberLandmarks::initialize(ros::NodeHandle& nh, const std::string& top
void SubscriberLandmarks::callback(const wolf_ros_node::LandmarkDetectionArray::ConstPtr& msg)
{
- ROS_INFO("SubscriberLandmarks::callback");
+ ROS_INFO("SubscriberLandmarks::callback: %lu detections", msg->detections.size());
updateLastHeader(msg->header);
@@ -91,6 +91,8 @@ void SubscriberLandmarks::callback(const wolf_ros_node::LandmarkDetectionArray::
}
else
cov = Eigen::Map<const Eigen::Matrix6d>(msg->detections.at(i).pose.covariance.data());
+
+ std::cout << "\tid " << msg->detections.at(i).id << ": quality: " << msg->detections.at(i).quality << ", meas: " << meas.transpose() << std::endl;
// fill capture
makePosDef(cov);
--
GitLab