How to calculate covariance matrix for monocular SLAM?

asked 2014-07-31 11:05:29 -0500

PedroGusmao gravatar image

Hi there, I am using a single camera for visual odometry. The camera is fixed to the robot and I use the common approach of matching descriptors between consecutive frames and then estimating the rotation and translation using SVD. The camera is already calibrated and I already have the points in 3D position.

From the rotation matrix and the translation matrix I can obtain the the rotation angles and the new position x,y,z of the robot.

My question then is: How can I estimate the covariance matrix for theses values in order to publish an nav_msgs::Odometry matrix? I suspect that I have to backpropagate the points from one frame to the other, but I am not sure. Any references to papers/books are also welcome =)

Thanks in advance,

Pedro

edit retag flag offensive close merge delete