|
2847
|
1 ## Copyright (C) 1996, 1997 John W. Eaton |
|
6964
|
2 ## Copyright (C) 2007 Ben Abbott |
|
2313
|
3 ## |
|
|
4 ## This file is part of Octave. |
|
|
5 ## |
|
|
6 ## Octave is free software; you can redistribute it and/or modify it |
|
|
7 ## under the terms of the GNU General Public License as published by |
|
|
8 ## the Free Software Foundation; either version 2, or (at your option) |
|
|
9 ## any later version. |
|
|
10 ## |
|
|
11 ## Octave is distributed in the hope that it will be useful, but |
|
|
12 ## WITHOUT ANY WARRANTY; without even the implied warranty of |
|
|
13 ## MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
|
|
14 ## General Public License for more details. |
|
|
15 ## |
|
|
16 ## You should have received a copy of the GNU General Public License |
|
|
17 ## along with Octave; see the file COPYING. If not, write to the Free |
|
5307
|
18 ## Software Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA |
|
|
19 ## 02110-1301, USA. |
|
904
|
20 |
|
3368
|
21 ## -*- texinfo -*- |
|
6978
|
22 ## @deftypefn {Function File} {[@var{r}, @var{p}, @var{k}, @var{e}] =} residue (@var{b}, @var{a}) |
|
|
23 ## Compute the partial fraction expansion for the quotient of the |
|
|
24 ## polynomials, @var{b} and @var{a}. |
|
3426
|
25 ## |
|
3368
|
26 ## @iftex |
|
|
27 ## @tex |
|
|
28 ## $$ |
|
6978
|
29 ## {B(s)\over A(s)} = \sum_{m=1}^M {r_m\over (s-p_m)^e_m} |
|
3368
|
30 ## + \sum_{i=1}^N k_i s^{N-i}. |
|
|
31 ## $$ |
|
|
32 ## @end tex |
|
|
33 ## @end iftex |
|
|
34 ## @ifinfo |
|
3426
|
35 ## |
|
3368
|
36 ## @example |
|
6978
|
37 ## B(s) M r(m) N |
|
3368
|
38 ## ---- = SUM ------------- + SUM k(i)*s^(N-i) |
|
6978
|
39 ## A(s) m=1 (s-p(m))^e(m) i=1 |
|
3368
|
40 ## @end example |
|
|
41 ## @end ifinfo |
|
3426
|
42 ## |
|
3368
|
43 ## @noindent |
|
3499
|
44 ## where @math{M} is the number of poles (the length of the @var{r}, |
|
6978
|
45 ## @var{p}, and @var{e}), the @var{k} vector is a polynomial of order @math{N-1} |
|
|
46 ## representing the direct contribution, and the @var{e} vector specifies |
|
|
47 ## the multiplicity of the mth residue's pole. |
|
3426
|
48 ## |
|
6964
|
49 ## For example, |
|
3426
|
50 ## |
|
3368
|
51 ## @example |
|
|
52 ## @group |
|
6964
|
53 ## b = [1, 1, 1]; |
|
|
54 ## a = [1, -5, 8, -4]; |
|
|
55 ## [r, p, k] = residue (b, a); |
|
3368
|
56 ## @result{} r = [-2, 7, 3] |
|
|
57 ## @result{} p = [2, 2, 1] |
|
|
58 ## @result{} k = [](0x0) |
|
|
59 ## @end group |
|
|
60 ## @end example |
|
3426
|
61 ## |
|
3368
|
62 ## @noindent |
|
6978
|
63 ## which represents the following partial fraction expansion |
|
3368
|
64 ## @iftex |
|
|
65 ## @tex |
|
|
66 ## $$ |
|
|
67 ## {s^2+s+1\over s^3-5s^2+8s-4} = {-2\over s-2} + {7\over (s-2)^2} + {3\over s-1} |
|
|
68 ## $$ |
|
|
69 ## @end tex |
|
|
70 ## @end iftex |
|
|
71 ## @ifinfo |
|
3426
|
72 ## |
|
3368
|
73 ## @example |
|
|
74 ## s^2 + s + 1 -2 7 3 |
|
2311
|
75 ## ------------------- = ----- + ------- + ----- |
|
|
76 ## s^3 - 5s^2 + 8s - 4 (s-2) (s-2)^2 (s-1) |
|
3368
|
77 ## @end example |
|
6964
|
78 ## |
|
3368
|
79 ## @end ifinfo |
|
6978
|
80 ## |
|
|
81 ## @deftypefnx {Function File} {[@var{b}, @var{a}] =} residue (@var{r}, @var{p}, @var{k}) |
|
|
82 ## Compute the reconstituted quotient of polynomials, |
|
|
83 ## @var{b}(s)/@var{a}(s), from the partial fraction expansion |
|
|
84 ## represented by the residues, poles, and a direct polynomial specified |
|
|
85 ## by @var{r}, @var{p} and @var{k}. |
|
|
86 ## |
|
|
87 ## For example, |
|
6964
|
88 ## |
|
|
89 ## @example |
|
|
90 ## @group |
|
|
91 ## r = [-2, 7, 3]; |
|
|
92 ## p = [2, 2, 1]; |
|
|
93 ## k = [1 0]; |
|
|
94 ## [b, a] = residue (r, p, k); |
|
|
95 ## @result{} b = [1, -5, 9, -3, 1] |
|
6978
|
96 ## @result{} a = [1, -5, 8, -4] |
|
6964
|
97 ## @end group |
|
|
98 ## @end example |
|
|
99 ## |
|
|
100 ## @noindent |
|
6978
|
101 ## which represents the following partial fraction expansion |
|
6964
|
102 ## @iftex |
|
|
103 ## @tex |
|
|
104 ## $$ |
|
6978
|
105 ## {-2\over s-2} + {7\over (s-2)^2} + {3\over s-1} + s = {s^4-5s^3+9s^2-3s+1\over s^3-5s^2+8s-4} |
|
6964
|
106 ## $$ |
|
|
107 ## @end tex |
|
|
108 ## @end iftex |
|
|
109 ## @ifinfo |
|
|
110 ## |
|
|
111 ## @example |
|
6978
|
112 ## -2 7 3 s^4 - 5s^3 + 9s^2 - 3s + 1 |
|
|
113 ## ----- + ------- + ----- + s = -------------------------- |
|
|
114 ## (s-2) (s-2)^2 (s-1) s^3 - 5s^2 + 8s - 4 |
|
6964
|
115 ## @end example |
|
|
116 ## @end ifinfo |
|
|
117 ## @seealso{poly, roots, conv, deconv, mpoles, polyval, polyderiv, polyinteg} |
|
3368
|
118 ## @end deftypefn |
|
1025
|
119 |
|
3202
|
120 ## Author: Tony Richardson <arichard@stark.cc.oh.us> |
|
6964
|
121 ## Author: Ben Abbott <bpabbott@mac.com> |
|
2312
|
122 ## Created: June 1994 |
|
|
123 ## Adapted-By: jwe |
|
559
|
124 |
|
6978
|
125 function [r, p, k, e] = residue (b, a, varargin) |
|
559
|
126 |
|
1025
|
127 if (nargin < 2 || nargin > 3) |
|
6046
|
128 print_usage (); |
|
559
|
129 endif |
|
|
130 |
|
6964
|
131 toler = .001; |
|
|
132 |
|
|
133 if (nargin == 3) |
|
|
134 ## The inputs are the residue, pole, and direct part. Solve for the |
|
|
135 ## corresponding numerator and denominator polynomials |
|
|
136 [r, p] = rresidue (b, a, varargin{1}, toler); |
|
|
137 return |
|
|
138 end |
|
559
|
139 |
|
2303
|
140 ## Make sure both polynomials are in reduced form. |
|
1025
|
141 |
|
|
142 a = polyreduce (a); |
|
|
143 b = polyreduce (b); |
|
559
|
144 |
|
1025
|
145 b = b / a(1); |
|
|
146 a = a / a(1); |
|
559
|
147 |
|
1025
|
148 la = length (a); |
|
|
149 lb = length (b); |
|
559
|
150 |
|
2303
|
151 ## Handle special cases here. |
|
1025
|
152 |
|
|
153 if (la == 0 || lb == 0) |
|
559
|
154 k = r = p = e = []; |
|
|
155 return; |
|
|
156 elseif (la == 1) |
|
1025
|
157 k = b / a; |
|
559
|
158 r = p = e = []; |
|
|
159 return; |
|
|
160 endif |
|
|
161 |
|
2303
|
162 ## Find the poles. |
|
1025
|
163 |
|
|
164 p = roots (a); |
|
|
165 lp = length (p); |
|
559
|
166 |
|
5464
|
167 ## Determine if the poles are (effectively) zero. |
|
5463
|
168 |
|
6964
|
169 small = max (abs (p)); |
|
|
170 small = max ([small, 1] ) * 1e-8 * (1 + numel (p))^2; |
|
|
171 p(abs (p) < small) = 0; |
|
|
172 |
|
|
173 ## Determine if the poles are (effectively) real, or imaginary. |
|
5463
|
174 |
|
6964
|
175 index = (abs (imag (p)) < small); |
|
|
176 p(index) = real (p(index)); |
|
|
177 index = (abs (real (p)) < small); |
|
|
178 p(index) = 1i * imag (p(index)); |
|
1025
|
179 |
|
6964
|
180 ## Sort poles so that multiplicity loop will work. |
|
|
181 |
|
|
182 [e, indx] = mpoles (p, toler, 1); |
|
|
183 p = p (indx); |
|
559
|
184 |
|
2303
|
185 ## Find the direct term if there is one. |
|
1025
|
186 |
|
|
187 if (lb >= la) |
|
6964
|
188 ## Also return the reduced numerator. |
|
1025
|
189 [k, b] = deconv (b, a); |
|
|
190 lb = length (b); |
|
559
|
191 else |
|
|
192 k = []; |
|
|
193 endif |
|
|
194 |
|
1025
|
195 if (lp == 1) |
|
|
196 r = polyval (b, p); |
|
559
|
197 return; |
|
|
198 endif |
|
|
199 |
|
6964
|
200 ## Determine the order of the denominator and remaining numerator. |
|
|
201 ## With the direct term removed the potential order of the numerator |
|
|
202 ## is one less than the order of the denominator. |
|
1025
|
203 |
|
6964
|
204 aorder = numel (a) - 1; |
|
|
205 border = aorder - 1; |
|
1025
|
206 |
|
6964
|
207 ## Construct a system of equations relating the individual |
|
|
208 ## contributions from each residue to the complete numerator. |
|
559
|
209 |
|
6964
|
210 A = zeros (border+1, border+1); |
|
|
211 B = prepad (reshape (b, [numel(b), 1]), border+1, 0); |
|
|
212 for ip = 1:numel(p) |
|
|
213 ri = zeros (size (p)); |
|
|
214 ri(ip) = 1; |
|
|
215 A(:,ip) = prepad (rresidue (ri, p, [], toler), border+1, 0).'; |
|
|
216 endfor |
|
559
|
217 |
|
2303
|
218 ## Solve for the residues. |
|
1025
|
219 |
|
|
220 r = A \ B; |
|
559
|
221 |
|
|
222 endfunction |
|
6964
|
223 |
|
6978
|
224 function [pnum, pden, multp] = rresidue (r, p, k, toler) |
|
6964
|
225 |
|
|
226 ## Reconstitute the numerator and denominator polynomials from the |
|
|
227 ## residues, poles, and direct term. |
|
|
228 |
|
|
229 if (nargin < 2 || nargin > 4) |
|
|
230 print_usage (); |
|
|
231 endif |
|
|
232 |
|
|
233 if (nargin < 4) |
|
|
234 toler = []; |
|
|
235 endif |
|
|
236 |
|
|
237 if (nargin < 3) |
|
|
238 k = []; |
|
|
239 endif |
|
|
240 |
|
|
241 [multp, indx] = mpoles (p, toler, 0); |
|
|
242 |
|
|
243 p = p (indx); |
|
|
244 r = r (indx); |
|
|
245 |
|
|
246 indx = 1:numel(p); |
|
|
247 |
|
|
248 for n = indx |
|
|
249 pn = [1, -p(n)]; |
|
|
250 if n == 1 |
|
|
251 pden = pn; |
|
|
252 else |
|
|
253 pden = conv (pden, pn); |
|
|
254 endif |
|
|
255 endfor |
|
|
256 |
|
|
257 ## D is the order of the denominator |
|
|
258 ## K is the order of the direct polynomial |
|
|
259 ## N is the order of the resulting numerator |
|
|
260 ## pnum(1:(N+1)) is the numerator's polynomial |
|
|
261 ## pden(1:(D+1)) is the denominator's polynomial |
|
|
262 ## pm is the multible pole for the nth residue |
|
|
263 ## pn is the numerator contribution for the nth residue |
|
|
264 |
|
|
265 D = numel (pden) - 1; |
|
|
266 K = numel (k) - 1; |
|
|
267 N = K + D; |
|
|
268 pnum = zeros (1, N+1); |
|
|
269 for n = indx(abs(r)>0) |
|
|
270 p1 = [1, -p(n)]; |
|
|
271 for m = 1:multp(n) |
|
|
272 if m == 1 |
|
|
273 pm = p1; |
|
|
274 else |
|
|
275 pm = conv (pm, p1); |
|
|
276 endif |
|
|
277 endfor |
|
|
278 pn = deconv (pden, pm); |
|
|
279 pn = r(n) * pn; |
|
|
280 pnum = pnum + prepad ( pn, N+1, 0); |
|
|
281 endfor |
|
|
282 |
|
|
283 ## Add the direct term. |
|
|
284 |
|
|
285 if (numel (k)) |
|
|
286 pnum = pnum + conv (pden, k); |
|
|
287 endif |
|
|
288 |
|
|
289 ## Check for leading zeros and trim the polynomial coefficients. |
|
|
290 |
|
|
291 small = max ([max(abs(pden)), max(abs(pnum)), 1]) * eps; |
|
|
292 |
|
|
293 pnum (abs (pnum) < small) = 0; |
|
|
294 pden (abs (pden) < small) = 0; |
|
|
295 |
|
|
296 pnum = polyreduce (pnum); |
|
|
297 pden = polyreduce (pden); |
|
|
298 |
|
|
299 endfunction |
|
6968
|
300 |
|
|
301 %!test |
|
|
302 %! b = [1, 1, 1]; |
|
|
303 %! a = [1, -5, 8, -4]; |
|
|
304 %! [r, p, k, e] = residue (b, a); |
|
6994
|
305 %! assert ((abs (r - [-2; 7; 3]) < 1e-5 |
|
6968
|
306 %! && abs (p - [2; 2; 1]) < 1e-7 |
|
|
307 %! && isempty (k) |
|
|
308 %! && e == [1; 2; 1])); |
|
6994
|
309 %! k = [1 0]; |
|
|
310 %! [b, a] = residue (r, p, k); |
|
|
311 %! assert ((abs (b - [1, -5, 9, -3, 1]) < 1e-12 |
|
|
312 %! && abs (a - [1, -5, 8, -4]) < 1e-12)); |
|
|
313 |
|
|
314 %!test |
|
|
315 %! b = [1, 0, 1]; |
|
|
316 %! a = [1, 0, 18, 0, 81]; |
|
|
317 %! [r, p, k, e] = residue(b, a); |
|
|
318 %! r1 = [-5i; 12; +5i; 12]/54; |
|
|
319 %! r2 = conj(r1); |
|
|
320 %! p1 = [+3i; +3i; -3i; -3i]; |
|
|
321 %! p2 = conj(p1); |
|
|
322 %! assert ((((abs (r - r1) < 1e-7) && (abs (p - p1) < 1e-7)) |
|
|
323 %! || ((abs (r - r2) < 1e-7) && (abs (p - p2) < 1e-7))) |
|
|
324 %! && isempty (k) |
|
|
325 %! && (e == [1; 2; 1; 2])); |
|
|
326 %! [br, ar] = residue (r, p, k); |
|
|
327 %! assert ((abs (br - b) < 1e-12 |
|
|
328 %! && abs (ar - a) < 1e-12)); |
