Code cleanups (bug #66)
[asterisk/asterisk.git] / codecs / lpc10 / ivfilt.c
1 /*
2
3 $Log$
4 Revision 1.15  2003/09/19 01:20:22  markster
5 Code cleanups (bug #66)
6
7 Revision 1.2  2003/09/19 01:20:22  markster
8 Code cleanups (bug #66)
9
10 Revision 1.1.1.1  2003/02/12 13:59:15  matteo
11 mer feb 12 14:56:57 CET 2003
12
13 Revision 1.2  2000/01/05 08:20:39  markster
14 Some OSS fixes and a few lpc changes to make it actually work
15
16  * Revision 1.1  1996/08/19  22:31:53  jaf
17  * Initial revision
18  *
19
20 */
21
22 #ifdef P_R_O_T_O_T_Y_P_E_S
23 extern int ivfilt_(real *lpbuf, real *ivbuf, integer *len, integer *nsamp, real *ivrc);
24 #endif
25
26 /*  -- translated by f2c (version 19951025).
27    You must link the resulting object file with the libraries:
28         -lf2c -lm   (in that order)
29 */
30
31 #include "f2c.h"
32
33 /* ********************************************************************* */
34
35 /*      IVFILT Version 48 */
36
37 /* $Log$
38  * Revision 1.15  2003/09/19 01:20:22  markster
39  * Code cleanups (bug #66)
40  *
41 /* Revision 1.2  2003/09/19 01:20:22  markster
42 /* Code cleanups (bug #66)
43 /*
44 /* Revision 1.1.1.1  2003/02/12 13:59:15  matteo
45 /* mer feb 12 14:56:57 CET 2003
46 /*
47 /* Revision 1.2  2000/01/05 08:20:39  markster
48 /* Some OSS fixes and a few lpc changes to make it actually work
49 /*
50  * Revision 1.1  1996/08/19  22:31:53  jaf
51  * Initial revision
52  * */
53 /* Revision 1.3  1996/03/15  21:36:29  jaf */
54 /* Just added a few comments about which array indices of the arguments */
55 /* are used, and mentioning that this subroutine has no local state. */
56
57 /* Revision 1.2  1996/03/13  00:01:00  jaf */
58 /* Comments added explaining that none of the local variables of this */
59 /* subroutine need to be saved from one invocation to the next. */
60
61 /* Revision 1.1  1996/02/07 14:47:34  jaf */
62 /* Initial revision */
63
64
65 /* ********************************************************************* */
66
67 /*   2nd order inverse filter, speech is decimated 4:1 */
68
69 /* Input: */
70 /*  LEN    - Length of speech buffers */
71 /*  NSAMP  - Number of samples to filter */
72 /*  LPBUF  - Low pass filtered speech buffer */
73 /*           Indices LEN-NSAMP-7 through LEN read. */
74 /* Output: */
75 /*  IVBUF  - Inverse filtered speech buffer */
76 /*           Indices LEN-NSAMP+1 through LEN written. */
77 /*  IVRC   - Inverse filter reflection coefficients (for voicing) */
78 /*          Indices 1 and 2 both written (also read, but only after writing).
79 */
80
81 /* This subroutine has no local state. */
82
83 /* Subroutine */ int ivfilt_(real *lpbuf, real *ivbuf, integer *len, integer *
84         nsamp, real *ivrc)
85 {
86     /* System generated locals */
87     integer i__1;
88
89     /* Local variables */
90     integer i__, j, k;
91     real r__[3], pc1, pc2;
92
93 /*      Arguments */
94 /*       Local variables that need not be saved */
95 /*       Local state */
96 /*       None */
97 /*  Calculate Autocorrelations */
98     /* Parameter adjustments */
99     --ivbuf;
100     --lpbuf;
101     --ivrc;
102
103     /* Function Body */
104     for (i__ = 1; i__ <= 3; ++i__) {
105         r__[i__ - 1] = 0.f;
106         k = (i__ - 1) << 2;
107         i__1 = *len;
108         for (j = (i__ << 2) + *len - *nsamp; j <= i__1; j += 2) {
109             r__[i__ - 1] += lpbuf[j] * lpbuf[j - k];
110         }
111     }
112 /*  Calculate predictor coefficients */
113     pc1 = 0.f;
114     pc2 = 0.f;
115     ivrc[1] = 0.f;
116     ivrc[2] = 0.f;
117     if (r__[0] > 1e-10f) {
118         ivrc[1] = r__[1] / r__[0];
119         ivrc[2] = (r__[2] - ivrc[1] * r__[1]) / (r__[0] - ivrc[1] * r__[1]);
120         pc1 = ivrc[1] - ivrc[1] * ivrc[2];
121         pc2 = ivrc[2];
122     }
123 /*  Inverse filter LPBUF into IVBUF */
124     i__1 = *len;
125     for (i__ = *len + 1 - *nsamp; i__ <= i__1; ++i__) {
126         ivbuf[i__] = lpbuf[i__] - pc1 * lpbuf[i__ - 4] - pc2 * lpbuf[i__ - 8];
127     }
128     return 0;
129 } /* ivfilt_ */
130