forked from cookem4/T265MatlabAnalysis
-
Notifications
You must be signed in to change notification settings - Fork 0
/
CoordinatePlotter.m
44 lines (36 loc) · 1.4 KB
/
CoordinatePlotter.m
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
%This script is used to graph the T265 camera data and the Motiv motion
%capture data in the same 3D space
%M1 = csvread("C:\Users\mitch\Documents\ResearchSummer19\ZAxisNvidiaV2.csv");
%M2 = csvread("C:\Users\mitch\Documents\ResearchSummer19\ZAisMotivV2Formatted.csv");
%M1 = csvread("C:\Users\mitch\Documents\ResearchSummer19\ZAxisSquareNvidia.csv");
%M2 = csvread("C:\Users\mitch\Documents\ResearchSummer19\ZAxisSquareMotivFormatted.csv");
%M1 = csvread("C:\Users\mitch\Documents\ResearchSummer19\Test4T265.csv");
%M2 = csvread("C:\Users\mitch\Documents\ResearchSummer19\Test4MotivFormatted.csv");
%M1 = csvread("C:\Users\mitch\Documents\ResearchSummer19\ZAxisSquareMultipleNvidia.csv");
%M2 = csvread("C:\Users\mitch\Documents\ResearchSummer19\ZAxisSquareMultipleMotivFormatted.csv");
M1 = csvread("C:\Users\mitch\Documents\ResearchSummer19\DroneData\coordinateData.csv");
M2 = csvread("C:\Users\mitch\Documents\ResearchSummer19\DroneData\RealSenseFlightFormatted.csv");
xT = M1(:,7);
yT = M1(:,8);
zT = M1(:,9);
xM = M2(:,1);
yM = M2(:,2);
zM = M2(:,3);
%For Z Axis path
xT2 = xT;
yT2 = yT;
zT2 = zT;
%Following variable is for using the plotting tab in Matlab IDE to help visualize
PlotNvidia = [xT2 yT2 zT2];
PlotMotiv = [xM yM zM];
plot3(xT2,zT2,yT2,'r');
hold on
plot3(xM,zM,yM,'b');
zlim([0 1]);
ylim([-3 3]);
xlim([-3 3]);
%xlabel('X (m)')
%ylabel('Y (m)')
%zlabel('Z (m)')
grid on
legend('T265', 'Motiv Tracker');