Question

我正在使用aruco标记来获取机器人的位置。从estimatePoseSingleMarkers获取姿势后，我获得给定标记的rvecs和tvecs。由此我如何获得标记绕每个轴的旋转角度。

我使用下面的代码来检测和绘制aruco标记及其轴

while(true)
{
    vector< vector<Point2f>> corners; //All the Marker corners 
    vector<int> ids;

    cap >> frame;
    cvtColor(frame, gray, CV_BGR2GRAY);

    aruco::detectMarkers(gray, dictionary, corners, ids);
    aruco::drawDetectedMarkers(frame,corners,ids);
    aruco::estimatePoseSingleMarkers(corners, arucoMarkerLength, cameraMatrix, distanceCoefficients, rvecs, tvecs);

    for(int i = 0; i < ids.size(); i++)
    {
        aruco::drawAxis(frame, cameraMatrix, distanceCoefficients, rvecs[i], tvecs[i], 0.1f);
    }

    imshow("Markers", frame);
    int key = waitKey(10);
    if((char)key == 'q')
        break;
}

Answer 1

通过首先从旋转矢量（rvec）获取旋转矩阵然后通过获取欧拉角来获得标记相对于相机的旋转。 Converting Rotation matrix to Eurler angles are given here

如何计算OpenCV rvecs的旋转角度

1 个答案: