Convert all CRLF in the SILK code, tabs to spaces, and trailing
[opus.git] / silk / float / silk_LPC_analysis_filter_FLP.c
1 /***********************************************************************
2 Copyright (c) 2006-2011, Skype Limited. All rights reserved.
3 Redistribution and use in source and binary forms, with or without
4 modification, (subject to the limitations in the disclaimer below)
5 are permitted provided that the following conditions are met:
6 - Redistributions of source code must retain the above copyright notice,
7 this list of conditions and the following disclaimer.
8 - Redistributions in binary form must reproduce the above copyright
9 notice, this list of conditions and the following disclaimer in the
10 documentation and/or other materials provided with the distribution.
11 - Neither the name of Skype Limited, nor the names of specific
12 contributors, may be used to endorse or promote products derived from
13 this software without specific prior written permission.
14 NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE GRANTED
15 BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
16 CONTRIBUTORS ''AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING,
17 BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND
18 FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
19 COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
20 INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
22 USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
23 ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
25 OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 ***********************************************************************/
27
28 #include <stdlib.h>
29 #include "silk_main_FLP.h"
30
31 /************************************************/
32 /* LPC analysis filter                          */
33 /* NB! State is kept internally and the         */
34 /* filter always starts with zero state         */
35 /* first Order output samples are set to zero   */
36 /************************************************/
37
38 /* 16th order LPC analysis filter, does not write first 16 samples */
39 void silk_LPC_analysis_filter16_FLP(
40           SKP_float                 r_LPC[],            /* O    LPC residual signal                     */
41     const SKP_float                 PredCoef[],         /* I    LPC coefficients                        */
42     const SKP_float                 s[],                /* I    Input signal                            */
43     const opus_int                   length              /* I    Length of input signal                  */
44 )
45 {
46     opus_int   ix;
47     SKP_float LPC_pred;
48     const SKP_float *s_ptr;
49
50     for ( ix = 16; ix < length; ix++) {
51         s_ptr = &s[ix - 1];
52
53         /* short-term prediction */
54         LPC_pred = s_ptr[  0 ]  * PredCoef[ 0 ]  +
55                    s_ptr[ -1 ]  * PredCoef[ 1 ]  +
56                    s_ptr[ -2 ]  * PredCoef[ 2 ]  +
57                    s_ptr[ -3 ]  * PredCoef[ 3 ]  +
58                    s_ptr[ -4 ]  * PredCoef[ 4 ]  +
59                    s_ptr[ -5 ]  * PredCoef[ 5 ]  +
60                    s_ptr[ -6 ]  * PredCoef[ 6 ]  +
61                    s_ptr[ -7 ]  * PredCoef[ 7 ]  +
62                    s_ptr[ -8 ]  * PredCoef[ 8 ]  +
63                    s_ptr[ -9 ]  * PredCoef[ 9 ]  +
64                    s_ptr[ -10 ] * PredCoef[ 10 ] +
65                    s_ptr[ -11 ] * PredCoef[ 11 ] +
66                    s_ptr[ -12 ] * PredCoef[ 12 ] +
67                    s_ptr[ -13 ] * PredCoef[ 13 ] +
68                    s_ptr[ -14 ] * PredCoef[ 14 ] +
69                    s_ptr[ -15 ] * PredCoef[ 15 ];
70
71         /* prediction error */
72         r_LPC[ix] = s_ptr[ 1 ] - LPC_pred;
73     }
74 }
75
76 /* 14th order LPC analysis filter, does not write first 14 samples */
77 void silk_LPC_analysis_filter14_FLP(
78           SKP_float                 r_LPC[],            /* O    LPC residual signal                     */
79     const SKP_float                 PredCoef[],         /* I    LPC coefficients                        */
80     const SKP_float                 s[],                /* I    Input signal                            */
81     const opus_int                   length              /* I    Length of input signal                  */
82 )
83 {
84     opus_int   ix;
85     SKP_float LPC_pred;
86     const SKP_float *s_ptr;
87
88     for ( ix = 14; ix < length; ix++) {
89         s_ptr = &s[ix - 1];
90
91         /* short-term prediction */
92         LPC_pred = s_ptr[  0 ]  * PredCoef[ 0 ]  +
93                    s_ptr[ -1 ]  * PredCoef[ 1 ]  +
94                    s_ptr[ -2 ]  * PredCoef[ 2 ]  +
95                    s_ptr[ -3 ]  * PredCoef[ 3 ]  +
96                    s_ptr[ -4 ]  * PredCoef[ 4 ]  +
97                    s_ptr[ -5 ]  * PredCoef[ 5 ]  +
98                    s_ptr[ -6 ]  * PredCoef[ 6 ]  +
99                    s_ptr[ -7 ]  * PredCoef[ 7 ]  +
100                    s_ptr[ -8 ]  * PredCoef[ 8 ]  +
101                    s_ptr[ -9 ]  * PredCoef[ 9 ]  +
102                    s_ptr[ -10 ] * PredCoef[ 10 ] +
103                    s_ptr[ -11 ] * PredCoef[ 11 ] +
104                    s_ptr[ -12 ] * PredCoef[ 12 ] +
105                    s_ptr[ -13 ] * PredCoef[ 13 ];
106
107         /* prediction error */
108         r_LPC[ix] = s_ptr[ 1 ] - LPC_pred;
109     }
110 }
111
112 /* 12th order LPC analysis filter, does not write first 12 samples */
113 void silk_LPC_analysis_filter12_FLP(
114           SKP_float                 r_LPC[],            /* O    LPC residual signal                     */
115     const SKP_float                 PredCoef[],         /* I    LPC coefficients                        */
116     const SKP_float                 s[],                /* I    Input signal                            */
117     const opus_int                   length              /* I    Length of input signal                  */
118 )
119 {
120     opus_int   ix;
121     SKP_float LPC_pred;
122     const SKP_float *s_ptr;
123
124     for ( ix = 12; ix < length; ix++) {
125         s_ptr = &s[ix - 1];
126
127         /* short-term prediction */
128         LPC_pred = s_ptr[  0 ]  * PredCoef[ 0 ]  +
129                    s_ptr[ -1 ]  * PredCoef[ 1 ]  +
130                    s_ptr[ -2 ]  * PredCoef[ 2 ]  +
131                    s_ptr[ -3 ]  * PredCoef[ 3 ]  +
132                    s_ptr[ -4 ]  * PredCoef[ 4 ]  +
133                    s_ptr[ -5 ]  * PredCoef[ 5 ]  +
134                    s_ptr[ -6 ]  * PredCoef[ 6 ]  +
135                    s_ptr[ -7 ]  * PredCoef[ 7 ]  +
136                    s_ptr[ -8 ]  * PredCoef[ 8 ]  +
137                    s_ptr[ -9 ]  * PredCoef[ 9 ]  +
138                    s_ptr[ -10 ] * PredCoef[ 10 ] +
139                    s_ptr[ -11 ] * PredCoef[ 11 ];
140
141         /* prediction error */
142         r_LPC[ix] = s_ptr[ 1 ] - LPC_pred;
143     }
144 }
145
146 /* 10th order LPC analysis filter, does not write first 10 samples */
147 void silk_LPC_analysis_filter10_FLP(
148           SKP_float                 r_LPC[],            /* O    LPC residual signal                     */
149     const SKP_float                 PredCoef[],         /* I    LPC coefficients                        */
150     const SKP_float                 s[],                /* I    Input signal                            */
151     const opus_int                   length              /* I    Length of input signal                  */
152 )
153 {
154     opus_int   ix;
155     SKP_float LPC_pred;
156     const SKP_float *s_ptr;
157
158     for ( ix = 10; ix < length; ix++) {
159         s_ptr = &s[ix - 1];
160
161         /* short-term prediction */
162         LPC_pred = s_ptr[  0 ] * PredCoef[ 0 ]  +
163                    s_ptr[ -1 ] * PredCoef[ 1 ]  +
164                    s_ptr[ -2 ] * PredCoef[ 2 ]  +
165                    s_ptr[ -3 ] * PredCoef[ 3 ]  +
166                    s_ptr[ -4 ] * PredCoef[ 4 ]  +
167                    s_ptr[ -5 ] * PredCoef[ 5 ]  +
168                    s_ptr[ -6 ] * PredCoef[ 6 ]  +
169                    s_ptr[ -7 ] * PredCoef[ 7 ]  +
170                    s_ptr[ -8 ] * PredCoef[ 8 ]  +
171                    s_ptr[ -9 ] * PredCoef[ 9 ];
172
173         /* prediction error */
174         r_LPC[ix] = s_ptr[ 1 ] - LPC_pred;
175     }
176 }
177
178 /* 8th order LPC analysis filter, does not write first 8 samples */
179 void silk_LPC_analysis_filter8_FLP(
180           SKP_float                 r_LPC[],            /* O    LPC residual signal                     */
181     const SKP_float                 PredCoef[],         /* I    LPC coefficients                        */
182     const SKP_float                 s[],                /* I    Input signal                            */
183     const opus_int                   length              /* I    Length of input signal                  */
184 )
185 {
186     opus_int   ix;
187     SKP_float LPC_pred;
188     const SKP_float *s_ptr;
189
190     for ( ix = 8; ix < length; ix++) {
191         s_ptr = &s[ix - 1];
192
193         /* short-term prediction */
194         LPC_pred = s_ptr[  0 ] * PredCoef[ 0 ]  +
195                    s_ptr[ -1 ] * PredCoef[ 1 ]  +
196                    s_ptr[ -2 ] * PredCoef[ 2 ]  +
197                    s_ptr[ -3 ] * PredCoef[ 3 ]  +
198                    s_ptr[ -4 ] * PredCoef[ 4 ]  +
199                    s_ptr[ -5 ] * PredCoef[ 5 ]  +
200                    s_ptr[ -6 ] * PredCoef[ 6 ]  +
201                    s_ptr[ -7 ] * PredCoef[ 7 ];
202
203         /* prediction error */
204         r_LPC[ix] = s_ptr[ 1 ] - LPC_pred;
205     }
206 }
207
208 /* 6th order LPC analysis filter, does not write first 6 samples */
209 void silk_LPC_analysis_filter6_FLP(
210           SKP_float                 r_LPC[],            /* O    LPC residual signal                     */
211     const SKP_float                 PredCoef[],         /* I    LPC coefficients                        */
212     const SKP_float                 s[],                /* I    Input signal                            */
213     const opus_int                   length              /* I    Length of input signal                  */
214 )
215 {
216     opus_int   ix;
217     SKP_float LPC_pred;
218     const SKP_float *s_ptr;
219
220     for ( ix = 6; ix < length; ix++) {
221         s_ptr = &s[ix - 1];
222
223         /* short-term prediction */
224         LPC_pred = s_ptr[  0 ] * PredCoef[ 0 ]  +
225                    s_ptr[ -1 ] * PredCoef[ 1 ]  +
226                    s_ptr[ -2 ] * PredCoef[ 2 ]  +
227                    s_ptr[ -3 ] * PredCoef[ 3 ]  +
228                    s_ptr[ -4 ] * PredCoef[ 4 ]  +
229                    s_ptr[ -5 ] * PredCoef[ 5 ];
230
231         /* prediction error */
232         r_LPC[ix] = s_ptr[ 1 ] - LPC_pred;
233     }
234 }
235
236 /************************************************/
237 /* LPC analysis filter                          */
238 /* NB! State is kept internally and the         */
239 /* filter always starts with zero state         */
240 /* first Order output samples are set to zero   */
241 /************************************************/
242
243 void silk_LPC_analysis_filter_FLP(
244           SKP_float                 r_LPC[],            /* O    LPC residual signal                     */
245     const SKP_float                 PredCoef[],         /* I    LPC coefficients                        */
246     const SKP_float                 s[],                /* I    Input signal                            */
247     const opus_int                   length,             /* I    Length of input signal                  */
248     const opus_int                   Order               /* I    LPC order                               */
249 )
250 {
251     SKP_assert( Order <= length );
252
253     switch( Order ) {
254         case 6:
255             silk_LPC_analysis_filter6_FLP(  r_LPC, PredCoef, s, length );
256         break;
257
258         case 8:
259             silk_LPC_analysis_filter8_FLP(  r_LPC, PredCoef, s, length );
260         break;
261
262         case 10:
263             silk_LPC_analysis_filter10_FLP( r_LPC, PredCoef, s, length );
264         break;
265
266         case 12:
267             silk_LPC_analysis_filter12_FLP( r_LPC, PredCoef, s, length );
268         break;
269
270         case 14:
271             silk_LPC_analysis_filter14_FLP( r_LPC, PredCoef, s, length );
272         break;
273
274         case 16:
275             silk_LPC_analysis_filter16_FLP( r_LPC, PredCoef, s, length );
276         break;
277
278         default:
279             SKP_assert( 0 );
280         break;
281     }
282
283     /* Set first Order output samples to zero */
284     SKP_memset( r_LPC, 0, Order * sizeof( SKP_float ) );
285 }
286