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

No more need to convert to double after wrap fix

release/4.3a0
Frank Dellaert 2012-06-13 12:05:39 +00:00
parent d13db7a997
commit 991d8f3c5f
2 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
matlab/VisualISAMPlot.m
View File

@ -2,8 +2,8 @@ function VisualISAMPlot(truth, data, isam, result, options)
% VisualISAMPlot: plot current state of visualSLAM::iSAM object % VisualISAMPlot: plot current state of visualSLAM::iSAM object
% Authors: Duy Nguyen Ta and Frank Dellaert % Authors: Duy Nguyen Ta and Frank Dellaert
M = double(result.nrPoses); M = result.nrPoses;
N = double(result.nrPoints); N = result.nrPoints;
h=gca; h=gca;
cla(h); cla(h);

2
matlab/VisualISAMStep.m
View File

@ -8,7 +8,7 @@ newFactors = visualSLAMGraph;
initialEstimates = visualSLAMValues; initialEstimates = visualSLAMValues;
%% Add odometry %% Add odometry
i = double(result.nrPoses)+1; i = result.nrPoses+1;
odometry = data.odometry{i-1}; odometry = data.odometry{i-1};
newFactors.addOdometry(symbol('x',i-1), symbol('x',i), odometry, noiseModels.odometry); newFactors.addOdometry(symbol('x',i-1), symbol('x',i), odometry, noiseModels.odometry);