From 7c5b14d53a0a4aa487bb75eea4f715625da3c08d Mon Sep 17 00:00:00 2001 From: ackimixs Date: Mon, 8 Apr 2024 17:07:56 +0200 Subject: [PATCH] log --- arucoDetector.cpp | 4 +++- 1 file changed, 3 insertions(+), 1 deletion(-) diff --git a/arucoDetector.cpp b/arucoDetector.cpp index a6bbcde..8551ba1 100644 --- a/arucoDetector.cpp +++ b/arucoDetector.cpp @@ -80,6 +80,8 @@ int main(int argc, char *argv[]) client.sendMessage("aruco;strat;get robot_pose;0"); while (true) { + std::cout << robotPose->position.x << " " << robotPose->position.y << " " << robotPose->position.z << " " << robotPose->theta << std::endl; + auto r = detector.detectArucoTags({whiteFlower, purpleFlower, solarPanel}); code = r.first; @@ -100,7 +102,7 @@ int main(int argc, char *argv[]) for (const auto& [tags, matrix] : r.second) { if (tags.type == FLOWER) { - std::cout << tags.id << " " << tags.name << " " << matrix.first << " " << matrix.second << std::endl; + // std::cout << tags.id << " " << tags.name << " " << matrix.first << " " << matrix.second << std::endl; //ArucoDetector::flowerDetector(tags, matrix.first, matrix.first, robotPose); } else if (tags.type == SOLAR_PANEL)