From 93f995065f1b6eae51e4864dfbbdd77d2ba6d47a Mon Sep 17 00:00:00 2001 From: Frank Dellaert Date: Sat, 4 Aug 2012 21:56:21 +0000 Subject: [PATCH] Aligned example with manual, fixed example make targets --- .cproject | 374 ++++++++++++++++------------------- examples/OdometryExample.cpp | 19 +- 2 files changed, 180 insertions(+), 213 deletions(-) diff --git a/.cproject b/.cproject index f5675f5ee..81bf59187 100644 --- a/.cproject +++ b/.cproject @@ -309,6 +309,14 @@ true true + + make + -j2 + testGaussianFactor.run + true + true + true + make -j2 @@ -335,7 +343,6 @@ make - tests/testBayesTree.run true false @@ -343,7 +350,6 @@ make - testBinaryBayesNet.run true false @@ -391,7 +397,6 @@ make - testSymbolicBayesNet.run true false @@ -399,7 +404,6 @@ make - tests/testSymbolicFactor.run true false @@ -407,7 +411,6 @@ make - testSymbolicFactorGraph.run true false @@ -423,20 +426,11 @@ make - tests/testBayesTree true false true - - make - -j2 - testGaussianFactor.run - true - true - true - make -j5 @@ -525,22 +519,6 @@ false true - - make - -j2 - tests/testPose2.run - true - true - true - - - make - -j2 - tests/testPose3.run - true - true - true - make -j2 @@ -557,6 +535,22 @@ true true + + make + -j2 + tests/testPose2.run + true + true + true + + + make + -j2 + tests/testPose3.run + true + true + true + make -j2 @@ -581,26 +575,26 @@ true true - + make - -j2 - all + -j5 + testValues.run true true true - + make - -j2 - check + -j5 + testOrdering.run true true true - + make - -j2 - clean + -j5 + testKey.run true true true @@ -685,26 +679,26 @@ true true - + make - -j5 - testValues.run + -j2 + all true true true - + make - -j5 - testOrdering.run + -j2 + check true true true - + make - -j5 - testKey.run + -j2 + clean true true true @@ -975,7 +969,6 @@ make - testGraph.run true false @@ -983,7 +976,6 @@ make - testJunctionTree.run true false @@ -991,7 +983,6 @@ make - testSymbolicBayesNetB.run true false @@ -1127,7 +1118,6 @@ make - testErrors.run true false @@ -1173,6 +1163,14 @@ true true + + make + -j2 + testGaussianFactor.run + true + true + true + make -j2 @@ -1253,14 +1251,6 @@ true true - - make - -j2 - testGaussianFactor.run - true - true - true - make -j2 @@ -1591,6 +1581,7 @@ make + testSimulated2DOriented.run true false @@ -1630,6 +1621,7 @@ make + testSimulated2D.run true false @@ -1637,6 +1629,7 @@ make + testSimulated3D.run true false @@ -1746,10 +1739,10 @@ true true - + make - -j2 - PlanarSLAMExample_easy.run + -j5 + PlanarSLAMExample.run true true true @@ -1778,26 +1771,10 @@ true true - + make - -j2 - PlanarSLAMSelfContained_advanced.run - true - true - true - - - make - -j2 - Pose2SLAMExample_advanced.run - true - true - true - - - make - -j2 - Pose2SLAMExample_easy.run + -j5 + Pose2SLAMExample.run true true true @@ -1826,18 +1803,10 @@ true true - + make -j5 - LocalizationExample2.run - true - true - true - - - make - -j5 - Pose2SLAMwSPCG_advanced.run + OdometryExample.run true true true @@ -1852,6 +1821,7 @@ make + tests/testGaussianISAM2 true false @@ -1873,6 +1843,102 @@ true true + + make + -j2 + testRot3.run + true + true + true + + + make + -j2 + testRot2.run + true + true + true + + + make + -j2 + testPose3.run + true + true + true + + + make + -j2 + timeRot3.run + true + true + true + + + make + -j2 + testPose2.run + true + true + true + + + make + -j2 + testCal3_S2.run + true + true + true + + + make + -j2 + testSimpleCamera.run + true + true + true + + + make + -j2 + testHomography2.run + true + true + true + + + make + -j2 + testCalibratedCamera.run + true + true + true + + + make + -j2 + check + true + true + true + + + make + -j2 + clean + true + true + true + + + make + -j2 + testPoint2.run + true + true + true + make -j1 @@ -2074,7 +2140,6 @@ cpack - -G DEB true false @@ -2082,7 +2147,6 @@ cpack - -G RPM true false @@ -2090,7 +2154,6 @@ cpack - -G TGZ true false @@ -2098,7 +2161,6 @@ cpack - --config CPackSourceConfig.cmake true false @@ -2224,98 +2286,34 @@ true true - + make - -j2 - testRot3.run + -j5 + testSpirit.run true true true - + make - -j2 - testRot2.run + -j5 + testWrap.run true true true - + make - -j2 - testPose3.run + -j5 + check.wrap true true true - + make - -j2 - timeRot3.run - true - true - true - - - make - -j2 - testPose2.run - true - true - true - - - make - -j2 - testCal3_S2.run - true - true - true - - - make - -j2 - testSimpleCamera.run - true - true - true - - - make - -j2 - testHomography2.run - true - true - true - - - make - -j2 - testCalibratedCamera.run - true - true - true - - - make - -j2 - check - true - true - true - - - make - -j2 - clean - true - true - true - - - make - -j2 - testPoint2.run + -j5 + wrap true true true @@ -2359,38 +2357,6 @@ false true - - make - -j5 - testSpirit.run - true - true - true - - - make - -j5 - testWrap.run - true - true - true - - - make - -j5 - check.wrap - true - true - true - - - make - -j5 - wrap - true - true - true - diff --git a/examples/OdometryExample.cpp b/examples/OdometryExample.cpp index e420a0be9..7c2a80d85 100644 --- a/examples/OdometryExample.cpp +++ b/examples/OdometryExample.cpp @@ -80,21 +80,22 @@ int main(int argc, char** argv) { // Create the data structure to hold the initialEstimate estimate to the solution // For illustrative purposes, these have been deliberately set to incorrect values - Values initialEstimate; - initialEstimate.insert(1, Pose2(0.5, 0.0, 0.2)); - initialEstimate.insert(2, Pose2(2.3, 0.1, -0.2)); - initialEstimate.insert(3, Pose2(4.1, 0.1, 0.1)); - initialEstimate.print("\nInitial Estimate:\n"); // print + Values initial; + initial.insert(1, Pose2(0.5, 0.0, 0.2)); + initial.insert(2, Pose2(2.3, 0.1, -0.2)); + initial.insert(3, Pose2(4.1, 0.1, 0.1)); + initial.print("\nInitial Estimate:\n"); // print // optimize using Levenberg-Marquardt optimization - Values result = LevenbergMarquardtOptimizer(graph, initialEstimate).optimize(); + Values result = LevenbergMarquardtOptimizer(graph, initial).optimize(); result.print("Final Result:\n"); // Calculate and print marginal covariances for all variables + cout.precision(2); Marginals marginals(graph, result); - cout << "Pose 1 covariance:\n" << marginals.marginalCovariance(1) << endl; - cout << "Pose 2 covariance:\n" << marginals.marginalCovariance(2) << endl; - cout << "Pose 3 covariance:\n" << marginals.marginalCovariance(3) << endl; + cout << "x1 covariance:\n" << marginals.marginalCovariance(1) << endl; + cout << "x2 covariance:\n" << marginals.marginalCovariance(2) << endl; + cout << "x3 covariance:\n" << marginals.marginalCovariance(3) << endl; return 0; }