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

Added actual plotting of Pose2s when there aren't covariance ellipses

release/4.3a0
Alex Cunningham 2013-03-25 16:01:49 +00:00
parent 233c8aa7bb
commit 06be7b4926
1 changed files with 3 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
matlab/+gtsam/plot2DTrajectory.m
View File

@ -32,7 +32,10 @@ for i = 0:keys.size-1
if haveMarginals if haveMarginals
P = marginals.marginalCovariance(lastKey); P = marginals.marginalCovariance(lastKey);
gtsam.plotPose2(lastPose, 'g', P); gtsam.plotPose2(lastPose, 'g', P);
else
gtsam.plotPose2(lastPose, 'g', []);
end end
end end
lastIndex = i; lastIndex = i;
end end