-
Notifications
You must be signed in to change notification settings - Fork 0
/
NonLinFilt.m
127 lines (98 loc) · 2.79 KB
/
NonLinFilt.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
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
function res=NonLinFilt(H,n_win,t,r,verbouse)
%
% MIT License
%
% Copyright (c) 2021 Roman Szewczyk
%
% Permission is hereby granted, free of charge, to any person obtaining a copy
% of this software and associated documentation files (the "Software"), to deal
% in the Software without restriction, including without limitation the rights
% to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
% copies of the Software, and to permit persons to whom the Software is
% furnished to do so, subject to the following conditions:
%
% The above copyright notice and this permission notice shall be included in all
% copies or substantial portions of the Software.
%
% THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
% IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
% FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
% AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
% LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
% OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
% SOFTWARE.
%
%
% Function nonlinear filtering
%
% Input:
% H - vector with input data
% n_win - sie of window
% t - treshold
% r - number of repetitions
%
if verbouse
fprintf('*** Nonlinear filtering ***\n');
fprintf('filtering %i elements\n',numel(H));
fprintf('window: %i, t=%1.2f, r=%i\n',n_win, t, r);
end
H_arch=H;
% n_win=30;
% t=0.5;
for ir=1:r
for i=0:floor(numel(H)./n_win)-1
if i<floor(numel(H)./n_win)-1
win=H(i.*n_win+1:(i+1).*n_win);
else
win=H(i.*n_win+1:end);
end
x=1:numel(win);
p=polyfit(x',win,2);
y=p(1).*x.^2+p(2).*x+p(3);
d=std(abs(win-y));
win2=win;
x2=x;
for j=1:numel(win)
if (abs(win(j)-y(j))>t.*d)
if ((j>1) && (j<numel(win)))
win2(j)=(win2(j-1)+win2(j+1))./2;
elseif j==1
win2(1)=win2(2)-(win2(3)-win2(2));
else
win2(end)=win2(end-1)+(win2(end-1)-win2(end-2));
end
end
end
p2=polyfit(x2',win2,2);
y2=p(1).*x.^2+p(2).*x+p(3);
for j=1:numel(win)
if (abs(win(j)-y(j))>t.*d)
win(j)=y2(j);
end
end
if i<floor(numel(H)./n_win)-1
H(i.*n_win+1:(i+1).*n_win)=win;
else
H(i.*n_win+1:end)=win;
end
end
%
end
H2=zeros(floor(numel(H)./n_win),1);
for i=0:floor(numel(H)./n_win)-1
if i<floor(numel(H)./n_win)-1
win=H(i.*n_win+1:(i+1).*n_win);
else
win=H(i.*n_win+1:end);
end
x=1:numel(win);
p=polyfit(x',win,1);
y=p(1).*x+p(2);
H2(i+1)=y(1);
end
%
res=H2;
if verbouse
fprintf('*** Everything done. ***\n\n');
end
end