12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

NonlinearOptimizer marginalCovariance returns mean as well

release/4.3a0
Richard Roberts 2010-10-26 13:51:39 +00:00
parent 8dea2f0f98
commit 67ecfed86e
2 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
examples/Pose2SLAMExample_advanced.cpp
View File

@ -77,8 +77,8 @@ int main(int argc, char** argv) {
result.print("final result"); result.print("final result");
/* Get covariances */ /* Get covariances */
Matrix covariance1 = optimizer_result.marginalCovariance(x1); Matrix covariance1 = optimizer_result.marginalCovariance(x1).second;
Matrix covariance2 = optimizer_result.marginalCovariance(x2); Matrix covariance2 = optimizer_result.marginalCovariance(x2).second;
print(covariance1, "Covariance1"); print(covariance1, "Covariance1");
print(covariance2, "Covariance2"); print(covariance2, "Covariance2");

4
gtsam/nonlinear/NonlinearOptimizer.h
View File

@ -209,8 +209,8 @@ namespace gtsam {
/** /**
* Return mean and covariance on a single variable * Return mean and covariance on a single variable
*/ */
Matrix marginalCovariance(Symbol j) const { std::pair<Vector,Matrix> marginalCovariance(Symbol j) const {
return solver_->marginalCovariance((*ordering_)[j]).second; return solver_->marginalCovariance((*ordering_)[j]);
} }
/** /**