summaryrefslogtreecommitdiffstats
path: root/SD-VBS/benchmarks/localization/src/matlab/drawLog.m
diff options
context:
space:
mode:
Diffstat (limited to 'SD-VBS/benchmarks/localization/src/matlab/drawLog.m')
-rw-r--r--SD-VBS/benchmarks/localization/src/matlab/drawLog.m44
1 files changed, 0 insertions, 44 deletions
diff --git a/SD-VBS/benchmarks/localization/src/matlab/drawLog.m b/SD-VBS/benchmarks/localization/src/matlab/drawLog.m
deleted file mode 100644
index f88e078..0000000
--- a/SD-VBS/benchmarks/localization/src/matlab/drawLog.m
+++ /dev/null
@@ -1,44 +0,0 @@
1function drawLog(data, ground_data)
2subplot(1,3,1);
3[nr nc]=size(data);
4for i=1:nr
5 x=data(i,2);
6 y=data(i,3);
7 z=data(i,4);
8 R=[1 0 0; 0 cos(x) sin(x); 0 -sin(x) cos(x)]...
9 *[cos(y) 0 -sin(y); 0 1 0; sin(y) 0 cos(y)]...
10 *[cos(z) sin(z) 0; -sin(z) cos(z) 0; 0 0 1];
11 coord=R*[1 0 0]';
12 axis([-1 1 -1 1 -1 1]);axis on
13 plot3([0 coord(1)], [0 coord(2)], [0 coord(3)], 'b'); hold on
14end
15
16[nr nc]=size(ground_data);
17for i=1:nr
18x=ground_data(i,2);
19y=ground_data(i,3);
20z=ground_data(i,4);
21R=[1 0 0; 0 cos(x) sin(x); 0 -sin(x) cos(x)]...
22 *[cos(y) 0 -sin(y); 0 1 0; sin(y) 0 cos(y)]...
23 *[cos(z) sin(z) 0; -sin(z) cos(z) 0; 0 0 1];
24coord=R*[1 0 0]';
25coord2=R*[0 -1 0]';
26axis([-1 1 -1 1 -1 1]);axis on
27plot3([0 coord(1)], [0 coord(2)], [0 coord(3)], 'r'); hold on
28plot3([0 coord2(1)], [0 coord2(2)], [0 coord2(3)], 'g');
29end
30
31xlabel('x');
32ylabel('y');
33zlabel('z');
34hold off
35drawnow
36subplot(1,3,2);
37Xoffset=4422610;
38Yoffset=483660;
39axis([4422610-Xoffset 4422660-Xoffset 483620-Yoffset 483720-Yoffset]);axis on
40scatter(data(:,5)-Xoffset, data(:,6)-Yoffset, 8, 'b'); hold on
41axis([4422610-Xoffset 4422660-Xoffset 483620-Yoffset 483720-Yoffset]);axis on
42scatter(ground_data(:,5)-Xoffset, ground_data(:,6)-Yoffset, 10, 'r'); hold off
43drawnow
44