Skip to content
Snippets Groups Projects
Commit 453ee3c4 authored by Joan Vallvé Navarro's avatar Joan Vallvé Navarro
Browse files

debuging messages

parent 64943d6f
No related branches found
No related tags found
1 merge request!16Devel
...@@ -51,7 +51,7 @@ void SubscriberLandmarks::initialize(ros::NodeHandle& nh, const std::string& top ...@@ -51,7 +51,7 @@ void SubscriberLandmarks::initialize(ros::NodeHandle& nh, const std::string& top
void SubscriberLandmarks::callback(const wolf_ros_node::LandmarkDetectionArray::ConstPtr& msg) 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); updateLastHeader(msg->header);
...@@ -91,6 +91,8 @@ void SubscriberLandmarks::callback(const wolf_ros_node::LandmarkDetectionArray:: ...@@ -91,6 +91,8 @@ void SubscriberLandmarks::callback(const wolf_ros_node::LandmarkDetectionArray::
} }
else else
cov = Eigen::Map<const Eigen::Matrix6d>(msg->detections.at(i).pose.covariance.data()); 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 // fill capture
makePosDef(cov); makePosDef(cov);
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment