Reworked the static modes. Now, if all static modes have the same frame size,
[opus.git] / libcelt / celt.c
1 /* (C) 2007-2008 Jean-Marc Valin, CSIRO
2 */
3 /*
4    Redistribution and use in source and binary forms, with or without
5    modification, are permitted provided that the following conditions
6    are met:
7    
8    - Redistributions of source code must retain the above copyright
9    notice, this list of conditions and the following disclaimer.
10    
11    - Redistributions in binary form must reproduce the above copyright
12    notice, this list of conditions and the following disclaimer in the
13    documentation and/or other materials provided with the distribution.
14    
15    - Neither the name of the Xiph.org Foundation nor the names of its
16    contributors may be used to endorse or promote products derived from
17    this software without specific prior written permission.
18    
19    THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
20    ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
21    LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
22    A PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR
23    CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
24    EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
25    PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
26    PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
27    LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
28    NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
29    SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 #ifdef HAVE_CONFIG_H
33 #include "config.h"
34 #endif
35
36 #define CELT_C
37
38 #include "os_support.h"
39 #include "mdct.h"
40 #include <math.h>
41 #include "celt.h"
42 #include "pitch.h"
43 #include "kiss_fftr.h"
44 #include "bands.h"
45 #include "modes.h"
46 #include "entcode.h"
47 #include "quant_pitch.h"
48 #include "quant_bands.h"
49 #include "psy.h"
50 #include "rate.h"
51 #include "stack_alloc.h"
52
53 static const celt_word16_t preemph = QCONST16(0.8f,15);
54
55
56 /** Encoder state 
57  @brief Encoder state
58  */
59 struct CELTEncoder {
60    const CELTMode *mode;     /**< Mode used by the encoder */
61    int frame_size;
62    int block_size;
63    int overlap;
64    int channels;
65    
66    ec_byte_buffer buf;
67    ec_enc         enc;
68
69    celt_sig_t *preemph_memE;
70    celt_sig_t *preemph_memD;
71
72    kiss_fftr_cfg fft;
73
74    celt_sig_t *in_mem;
75    celt_sig_t *mdct_overlap;
76    celt_sig_t *out_mem;
77
78    celt_word16_t *oldBandE;
79 };
80
81 CELTEncoder EXPORT *celt_encoder_create(const CELTMode *mode)
82 {
83    int N, C;
84    CELTEncoder *st;
85
86    if (check_mode(mode) != CELT_OK)
87       return NULL;
88
89    N = mode->mdctSize;
90    C = mode->nbChannels;
91    st = celt_alloc(sizeof(CELTEncoder));
92    
93    st->mode = mode;
94    st->frame_size = N;
95    st->block_size = N;
96    st->overlap = mode->overlap;
97
98    ec_byte_writeinit(&st->buf);
99    ec_enc_init(&st->enc,&st->buf);
100
101    st->fft = pitch_state_alloc(MAX_PERIOD);
102    
103    st->in_mem = celt_alloc(N*C*sizeof(celt_sig_t));
104    st->mdct_overlap = celt_alloc(N*C*sizeof(celt_sig_t));
105    st->out_mem = celt_alloc(MAX_PERIOD*C*sizeof(celt_sig_t));
106
107    st->oldBandE = (celt_word16_t*)celt_alloc(C*mode->nbEBands*sizeof(celt_word16_t));
108
109    st->preemph_memE = (celt_sig_t*)celt_alloc(C*sizeof(celt_sig_t));;
110    st->preemph_memD = (celt_sig_t*)celt_alloc(C*sizeof(celt_sig_t));;
111
112    return st;
113 }
114
115 void EXPORT celt_encoder_destroy(CELTEncoder *st)
116 {
117    if (st == NULL)
118    {
119       celt_warning("NULL passed to celt_encoder_destroy");
120       return;
121    }
122    if (check_mode(st->mode) != CELT_OK)
123       return;
124
125    ec_byte_writeclear(&st->buf);
126
127    pitch_state_free(st->fft);
128
129    celt_free(st->in_mem);
130    celt_free(st->mdct_overlap);
131    celt_free(st->out_mem);
132    
133    celt_free(st->oldBandE);
134    
135    celt_free(st->preemph_memE);
136    celt_free(st->preemph_memD);
137    
138    celt_free(st);
139 }
140
141 static inline celt_int16_t SIG2INT16(celt_sig_t x)
142 {
143    x = PSHR32(x, SIG_SHIFT);
144    if (x>32767)
145       x = 32767;
146    else if (x<-32767)
147       x = -32767;
148 #ifdef FIXED_POINT
149    return EXTRACT16(x);
150 #else
151    return (celt_int16_t)floor(.5+x);
152 #endif
153 }
154
155 /** Apply window and compute the MDCT for all sub-frames and all channels in a frame */
156 static void compute_mdcts(const CELTMode *mode, const celt_word16_t * restrict window, celt_sig_t * restrict in, celt_sig_t * restrict out)
157 {
158    int c, N4;
159    VARDECL(celt_word32_t, x);
160    VARDECL(celt_word32_t, tmp);
161    const int C = CHANNELS(mode);
162    const mdct_lookup *lookup = MDCT(mode);
163    const int N = FRAMESIZE(mode);
164    const int overlap = OVERLAP(mode);
165    SAVE_STACK;
166    N4 = (N-overlap)>>1;
167    ALLOC(x, 2*N, celt_word32_t);
168    ALLOC(tmp, N, celt_word32_t);
169    for (c=0;c<C;c++)
170    {
171       int j;
172       celt_word32_t * restrict x1, * restrict x2;
173       for (j=0;j<2*N-2*N4;j++)
174          x[j+N4] = in[C*j+c];
175       x1 = x+N4;
176       x2 = x+2*N-N4-1;
177       for (j=0;j<overlap;j++)
178       {
179          *x1 = MULT16_32_Q15(window[j],*x1);
180          *x2 = MULT16_32_Q15(window[j],*x2);
181          x1++;
182          x2--;
183       }
184       for (j=0;j<N4;j++)
185       {
186          x[j] = 0;
187          x[2*N-j-1] = 0;
188       }
189       mdct_forward(lookup, x, tmp);
190       /* Interleaving the sub-frames */
191       for (j=0;j<N;j++)
192          out[C*j+c] = tmp[j];
193    }
194    RESTORE_STACK;
195 }
196
197 /** Compute the IMDCT and apply window for all sub-frames and all channels in a frame */
198 static void compute_inv_mdcts(const CELTMode *mode, const celt_word16_t * restrict window, celt_sig_t *X, celt_sig_t * restrict out_mem, celt_sig_t * restrict mdct_overlap)
199 {
200    int c, N4;
201    VARDECL(celt_word32_t, x);
202    VARDECL(celt_word32_t, tmp);
203    const int C = CHANNELS(mode);
204    const mdct_lookup *lookup = MDCT(mode);
205    const int N = FRAMESIZE(mode);
206    const int overlap = OVERLAP(mode);
207    SAVE_STACK;
208    ALLOC(x, 2*N, celt_word32_t);
209    ALLOC(tmp, N, celt_word32_t);
210    N4 = (N-overlap)>>1;
211    for (c=0;c<C;c++)
212    {
213       int j;
214       /* De-interleaving the sub-frames */
215       for (j=0;j<N;j++)
216          tmp[j] = X[C*j+c];
217       mdct_backward(lookup, tmp, x);
218          /* The first and last part would need to be set to zero if we actually
219       wanted to use them. */
220       for (j=0;j<overlap;j++)
221          out_mem[C*(MAX_PERIOD-N)+C*j+c] = 2*(mdct_overlap[C*j+c]+MULT16_32_Q15(window[j],x[j+N4]));
222       for (j=0;j<overlap;j++)
223          mdct_overlap[C*(overlap-j-1)+c] = MULT16_32_Q15(window[j],x[2*N-j-N4-1]);
224       for (j=0;j<2*N4;j++)
225          out_mem[C*(MAX_PERIOD-N)+C*(j+overlap)+c] = 2*x[j+N4+overlap];
226    }
227    RESTORE_STACK;
228 }
229
230 int EXPORT celt_encode(CELTEncoder *st, celt_int16_t *pcm, unsigned char *compressed, int nbCompressedBytes)
231 {
232    int i, c, N, N4;
233    int has_pitch;
234    int pitch_index;
235    celt_word32_t curr_power, pitch_power;
236    VARDECL(celt_sig_t, in);
237    VARDECL(celt_sig_t, freq);
238    VARDECL(celt_norm_t, X);
239    VARDECL(celt_norm_t, P);
240    VARDECL(celt_ener_t, bandE);
241    VARDECL(celt_pgain_t, gains);
242    const int C = CHANNELS(st->mode);
243    SAVE_STACK;
244
245    if (check_mode(st->mode) != CELT_OK)
246       return CELT_INVALID_MODE;
247
248    N = st->block_size;
249    N4 = (N-st->overlap)>>1;
250    ALLOC(in, 2*C*N-2*N4, celt_sig_t);
251    
252
253    for (c=0;c<C;c++)
254    {
255       for (i=0;i<st->overlap;i++)
256          in[C*i+c] = st->in_mem[C*i+c];
257       for (i=0;i<N;i++)
258       {
259          celt_sig_t tmp = SHL32(EXTEND32(pcm[C*i+c]), SIG_SHIFT);
260          in[C*(i+st->overlap)+c] = SUB32(tmp, MULT16_32_Q15(preemph,st->preemph_memE[c]));
261          st->preemph_memE[c] = tmp;
262       }
263       for (i=0;i<st->overlap;i++)
264          st->in_mem[C*i+c] = in[C*(2*N-2*N4-st->overlap+i)+c];
265    }
266    /* Pitch analysis: we do it early to save on the peak stack space */
267    find_spectral_pitch(st->fft, &st->mode->psy, in, st->out_mem, st->mode->window, st->overlap, MAX_PERIOD, 2*N-2*N4, C, &pitch_index);
268
269    ALLOC(freq, C*N, celt_sig_t); /**< Interleaved signal MDCTs */
270    
271    /*for (i=0;i<(B+1)*C*N;i++) printf ("%f(%d) ", in[i], i); printf ("\n");*/
272    /* Compute MDCTs */
273    compute_mdcts(st->mode, st->mode->window, in, freq);
274
275 #if 0 /* Mask disabled until it can be made to do something useful */
276    compute_mdct_masking(X, mask, B*C*N, st->Fs);
277
278    /* Invert and stretch the mask to length of X 
279       For some reason, I get better results by using the sqrt instead,
280       although there's no valid reason to. Must investigate further */
281    for (i=0;i<B*C*N;i++)
282       mask[i] = 1/(.1+mask[i]);
283 #endif
284    
285    /* Deferred allocation after find_spectral_pitch() to reduce the peak memory usage */
286    ALLOC(X, C*N, celt_norm_t);         /**< Interleaved normalised MDCTs */
287    ALLOC(P, C*N, celt_norm_t);         /**< Interleaved normalised pitch MDCTs*/
288    ALLOC(bandE,st->mode->nbEBands*C, celt_ener_t);
289    ALLOC(gains,st->mode->nbPBands, celt_pgain_t);
290
291    /*printf ("%f %f\n", curr_power, pitch_power);*/
292    /*int j;
293    for (j=0;j<B*N;j++)
294       printf ("%f ", X[j]);
295    for (j=0;j<B*N;j++)
296       printf ("%f ", P[j]);
297    printf ("\n");*/
298
299    /* Band normalisation */
300    compute_band_energies(st->mode, freq, bandE);
301    normalise_bands(st->mode, freq, X, bandE);
302    /*for (i=0;i<st->mode->nbEBands;i++)printf("%f ", bandE[i]);printf("\n");*/
303    /*for (i=0;i<N*B*C;i++)printf("%f ", X[i]);printf("\n");*/
304
305    /* Compute MDCTs of the pitch part */
306    compute_mdcts(st->mode, st->mode->window, st->out_mem+pitch_index*C, freq);
307
308    quant_energy(st->mode, bandE, st->oldBandE, nbCompressedBytes*8/3, &st->enc);
309
310    if (C==2)
311    {
312       stereo_mix(st->mode, X, bandE, 1);
313    }
314
315    {
316       /* Normalise the pitch vector as well (discard the energies) */
317       VARDECL(celt_ener_t, bandEp);
318       ALLOC(bandEp, st->mode->nbEBands*st->mode->nbChannels, celt_ener_t);
319       compute_band_energies(st->mode, freq, bandEp);
320       normalise_bands(st->mode, freq, P, bandEp);
321       pitch_power = bandEp[0]+bandEp[1]+bandEp[2];
322    }
323    curr_power = bandE[0]+bandE[1]+bandE[2];
324    /* Check if we can safely use the pitch (i.e. effective gain isn't too high) */
325    if (MULT16_32_Q15(QCONST16(.1f, 15),curr_power) + QCONST32(10.f,ENER_SHIFT) < pitch_power)
326    {
327       if (C==2)
328          stereo_mix(st->mode, P, bandE, 1);
329       /* Simulates intensity stereo */
330       /*for (i=30;i<N*B;i++)
331          X[i*C+1] = P[i*C+1] = 0;*/
332
333       /* Pitch prediction */
334       compute_pitch_gain(st->mode, X, P, gains);
335       has_pitch = quant_pitch(gains, st->mode->nbPBands, &st->enc);
336       if (has_pitch)
337          ec_enc_uint(&st->enc, pitch_index, MAX_PERIOD-(2*N-2*N4));
338    } else {
339       /* No pitch, so we just pretend we found a gain of zero */
340       for (i=0;i<st->mode->nbPBands;i++)
341          gains[i] = 0;
342       ec_enc_uint(&st->enc, 0, 128);
343       for (i=0;i<C*N;i++)
344          P[i] = 0;
345    }
346    
347
348    pitch_quant_bands(st->mode, P, gains);
349
350    /*for (i=0;i<B*N;i++) printf("%f ",P[i]);printf("\n");*/
351    /* Compute residual that we're going to encode */
352    for (i=0;i<C*N;i++)
353       X[i] -= P[i];
354
355    /* Residual quantisation */
356    quant_bands(st->mode, X, P, NULL, nbCompressedBytes*8, &st->enc);
357    
358    if (C==2)
359    {
360       stereo_mix(st->mode, X, bandE, -1);
361       renormalise_bands(st->mode, X);
362    }
363    /* Synthesis */
364    denormalise_bands(st->mode, X, freq, bandE);
365
366
367    CELT_MOVE(st->out_mem, st->out_mem+C*N, C*(MAX_PERIOD-N));
368
369    compute_inv_mdcts(st->mode, st->mode->window, freq, st->out_mem, st->mdct_overlap);
370    /* De-emphasis and put everything back at the right place in the synthesis history */
371    for (c=0;c<C;c++)
372    {
373       int j;
374       for (j=0;j<N;j++)
375       {
376          celt_sig_t tmp = ADD32(st->out_mem[C*(MAX_PERIOD-N)+C*j+c],
377                                 MULT16_32_Q15(preemph,st->preemph_memD[c]));
378          st->preemph_memD[c] = tmp;
379          pcm[C*j+c] = SIG2INT16(tmp);
380       }
381    }
382    
383    if (ec_enc_tell(&st->enc, 0) < nbCompressedBytes*8 - 7)
384       celt_warning_int ("many unused bits: ", nbCompressedBytes*8-ec_enc_tell(&st->enc, 0));
385    /*printf ("%d\n", ec_enc_tell(&st->enc, 0)-8*nbCompressedBytes);*/
386    /* Finishing the stream with a 0101... pattern so that the decoder can check is everything's right */
387    {
388       int val = 0;
389       while (ec_enc_tell(&st->enc, 0) < nbCompressedBytes*8)
390       {
391          ec_enc_uint(&st->enc, val, 2);
392          val = 1-val;
393       }
394    }
395    ec_enc_done(&st->enc);
396    {
397       unsigned char *data;
398       int nbBytes = ec_byte_bytes(&st->buf);
399       if (nbBytes > nbCompressedBytes)
400       {
401          celt_warning_int ("got too many bytes:", nbBytes);
402          RESTORE_STACK;
403          return CELT_INTERNAL_ERROR;
404       }
405       /*printf ("%d\n", *nbBytes);*/
406       data = ec_byte_get_buffer(&st->buf);
407       for (i=0;i<nbBytes;i++)
408          compressed[i] = data[i];
409       for (;i<nbCompressedBytes;i++)
410          compressed[i] = 0;
411    }
412    /* Reset the packing for the next encoding */
413    ec_byte_reset(&st->buf);
414    ec_enc_init(&st->enc,&st->buf);
415
416    RESTORE_STACK;
417    return nbCompressedBytes;
418 }
419
420
421 /****************************************************************************/
422 /*                                                                          */
423 /*                                DECODER                                   */
424 /*                                                                          */
425 /****************************************************************************/
426
427
428 /** Decoder state 
429  @brief Decoder state
430  */
431 struct CELTDecoder {
432    const CELTMode *mode;
433    int frame_size;
434    int block_size;
435    int overlap;
436
437    ec_byte_buffer buf;
438    ec_enc         enc;
439
440    celt_sig_t *preemph_memD;
441
442    celt_sig_t *mdct_overlap;
443    celt_sig_t *out_mem;
444
445    celt_word16_t *oldBandE;
446    
447    int last_pitch_index;
448 };
449
450 CELTDecoder EXPORT *celt_decoder_create(const CELTMode *mode)
451 {
452    int N, C;
453    CELTDecoder *st;
454
455    if (check_mode(mode) != CELT_OK)
456       return NULL;
457
458    N = mode->mdctSize;
459    C = CHANNELS(mode);
460    st = celt_alloc(sizeof(CELTDecoder));
461    
462    st->mode = mode;
463    st->frame_size = N;
464    st->block_size = N;
465    st->overlap = mode->overlap;
466
467    st->mdct_overlap = celt_alloc(N*C*sizeof(celt_sig_t));
468    st->out_mem = celt_alloc(MAX_PERIOD*C*sizeof(celt_sig_t));
469    
470    st->oldBandE = (celt_word16_t*)celt_alloc(C*mode->nbEBands*sizeof(celt_word16_t));
471
472    st->preemph_memD = (celt_sig_t*)celt_alloc(C*sizeof(celt_sig_t));;
473
474    st->last_pitch_index = 0;
475    return st;
476 }
477
478 void EXPORT celt_decoder_destroy(CELTDecoder *st)
479 {
480    if (st == NULL)
481    {
482       celt_warning("NULL passed to celt_encoder_destroy");
483       return;
484    }
485    if (check_mode(st->mode) != CELT_OK)
486       return;
487
488
489    celt_free(st->mdct_overlap);
490    celt_free(st->out_mem);
491    
492    celt_free(st->oldBandE);
493    
494    celt_free(st->preemph_memD);
495
496    celt_free(st);
497 }
498
499 /** Handles lost packets by just copying past data with the same offset as the last
500     pitch period */
501 static void celt_decode_lost(CELTDecoder *st, short *pcm)
502 {
503    int c, N;
504    int pitch_index;
505    VARDECL(celt_sig_t, freq);
506    const int C = CHANNELS(st->mode);
507    SAVE_STACK;
508    N = st->block_size;
509    ALLOC(freq,C*N, celt_sig_t);         /**< Interleaved signal MDCTs */
510    
511    pitch_index = st->last_pitch_index;
512    
513    /* Use the pitch MDCT as the "guessed" signal */
514    compute_mdcts(st->mode, st->mode->window, st->out_mem+pitch_index*C, freq);
515
516    CELT_MOVE(st->out_mem, st->out_mem+C*N, C*(MAX_PERIOD-N));
517    /* Compute inverse MDCTs */
518    compute_inv_mdcts(st->mode, st->mode->window, freq, st->out_mem, st->mdct_overlap);
519
520    for (c=0;c<C;c++)
521    {
522       int j;
523       for (j=0;j<N;j++)
524       {
525          celt_sig_t tmp = ADD32(st->out_mem[C*(MAX_PERIOD-N)+C*j+c],
526                                 MULT16_32_Q15(preemph,st->preemph_memD[c]));
527          st->preemph_memD[c] = tmp;
528          pcm[C*j+c] = SIG2INT16(tmp);
529       }
530    }
531    RESTORE_STACK;
532 }
533
534 int EXPORT celt_decode(CELTDecoder *st, unsigned char *data, int len, celt_int16_t *pcm)
535 {
536    int c, N, N4;
537    int has_pitch;
538    int pitch_index;
539    ec_dec dec;
540    ec_byte_buffer buf;
541    VARDECL(celt_sig_t, freq);
542    VARDECL(celt_norm_t, X);
543    VARDECL(celt_norm_t, P);
544    VARDECL(celt_ener_t, bandE);
545    VARDECL(celt_pgain_t, gains);
546    const int C = CHANNELS(st->mode);
547    SAVE_STACK;
548
549    if (check_mode(st->mode) != CELT_OK)
550       return CELT_INVALID_MODE;
551
552    N = st->block_size;
553    N4 = (N-st->overlap)>>1;
554
555    ALLOC(freq, C*N, celt_sig_t); /**< Interleaved signal MDCTs */
556    ALLOC(X, C*N, celt_norm_t);         /**< Interleaved normalised MDCTs */
557    ALLOC(P, C*N, celt_norm_t);         /**< Interleaved normalised pitch MDCTs*/
558    ALLOC(bandE, st->mode->nbEBands*C, celt_ener_t);
559    ALLOC(gains, st->mode->nbPBands, celt_pgain_t);
560    
561    if (check_mode(st->mode) != CELT_OK)
562    {
563       RESTORE_STACK;
564       return CELT_INVALID_MODE;
565    }
566    if (data == NULL)
567    {
568       celt_decode_lost(st, pcm);
569       RESTORE_STACK;
570       return 0;
571    }
572    
573    ec_byte_readinit(&buf,data,len);
574    ec_dec_init(&dec,&buf);
575    
576    /* Get band energies */
577    unquant_energy(st->mode, bandE, st->oldBandE, len*8/3, &dec);
578    
579    /* Get the pitch gains */
580    has_pitch = unquant_pitch(gains, st->mode->nbPBands, &dec);
581    
582    /* Get the pitch index */
583    if (has_pitch)
584    {
585       pitch_index = ec_dec_uint(&dec, MAX_PERIOD-(2*N-2*N4));
586       st->last_pitch_index = pitch_index;
587    } else {
588       /* FIXME: We could be more intelligent here and just not compute the MDCT */
589       pitch_index = 0;
590    }
591    
592    /* Pitch MDCT */
593    compute_mdcts(st->mode, st->mode->window, st->out_mem+pitch_index*C, freq);
594
595    {
596       VARDECL(celt_ener_t, bandEp);
597       ALLOC(bandEp, st->mode->nbEBands*C, celt_ener_t);
598       compute_band_energies(st->mode, freq, bandEp);
599       normalise_bands(st->mode, freq, P, bandEp);
600    }
601
602    if (C==2)
603       stereo_mix(st->mode, P, bandE, 1);
604
605    /* Apply pitch gains */
606    pitch_quant_bands(st->mode, P, gains);
607
608    /* Decode fixed codebook and merge with pitch */
609    unquant_bands(st->mode, X, P, len*8, &dec);
610
611    if (C==2)
612    {
613       stereo_mix(st->mode, X, bandE, -1);
614       renormalise_bands(st->mode, X);
615    }
616    /* Synthesis */
617    denormalise_bands(st->mode, X, freq, bandE);
618
619
620    CELT_MOVE(st->out_mem, st->out_mem+C*N, C*(MAX_PERIOD-N));
621    /* Compute inverse MDCTs */
622    compute_inv_mdcts(st->mode, st->mode->window, freq, st->out_mem, st->mdct_overlap);
623
624    for (c=0;c<C;c++)
625    {
626       int j;
627       for (j=0;j<N;j++)
628       {
629          celt_sig_t tmp = ADD32(st->out_mem[C*(MAX_PERIOD-N)+C*j+c],
630                                 MULT16_32_Q15(preemph,st->preemph_memD[c]));
631          st->preemph_memD[c] = tmp;
632          pcm[C*j+c] = SIG2INT16(tmp);
633       }
634    }
635
636    {
637       unsigned int val = 0;
638       while (ec_dec_tell(&dec, 0) < len*8)
639       {
640          if (ec_dec_uint(&dec, 2) != val)
641          {
642             celt_warning("decode error");
643             RESTORE_STACK;
644             return CELT_CORRUPTED_DATA;
645          }
646          val = 1-val;
647       }
648    }
649
650    RESTORE_STACK;
651    return 0;
652    /*printf ("\n");*/
653 }
654