i/rtabmap
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap.git synced 2026-09-01 17:10:26 +08:00
Code Issues Packages Projects Releases Wiki Activity

minor change

Browse Source
This commit is contained in:
matlabbe
2016-02-17 18:30:35 -05:00
parent 0a913a9cd4
commit b09429c5d8
2 changed files with 1 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
corelib/src/util3d_motion_estimation.cpp
View File

@@ -130,12 +130,6 @@ Transform estimateMotion3DTo2D(
R.at<double>(1,0), R.at<double>(1,1), R.at<double>(1,2), tvec.at<double>(1),
R.at<double>(2,0), R.at<double>(2,1), R.at<double>(2,2), tvec.at<double>(2));
UWARN("pnp=%s", pnp.prettyPrint().c_str());
OptimizerG2O g2o;
Transform g2oT = g2o.poseOptimization(pnp, objectPoints, imagePoints, cameraModel);
UWARN("g2oT=%s", g2oT.prettyPrint().c_str());
transform = (cameraModel.localTransform() * pnp).inverse();
// compute variance (like in PCL computeVariance() method of sac_model.h)