forked from pichim/bf_function_libary
-
Notifications
You must be signed in to change notification settings - Fork 0
/
downsample_frd.m
37 lines (32 loc) · 1.2 KB
/
downsample_frd.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
%
% This file is part of pichim's controller tuning framework.
%
% This sofware is free. You can redistribute this software
% and/or modify this software under the terms of the GNU General
% Public License as published by the Free Software Foundation,
% either version 3 of the License, or (at your option) any later
% version.
%
% This software is distributed in the hope that it will be useful,
% but WITHOUT ANY WARRANTY; without even the implied warranty of
% MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
%
% See the GNU General Public License for more details.
%
% You should have received a copy of the GNU General Public
% License along with this software.
%
% If not, see <http:%www.gnu.org/licenses/>.
%
%%
function Gds = downsample_frd(G, Ts, freq)
% the frequency response is infinite at some frequencies due to poles on the stability boundary.
g = squeeze(freqresp(G, 2*pi*freq(2:end)));
g = [g(1); g]; % copy second value to dc in case it is an integrating tf
% i think this is not necessary... can't think atm
if(isinf(g(1)))
g(1) = g(2);
end
g(freq > 1/2/Ts) = flipud(conj(g(freq > 0 & freq < 1/2/Ts)));
Gds = frd(g, freq, Ts, 'Units', 'Hz');
end