diff --git a/aruco/ArucoDetector.cpp b/aruco/ArucoDetector.cpp index 61330a9..afea84b 100644 --- a/aruco/ArucoDetector.cpp +++ b/aruco/ArucoDetector.cpp @@ -189,8 +189,8 @@ std::pair>>> Ar cv::Mat rotationMatrix; cv::Rodrigues(rvec, rotationMatrix); - std::cout << rvec << std::endl; - std::cout << rotationMatrix << std::endl; + // std::cout << rvec << std::endl; + // std::cout << rotationMatrix << std::endl; // Extract Euler angles from the rotation matrix double roll, pitch, yaw; @@ -199,7 +199,7 @@ std::pair>>> Ar yaw = atan2(-rotationMatrix.at(1, 0), rotationMatrix.at(0, 0)); // Angles can be used to calculate the distance to the center of the flower. - std::cout << roll << " " << pitch << " " << yaw << std::endl << std::endl; + // std::cout << roll << " " << pitch << " " << yaw << std::endl << std::endl; cv::Mat rotaEuler = (cv::Mat_(3, 1) << roll, pitch, yaw); diff --git a/tcp/MyClient.cpp b/tcp/MyClient.cpp index a1fbc80..71f10df 100644 --- a/tcp/MyClient.cpp +++ b/tcp/MyClient.cpp @@ -33,6 +33,8 @@ void MyClient::handleMessage(const std::string& message) } } + std::cout << "Sent to client " << res << std::endl; + this->sendMessage(res.c_str()); } else if (messageSplited[2] == "ping") {