diff --git a/aruco/ArucoDetector.cpp b/aruco/ArucoDetector.cpp index 12073a8..bfc2ca8 100644 --- a/aruco/ArucoDetector.cpp +++ b/aruco/ArucoDetector.cpp @@ -204,7 +204,7 @@ std::pair>>> Ar cv::Mat rotaEuler = (cv::Mat_(3, 1) << roll, pitch, yaw); // Apply the homogeneous transformation to tvec - cv::Mat translat = (cv::Mat_(4, 1) << tvec.at(2, 0) + 91/* TODO camera is not at the center*/ /* TODO la pince n'est pas au millieu non plus*/, tvec.at(1, 0) /* + TODO HAUTEUR CAMERA */, (tvec.at(0, 0)), 1); + cv::Mat translat = (cv::Mat_(4, 1) << tvec.at(2, 0), tvec.at(1, 0), (tvec.at(0, 0)), 1); result.second.emplace_back(tag, std::make_pair(translat, rotaEuler)); }