change position system

This commit is contained in:
ackimixs
2024-04-08 17:51:52 +02:00
parent ba28a36bec
commit 182000ded6

View File

@@ -206,7 +206,7 @@ std::pair<int, std::vector<std::pair<ArucoTag, std::pair<cv::Mat, cv::Mat>>>> Ar
cv::Mat rotaEuler = (cv::Mat_<double>(3, 1) << roll, pitch, yaw);
// Apply the homogeneous transformation to tvec
cv::Mat translat = (cv::Mat_<double>(4, 1) << tvec.at<double>(0, 0), tvec.at<double>(1, 0), tvec.at<double>(2, 0), 1);
cv::Mat translat = (cv::Mat_<double>(4, 1) << tvec.at<double>(2, 0), tvec.at<double>(1, 0), tvec.at<double>(0, 0), 1);
cv::Mat transformedTvec = (transformationMatrix * translat);