CameraSense/frameExtract.m at master · system123/CameraSense · GitHub

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
acc = [];
gyro = [];
mag = [];
R = [];
Q = [];
usrAcc = [];
gAcc = [];
timeStamps = [];

for i = 1:235

    fid = fopen(sprintf('frame%u.txt',i));

%     frame = textscan(fid, '%s %u %*[^\n]',1);
%
%     timeStamps = [timeStamps, frame{2}];

    sensors = textscan(fid, '%s X:%f Y:%f Z:%f',3,'delimiter',',','CollectOutput', true);
    frame = textscan(fid, '%s%*[^\n]',1);
    tmpR = textscan(fid, '%f %f %f',3,'delimiter',',','CollectOutput', true);
    frame = textscan(fid, '%s%*[^\n]',1);
    tmpQ = textscan(fid, '%f %f %f %f',1,'delimiter',',','CollectOutput', true);
    usrSens = textscan(fid, '%s X:%f Y:%f Z:%f',2,'delimiter',',','CollectOutput', true);

    R(:,:,i) = tmpR{1};
    Q = [Q, tmpQ{1}'];

    tmp = sensors{2};

    acc = [acc, tmp(1,:)'];
    gyro = [gyro, tmp(2,:)'];
    mag = [mag, tmp(3,:)'];

    tmp = usrSens{2};

    usrAcc = [usrAcc, tmp(1,:)'];
    gAcc = [gAcc, tmp(2,:)'];

    fclose(fid);

end

save sensorData.mat acc gyro mag R Q usrAcc gAcc timeStamps