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:31:34 +02:00
parent b0d8be45b3
commit 2bb75e4a99
1 changed files with 5 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

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

@@ -116,6 +116,11 @@ int main(int argc, char **argv)
if (tracker_msg.is_valid_position)
{
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));
for (const &anchor_data_t : tracker_msg.anchor_data)
{
RCLCPP_INFO(node->get_logger(), "anchor number= %d, distance = %f, x = %f, y = %f, z = %f", anchor_data_t.number, anchor_data_t.distance, anchor_data_t.pos_x, anchor_data_t.pos_y, anchor_data_t.pos_z);
}
RCLCPP_INFO(node->get_logger(), "");
auto message = std_msgs::msg::String();
message.data = "Hello from tracker callback!";
node->publish(message);