raulmur / ORB_SLAM2

Real-Time SLAM for Monocular, Stereo and RGB-D Cameras, with Loop Detection and Relocalization Capabilities
Other
9.37k stars 4.69k forks source link

compute pose covariance #822

Open arianna003 opened 5 years ago

arianna003 commented 5 years ago

Hi, how i can calculate the covariance of the estimated pose ? thanks

AlejandroSilvestri commented 4 years ago

@arianna003 ORB-SLAM2 doesn't use covariance matrix. It uses bundle adjustment - a whole different approach.

If you need to calculate it, you must do it yourself, starting with defining what variables you want to correlate.

mathuse commented 4 years ago

@arianna003 ORB-SLAM2 doesn't use covariance matrix. It uses bundle adjustment - a whole different approach.

If you need to calculate it, you must do it yourself, starting with defining what variables you want to correlate.

I have the stereo camera, and I migrate the code to my code. I find some problem,the first problem is that what time the program calculate the "pKF->mFeatVec" when program first enter the "TrackReferenceKeyFrame/SearchByBoW". I slove it by adding "mCurrentFrame->ComputeBoW();" before "StereoInitialization/new KeyFrame" but it is not perfect, because I have successfully tested stereo camera using the executable file compiled from ORB-SLAM2 code. The second problem is "std::bad_alloc" when I run the my executing file, and I have find the location of this problem at "TrackReferenceKeyFrame/PoseOptimization/optimizer.optimize(its[it])". I want to know the reason.Can you help me? By the way, I have tried a lot of ways, but none of them worked.