AUV-Coop-Assembly
Master Thesis for Robotics Engineering. Cooperative peg-in-hole assembly with two underwater vehicles guided by vision
untitled.m
1 refsA = importMatrices('~/logPegBella/withVision/15/g500_A/forces.txt');
2 refsB = importMatrices('~/logPegBella/withVision/15/g500_B/forces.txt');
3 nStep = size(refsB, 3);
4 %diffRefs = refsB - refsA;
5 
6 %diffRefs = squeeze(diffRefs);
7 
8 global sControlLoop;
9 totSecondPassed = sControlLoop*(nStep-1);
10 seconds = 0:sControlLoop:totSecondPassed;
11 
12 %figure('Renderer', 'painters', 'Position', [0 0 650 500])
13 %plot(seconds, diffRefs);
14 %xlab = xlabel('time [s]');
15 
16 figure
17 plot(seconds, squeeze(refsA));
18 
19 figure
20 plot(seconds, squeeze(refsB));
21