Computing camera pose with homography matrix based on 4 coplanar points

by

If you have your Homography, you can calculate the camera pose with something like this:

void cameraPoseFromHomography(const Mat& H, Mat& pose)
{
    pose = Mat::eye(3, 4, CV_32FC1);      // 3x4 matrix, the camera pose
    float norm1 = (float)norm(H.col(0));  
    float norm2 = (float)norm(H.col(1));  
    float tnorm = (norm1 + norm2) / 2.0f; // Normalization value

    Mat p1 = H.col(0);       // Pointer to first column of H
    Mat p2 = pose.col(0);    // Pointer to first column of pose (empty)

    cv::normalize(p1, p2);   // Normalize the rotation, and copies the column to pose

    p1 = H.col(1);           // Pointer to second column of H
    p2 = pose.col(1);        // Pointer to second column of pose (empty)

    cv::normalize(p1, p2);   // Normalize the rotation and copies the column to pose

    p1 = pose.col(0);
    p2 = pose.col(1);

    Mat p3 = p1.cross(p2);   // Computes the cross-product of p1 and p2
    Mat c2 = pose.col(2);    // Pointer to third column of pose
    p3.copyTo(c2);       // Third column is the crossproduct of columns one and two

    pose.col(3) = H.col(2) / tnorm;  //vector t [R|t] is the last column of pose
}

This method works form me. Good luck.

More Related Contents:

  1. opencv c++ Edge detection to find edge that the top of it is white and the bottom is black
  2. How to verify the correctness of calibration of a webcam?
  3. How to define the markers for Watershed in OpenCV?
  4. How to detect colored patches in an image using OpenCV?
  5. How to crop away convexity defects?
  6. Augmented Reality SDK with OpenCV [closed]
  7. Opencv virtually camera rotating/translating for bird’s eye view
  8. Multi otsu(multi-thresholding) with openCV
  9. Are there any fast alternatives to SURF and SIFT for scale-invariant feature extraction?
  10. How is the camera coordinate system in OpenCV oriented?
  11. How to detect ellipses in image without using fitEllipse() in opencv?
  12. How to clean images before OCR with Python OpenCV?
  13. Detect image orientation angle based on text direction
  14. opencv drawing a 2d histogram
  15. Displaying stitched images together without cutoff using warpAffine
  16. Configuring an c++ OpenCV project with Cmake
  17. Horizontal Line detection with OpenCV
  18. Detect and visualize differences between two images with OpenCV Python
  19. sift = cv2.xfeatures2d.SIFT_create() not working even though have contrib installed
  20. MinAreaRect angles – Unsure about the angle returned
  21. Why cv2.so missing after opencv installed?
  22. OpenCV as a static library (cmake options)
  23. Can’t access webcam with OpenCV
  24. module’ object has no attribute ‘drawMatches’ opencv python
  25. How can I determine distance from an object in a video?
  26. how to add border around an image in opencv python
  27. OpenCV Mat element types and their sizes
  28. How to calculate the angle from rotation matrix
  29. Square detection in image
  30. How to warp an image using deformed mesh

Leave a Comment