sem/5g_drone_ROS2
1
0
Fork 0
Code Issues 1 Pull Requests 1 Actions Packages Projects Releases Wiki Activity

show position even when invalid

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-04-17 15:11:13 +02:00
parent 80acfc8049
commit b0d8be45b3
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
src/beacon_positioning/src/tracker_position.cpp
View File

@@ -115,7 +115,7 @@ int main(int argc, char **argv)
{ {
if (tracker_msg.is_valid_position) if (tracker_msg.is_valid_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]); RCLCPP_INFO(node->get_logger(), "x = %f, y = %f, z = %f", tracker_msg.tracker_position_xyz.at(0), tracker_msg.tracker_position_xyz.at(1), tracker_msg.tracker_position_xyz.at(2));
auto message = std_msgs::msg::String(); auto message = std_msgs::msg::String();
message.data = "Hello from tracker callback!"; message.data = "Hello from tracker callback!";
node->publish(message); node->publish(message);
@@ -123,7 +123,7 @@ int main(int argc, char **argv)
else else
{ {
RCLCPP_ERROR(node->get_logger(), "invalid tracker position"); 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]); // 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(); rtls_device.startReadingStream();