From 80acfc80499dec111ed5962e8bb1a3bef41a6f12 Mon Sep 17 00:00:00 2001 From: Sem van der Hoeven Date: Mon, 17 Apr 2023 15:06:27 +0200 Subject: [PATCH] show position even when invalid --- src/beacon_positioning/src/tracker_position.cpp | 9 +++++---- 1 file changed, 5 insertions(+), 4 deletions(-) diff --git a/src/beacon_positioning/src/tracker_position.cpp b/src/beacon_positioning/src/tracker_position.cpp index 6b5d13ad..b5010ec4 100644 --- a/src/beacon_positioning/src/tracker_position.cpp +++ b/src/beacon_positioning/src/tracker_position.cpp @@ -81,10 +81,10 @@ private: void timer_callback() { - auto message = std_msgs::msg::String(); - message.data = "Hello beacons!"; - RCLCPP_INFO(this->get_logger(), "Publishing: '%s'", message.data.c_str()); - publisher_->publish(message); + // auto message = std_msgs::msg::String(); + // message.data = "Hello beacons!"; + // RCLCPP_INFO(this->get_logger(), "Publishing: '%s'", message.data.c_str()); + // publisher_->publish(message); } rclcpp::TimerBase::SharedPtr timer_; // timer to trigger the @@ -123,6 +123,7 @@ int main(int argc, char **argv) else { RCLCPP_ERROR(node->get_logger(), "invalid tracker position"); + RCLCPP_INFO(node->get_logger(), "x = %f, y = %f, z = %f", tracker_msg.tracker_position_xyz[0], tracker_msg.tracker_position_xyz[1], tracker_msg.tracker_position_xyz[2]); } }); rtls_device.startReadingStream();