chrysalis/pre_processor.m at main · lscharck/chrysalis · 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
%% fetch and proces data

sim_out = sim('basic_model', 200); % to get data from the model
%f = fopen('Data_out.dat', 'w+');

time = sim_out.logsout{3}.Values.Time;
mu = sim_out.logsout{3}.Values.Data(:, 1);
eta1 = sim_out.logsout{3}.Values.Data(:, 2);
eta2 = sim_out.logsout{3}.Values.Data(:, 3);
eta3 = sim_out.logsout{3}.Values.Data(:, 4);
fire = sim_out.logsout{1}.Values.Data;
quat = [mu eta1 eta2 eta3 fire];
quat_sparse = quat(1, :);

dt = 1;
i = 1;

tOld = time(1);
tNew = tOld;

while i <= length(time)

    tNew = time(i);

    if tNew < tOld + dt

        i = i + dt;

    else

        quat_sparse = [quat_sparse; quat(i, :)];
        tOld = tNew;
        i = i + 1;
    end

end

eul = quat2eul(quat_sparse(:, 1:4)); % save me to a file please :)
eul = [eul, quat_sparse(:, 5:end)];

%% Okay - Save
save('eulers', 'eul')