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