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

Made display better

release/4.3a0
Frank Dellaert 2012-06-15 01:01:39 +00:00
parent 9d3bb30bc2
commit 06ed537091
1 changed files with 5 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
matlab/examples/StereoVOExample.m
View File

@ -61,6 +61,10 @@ toc
%% visualize initial trajectory, final trajectory, and final points
cla; hold on;
axis normal
axis([-1 6 -2 2 -1.5 1.5]);
axis equal
view(-38,12)
% initial trajectory in red (rotated so Z is up)
plot3(initialEstimate.zs(),-initialEstimate.xs(),-initialEstimate.ys(), '-*r','LineWidth',2);
@ -71,8 +75,5 @@ xlabel('X (m)'); ylabel('Y (m)'); zlabel('Z (m)');
% optimized 3D points (rotated so Z is up)
points = result.points();
plot3(points(:,3),-points(:,1),-points(:,2),'.');
plot3(points(:,3),-points(:,1),-points(:,2),'*');
axis([-4 4 -4 4 -4 4]);
axis equal
view(3)