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

Finished object detection nodes #3

Merged
SemvdH merged 107 commits from object_detection into main 2023-04-24 10:41:13 +00:00
Conversation 0 Commits 107 Files Changed 169 +2 -2
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Showing only changes of commit 2428ad6855 - Show all commits

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

@@ -116,9 +116,9 @@ 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 struct anchor_data_t &anchor : tracker_msg.anchors_data)
for (int i = 0; i < tracker_msg.anchors_data.size(); i++)
{
RCLCPP_INFO(node->get_logger(), "anchor number= %d, distance = %f, x = %f, y = %f, z = %f", anchor->number, anchor->distance, anchor->pos_x, anchor->pos_y, anchor->pos_z);
RCLCPP_INFO(node->get_logger(), "anchor number= %d, distance = %f, x = %f, y = %f, z = %f", tracker_msg.anchors_data[i].number, tracker_msg.anchors_data[i].distance, tracker_msg.anchors_data[i].pos_x, tracker_msg.anchors_data[i].pos_y, tracker_msg.anchors_data[i].pos_z);
}
RCLCPP_INFO(node->get_logger(), "");
auto message = std_msgs::msg::String();