license/header stuff
[speexdsp.git] / libspeex / lpc.c
1 /*
2   Copyright 1992, 1993, 1994 by Jutta Degener and Carsten Bormann,
3   Technische Universitaet Berlin
4
5   Any use of this software is permitted provided that this notice is not
6   removed and that neither the authors nor the Technische Universitaet Berlin
7   are deemed to have made any representations as to the suitability of this
8   software for any purpose nor are held responsible for any defects of
9   this software.  THERE IS ABSOLUTELY NO WARRANTY FOR THIS SOFTWARE.
10
11   As a matter of courtesy, the authors request to be informed about uses
12   this software has found, about bugs in this software, and about any
13   improvements that may be of general interest.
14
15   Berlin, 28.11.1994
16   Jutta Degener
17   Carsten Bormann
18
19
20    Code slightly modified by Jean-Marc Valin
21
22    Speex License:
23
24    This library is free software; you can redistribute it and/or
25    modify it under the terms of the GNU Lesser General Public
26    License as published by the Free Software Foundation; either
27    version 2.1 of the License, or (at your option) any later version.
28    
29    This library is distributed in the hope that it will be useful,
30    but WITHOUT ANY WARRANTY; without even the implied warranty of
31    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
32    Lesser General Public License for more details.
33    
34    You should have received a copy of the GNU Lesser General Public
35    License along with this library; if not, write to the Free Software
36    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
37 */
38
39
40
41 /* LPC- and Reflection Coefficients
42  *
43  * The next two functions calculate linear prediction coefficients
44  * and/or the related reflection coefficients from the first P_MAX+1
45  * values of the autocorrelation function.
46  */
47
48 /* Invented by N. Levinson in 1947, modified by J. Durbin in 1959.
49  */
50
51 #include "lpc.h"
52
53 float                      /* returns minimum mean square error    */
54 wld(
55     float       * lpc, /*      [0...p-1] LPC coefficients      */
56     const float * ac,  /*  in: [0...p] autocorrelation values  */
57     float       * ref, /* out: [0...p-1] reflection coef's     */
58     int p
59     )
60 {
61    int i, j;  float r, error = ac[0];
62
63    if (ac[0] == 0) {
64       for (i = 0; i < p; i++) ref[i] = 0; return 0; }
65
66    for (i = 0; i < p; i++) {
67
68       /* Sum up this iteration's reflection coefficient.
69        */
70       r = -ac[i + 1];
71       for (j = 0; j < i; j++) r -= lpc[j] * ac[i - j];
72       ref[i] = r /= error;
73
74       /*  Update LPC coefficients and total error.
75        */
76       lpc[i] = r;
77       for (j = 0; j < i/2; j++) {
78          float tmp  = lpc[j];
79          lpc[j]     += r * lpc[i-1-j];
80          lpc[i-1-j] += r * tmp;
81       }
82       if (i % 2) lpc[j] += lpc[j] * r;
83
84       error *= 1.0 - r * r;
85    }
86    return error;
87 }
88
89
90 /* Compute the autocorrelation
91  *                      ,--,
92  *              ac(i) = >  x(n) * x(n-i)  for all n
93  *                      `--'
94  * for lags between 0 and lag-1, and x == 0 outside 0...n-1
95  */
96 void autocorr(
97               const float * x,   /*  in: [0...n-1] samples x   */
98               float *ac,   /* out: [0...lag-1] ac values */
99               int lag, int   n)
100 {
101    float d; int i;
102    while (lag--) {
103       for (i = lag, d = 0; i < n; i++) d += x[i] * x[i-lag];
104       ac[lag] = d;
105    }
106 }