mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 01:20:25 +08:00
minor change
This commit is contained in:
@@ -47,7 +47,7 @@ public:
|
|||||||
bool useRobustConstraints = false);
|
bool useRobustConstraints = false);
|
||||||
|
|
||||||
public:
|
public:
|
||||||
OptimizerG2O(const ParametersMap & parameters) :
|
OptimizerG2O(const ParametersMap & parameters = ParametersMap()) :
|
||||||
Optimizer(parameters),
|
Optimizer(parameters),
|
||||||
solver_(Parameters::defaultg2oSolver()),
|
solver_(Parameters::defaultg2oSolver()),
|
||||||
optimizer_(Parameters::defaultg2oOptimizer())
|
optimizer_(Parameters::defaultg2oOptimizer())
|
||||||
|
|||||||
@@ -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>(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));
|
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();
|
transform = (cameraModel.localTransform() * pnp).inverse();
|
||||||
|
|
||||||
// compute variance (like in PCL computeVariance() method of sac_model.h)
|
// compute variance (like in PCL computeVariance() method of sac_model.h)
|
||||||
|
|||||||
Reference in New Issue
Block a user