40 cv::Mat rvec = cv::Mat::zeros(3, 1, CV_32FC1);
41 cv::Rodrigues(cv::Mat(
rt_matrix, cv::Rect(0, 0, 3, 3)), rvec);
46 return cv::Mat(
rt_matrix, cv::Rect(3, 0, 1, 3)).clone();
MarkerPose(std::vector< int > ids, std::vector< double > ids_confidence)