-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathdessacade.m
68 lines (66 loc) · 1.55 KB
/
dessacade.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
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
function [ desacadedData ] = dessacade( rawData )
%UNTITLED2 Summary of this function goes here
% Detailed explanation goes here
[~,endData] = size(rawData);
iter8 = 1;
desacadedData = [];
while iter8 <= endData
corData = desacA(rawData(:,iter8));
desacadedData = vertcat(desacadedData,corData.');
iter8 = iter8 + 1;
end
desacadedData = desacadedData.';
end
function [corrected] = desacA(rawImpulse)
accel = diff(rawImpulse);
[tama9,~] = size(accel);
iter2 = 1;
accelPos = zeros(1,tama9);
accelNeg = zeros(1,tama9);
%Split in two psotive matrix
while iter2 <= tama9
if accel(iter2)> 0
accelPos(iter2) = accel(iter2);
end
if accel(iter2)<0
accelNeg(iter2) = abs(accel(iter2));
end
iter2 = iter2 + 1;
end
%Positive correction
[~,loc,wid] = findpeaks(accelPos,'nPeaks',1,'minPeakProminence',30);
% Usar wid (ancho en la mitad o 5)
ancho = 6;
%EliminarPico
if loc+ancho < 61
accelPos(1,loc-ancho:loc+ancho) = 0;
else
accelPos(1,loc-ancho:61) = 0;
end
%negative correction
[~,loc,wid] = findpeaks(accelNeg,'nPeaks',1,'minPeakProminence',30);
ancho = round(wid);
%EliminarPico
if loc+ancho < 61
accelNeg(1,loc-ancho:loc+ancho) = 0;
else
accelNeg(1,loc-ancho:61) = 0;
end
%Umbalanced split on some impulses,unknown reason!
[~,tamP] = size(accelPos);
[~,tamN] = size(accelNeg);
if ~(tamP==tamN)
if tamP>60
accelPos = accelPos(1,1:60);
else
accelNeg = accelNeg(1,1:60);
end
end
x = (1:61).';
y = horzcat((accelPos-accelNeg),0).';
[tamY,~] = size(y);
if tamY > 61
y = y(1:61,1);
end
corrected = (cumtrapz(x,y)+rawImpulse(1));
end