octave_packages/control-2.3.52/@frd/__freqresp__.m

   1 ## Copyright (C) 2010, 2012   Lukas F. Reichlin
   2 ##
   3 ## This file is part of LTI Syncope.
   4 ##
   5 ## LTI Syncope is free software: you can redistribute it and/or modify
   6 ## it under the terms of the GNU General Public License as published by
   7 ## the Free Software Foundation, either version 3 of the License, or
   8 ## (at your option) any later version.
   9 ##
  10 ## LTI Syncope is distributed in the hope that it will be useful,
  11 ## but WITHOUT ANY WARRANTY; without even the implied warranty of
  12 ## MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13 ## GNU General Public License for more details.
  14 ##
  15 ## You should have received a copy of the GNU General Public License
  16 ## along with LTI Syncope.  If not, see <http://www.gnu.org/licenses/>.
  17
  18 ## -*- texinfo -*-
  19 ## Frequency response of FRD models :-)
  20
  21 ## Author: Lukas Reichlin <lukas.reichlin@gmail.com>
  22 ## Created: October 2010
  23 ## Version: 0.2
  24
  25 function H = __freqresp__ (sys, w, resptype = 0, cellflag = false)
  26
  27   [H, w_sys, tsam] = frdata (sys, "array");
  28
  29   if (! isempty (w))     # freqresp (frdsys, w), sigma (frdsys, w), ...
  30     tol = sqrt (eps);
  31     w_idx = arrayfun (@(x) find (abs (w_sys - x) < tol), w, "uniformoutput", false);
  32     w_idx = vertcat (w_idx{:});
  33
  34     ## NOTE: There are problems when cellfun uses "uniformoutput", true
  35     ##       and find returns an empty matrix,
  36
  37     if (length (w_idx) != numel (w))
  38       error ("frd: freqresp: some frequencies are not within tolerance %g", tol);
  39     endif
  40
  41     H = H(:, :, w_idx);
  42   endif
  43
  44   [p, m, l] = size (H);
  45
  46   if (resptype == 0)
  47
  48     if (cellflag)
  49       H = mat2cell (H, p, m, ones (1, l))(:);
  50     endif
  51
  52   else
  53
  54     if (m != p)
  55       error ("tf: freqresp: system must be square for response type %d", resptype);
  56     endif
  57
  58     H = mat2cell (H, p, m, ones (1, l))(:);
  59     j = eye (p);
  60
  61     switch (resptype)
  62       case 1             # inversed system
  63         H = cellfun (@inv, H, "uniformoutput", false);
  64
  65       case 2             # inversed sensitivity
  66         H = cellfun (@(x) j + x, H, "uniformoutput", false);
  67
  68       case 3             # inversed complementary sensitivity
  69         H = cellfun (@(x) j + inv (x), H, "uniformoutput", false);
  70
  71       otherwise
  72         error ("frd: freqresp: invalid response type");
  73     endswitch
  74
  75     if (! cellflag)
  76       H = cat (3, H{:});
  77     endif
  78
  79   endif
  80
  81 endfunction