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

This example stopped working: now fixed

release/4.3a0
dellaert 2014-05-25 17:46:47 -04:00
parent 852e1e1f2f
commit c2e748b362
1 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
matlab/gtsam_examples/Pose2SLAMExample_advanced.m
View File

@ -59,16 +59,16 @@ params.setAbsoluteErrorTol(1e-15);
params.setRelativeErrorTol(1e-15);
params.setVerbosity('ERROR');
params.setVerbosityDL('VERBOSE');
params.setOrdering(graph.orderingCOLAMD(initialEstimate));
params.setOrdering(graph.orderingCOLAMD());
optimizer = DoglegOptimizer(graph, initialEstimate, params);
result = optimizer.optimizeSafely();
result.print('final result');
%% Get the corresponding dense matrix
ord = graph.orderingCOLAMD(result);
gfg = graph.linearize(result,ord);
denseAb = gfg.denseJacobian;
ord = graph.orderingCOLAMD();
gfg = graph.linearize(result);
denseAb = gfg.augmentedJacobian;
%% Get sparse matrix A and RHS b
IJS = gfg.sparseJacobian_();