summaryrefslogtreecommitdiffstats
path: root/SD-VBS/benchmarks/localization/src/matlab/drawLog.m
diff options
context:
space:
mode:
authorleochanj <jbakita@cs.unc.edu>2020-10-21 01:52:54 -0400
committerleochanj <jbakita@cs.unc.edu>2020-10-21 15:59:54 -0400
commit0efc775370d2ff91927d1b383a99eab78dc5538f (patch)
treea41fe470fee5adc4d944ecd6b917bc48df8c7e0f /SD-VBS/benchmarks/localization/src/matlab/drawLog.m
parente2b50015cebdfba68699abd6e8575e38230f5a78 (diff)
debug libextra and remove matlab
FLUSH_CACHES
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