diff --git a/aruco_pose/src/aruco_pose.cpp b/aruco_pose/src/aruco_pose.cpp index 7723dd35..11fad954 100644 --- a/aruco_pose/src/aruco_pose.cpp +++ b/aruco_pose/src/aruco_pose.cpp @@ -157,8 +157,8 @@ cv::Point3f ArucoPose::getObjPointsCenter(cv::Mat objPoints) { for (int i = 0; i < objPoints.rows; i++) { max_x = std::max(max_x, objPoints.at(i, 0)); max_y = std::max(max_y, objPoints.at(i, 1)); - min_x = std::min(max_x, objPoints.at(i, 0)); - min_y = std::min(max_y, objPoints.at(i, 1)); + min_x = std::min(min_x, objPoints.at(i, 0)); + min_y = std::min(min_y, objPoints.at(i, 1)); } cv::Point3f res((min_x + max_x) / 2, (min_y + max_y) / 2, 0); return res;