diff --git a/arucoDetector.cpp b/arucoDetector.cpp index 321fb16..b5fe987 100644 --- a/arucoDetector.cpp +++ b/arucoDetector.cpp @@ -62,6 +62,8 @@ int main(int argc, char *argv[]) client.sendMessage("aruco;strat;get robot_pose;0"); + auto lastArucoFind = std::chrono::high_resolution_clock::now(); + while (true) { auto r = detector.detectArucoTags({whiteFlower, purpleFlower, solarPanel}); @@ -87,6 +89,10 @@ int main(int argc, char *argv[]) if (tags.type == FLOWER) { std::cout << tags.id << " " << tags.name << " " << matrix.first.at(2, 0) << " " << matrix.first.at(0, 0) << std::endl; //ArucoDetector::flowerDetector(tags, matrix.first, matrix.first, robotPose); + auto now = std::chrono::high_resolution_clock::now(); + std::cout << "Time since last find: " << std::chrono::duration_cast(now - lastArucoFind).count() << "ms" << std::endl; + + lastArucoFind = now; } else if (tags.type == SOLAR_PANEL) {