ec7b54476026a93078a0f246037f644eb0d75e15
[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_word16_t * restrict preemph_memE; /* Input is 16-bit, so why bother with 32 */
70    celt_sig_t    * restrict 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(st->overlap*C*sizeof(celt_sig_t));
104    st->mdct_overlap = celt_alloc(st->overlap*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_word16_t*)celt_alloc(C*sizeof(celt_word16_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    x = MAX32(x, -32768);
145    x = MIN32(x, 32767);
146 #ifdef FIXED_POINT
147    return EXTRACT16(x);
148 #else
149    return (celt_int16_t)floor(.5+x);
150 #endif
151 }
152
153 /** Apply window and compute the MDCT for all sub-frames and all channels in a frame */
154 static void compute_mdcts(const CELTMode *mode, const celt_word16_t * restrict window, celt_sig_t * restrict in, celt_sig_t * restrict out)
155 {
156    const mdct_lookup *lookup = MDCT(mode);
157    const int N = FRAMESIZE(mode);
158    const int C = CHANNELS(mode);
159    const int overlap = OVERLAP(mode);
160    if (C==1)
161    {
162       mdct_forward(lookup, in, out, window, overlap);
163    } else {
164       int c;
165       VARDECL(celt_word32_t, x);
166       VARDECL(celt_word32_t, tmp);
167       SAVE_STACK;
168       ALLOC(x, N+overlap, celt_word32_t);
169       ALLOC(tmp, N, celt_word32_t);
170       for (c=0;c<C;c++)
171       {
172          int j;
173          for (j=0;j<N+overlap;j++)
174             x[j] = in[C*j+c];
175          mdct_forward(lookup, x, tmp, window, overlap);
176          /* Interleaving the sub-frames */
177          for (j=0;j<N;j++)
178             out[C*j+c] = tmp[j];
179       }
180       RESTORE_STACK;
181    }
182 }
183
184 /** Compute the IMDCT and apply window for all sub-frames and all channels in a frame */
185 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)
186 {
187    int c, N4;
188    VARDECL(celt_word32_t, x);
189    VARDECL(celt_word32_t, tmp);
190    const int C = CHANNELS(mode);
191    const mdct_lookup *lookup = MDCT(mode);
192    const int N = FRAMESIZE(mode);
193    const int overlap = OVERLAP(mode);
194    SAVE_STACK;
195    ALLOC(x, 2*N, celt_word32_t);
196    ALLOC(tmp, N, celt_word32_t);
197    N4 = (N-overlap)>>1;
198    for (c=0;c<C;c++)
199    {
200       int j;
201       if (C==1) {
202          mdct_backward(lookup, X, x);
203       } else {
204          /* De-interleaving the sub-frames */
205          for (j=0;j<N;j++)
206             tmp[j] = X[C*j+c];
207          mdct_backward(lookup, tmp, x);
208       }
209          /* The first and last part would need to be set to zero if we actually
210       wanted to use them. */
211       for (j=0;j<overlap;j++)
212          out_mem[C*(MAX_PERIOD-N)+C*j+c] = 2*(mdct_overlap[C*j+c]+MULT16_32_Q15(window[j],x[j+N4]));
213       for (j=0;j<overlap;j++)
214          mdct_overlap[C*(overlap-j-1)+c] = MULT16_32_Q15(window[j],x[2*N-j-N4-1]);
215       for (j=0;j<2*N4;j++)
216          out_mem[C*(MAX_PERIOD-N)+C*(j+overlap)+c] = 2*x[j+N4+overlap];
217    }
218    RESTORE_STACK;
219 }
220
221 int EXPORT celt_encode(CELTEncoder * restrict st, celt_int16_t * restrict pcm, unsigned char *compressed, int nbCompressedBytes)
222 {
223    int i, c, N, N4;
224    int has_pitch;
225    int pitch_index;
226    celt_word32_t curr_power, pitch_power;
227    VARDECL(celt_sig_t, in);
228    VARDECL(celt_sig_t, freq);
229    VARDECL(celt_norm_t, X);
230    VARDECL(celt_norm_t, P);
231    VARDECL(celt_ener_t, bandE);
232    VARDECL(celt_pgain_t, gains);
233    const int C = CHANNELS(st->mode);
234    SAVE_STACK;
235
236    if (check_mode(st->mode) != CELT_OK)
237       return CELT_INVALID_MODE;
238
239    N = st->block_size;
240    N4 = (N-st->overlap)>>1;
241    ALLOC(in, 2*C*N-2*C*N4, celt_sig_t);
242
243    CELT_COPY(in, st->in_mem, C*st->overlap);
244    for (c=0;c<C;c++)
245    {
246       const celt_int16_t * restrict pcmp = pcm+c;
247       celt_sig_t * restrict inp = in+C*st->overlap+c;
248       for (i=0;i<N;i++)
249       {
250          /* Apply pre-emphasis */
251          celt_sig_t tmp = SHL32(EXTEND32(*pcmp), SIG_SHIFT);
252          *inp = SUB32(tmp, SHR32(MULT16_16(preemph,st->preemph_memE[c]),1));
253          st->preemph_memE[c] = *pcmp;
254          inp += C;
255          pcmp += C;
256       }
257    }
258    CELT_COPY(st->in_mem, in+C*(2*N-2*N4-st->overlap), C*st->overlap);
259
260    /* Pitch analysis: we do it early to save on the peak stack space */
261    find_spectral_pitch(st->mode, st->fft, &st->mode->psy, in, st->out_mem, st->mode->window, 2*N-2*N4, &pitch_index);
262
263    ALLOC(freq, C*N, celt_sig_t); /**< Interleaved signal MDCTs */
264    
265    /*for (i=0;i<(B+1)*C*N;i++) printf ("%f(%d) ", in[i], i); printf ("\n");*/
266    /* Compute MDCTs */
267    compute_mdcts(st->mode, st->mode->window, in, freq);
268
269 #if 0 /* Mask disabled until it can be made to do something useful */
270    compute_mdct_masking(X, mask, B*C*N, st->Fs);
271
272    /* Invert and stretch the mask to length of X 
273       For some reason, I get better results by using the sqrt instead,
274       although there's no valid reason to. Must investigate further */
275    for (i=0;i<B*C*N;i++)
276       mask[i] = 1/(.1+mask[i]);
277 #endif
278    
279    /* Deferred allocation after find_spectral_pitch() to reduce the peak memory usage */
280    ALLOC(X, C*N, celt_norm_t);         /**< Interleaved normalised MDCTs */
281    ALLOC(P, C*N, celt_norm_t);         /**< Interleaved normalised pitch MDCTs*/
282    ALLOC(bandE,st->mode->nbEBands*C, celt_ener_t);
283    ALLOC(gains,st->mode->nbPBands, celt_pgain_t);
284
285    /*printf ("%f %f\n", curr_power, pitch_power);*/
286    /*int j;
287    for (j=0;j<B*N;j++)
288       printf ("%f ", X[j]);
289    for (j=0;j<B*N;j++)
290       printf ("%f ", P[j]);
291    printf ("\n");*/
292
293    /* Band normalisation */
294    compute_band_energies(st->mode, freq, bandE);
295    normalise_bands(st->mode, freq, X, bandE);
296    /*for (i=0;i<st->mode->nbEBands;i++)printf("%f ", bandE[i]);printf("\n");*/
297    /*for (i=0;i<N*B*C;i++)printf("%f ", X[i]);printf("\n");*/
298
299    /* Compute MDCTs of the pitch part */
300    compute_mdcts(st->mode, st->mode->window, st->out_mem+pitch_index*C, freq);
301
302    quant_energy(st->mode, bandE, st->oldBandE, nbCompressedBytes*8/3, &st->enc);
303
304    if (C==2)
305    {
306       stereo_mix(st->mode, X, bandE, 1);
307    }
308
309    {
310       /* Normalise the pitch vector as well (discard the energies) */
311       VARDECL(celt_ener_t, bandEp);
312       ALLOC(bandEp, st->mode->nbEBands*st->mode->nbChannels, celt_ener_t);
313       compute_band_energies(st->mode, freq, bandEp);
314       normalise_bands(st->mode, freq, P, bandEp);
315       pitch_power = bandEp[0]+bandEp[1]+bandEp[2];
316    }
317    curr_power = bandE[0]+bandE[1]+bandE[2];
318    /* Check if we can safely use the pitch (i.e. effective gain isn't too high) */
319    if (MULT16_32_Q15(QCONST16(.1f, 15),curr_power) + QCONST32(10.f,ENER_SHIFT) < pitch_power)
320    {
321       if (C==2)
322          stereo_mix(st->mode, P, bandE, 1);
323       /* Simulates intensity stereo */
324       /*for (i=30;i<N*B;i++)
325          X[i*C+1] = P[i*C+1] = 0;*/
326
327       /* Pitch prediction */
328       compute_pitch_gain(st->mode, X, P, gains);
329       has_pitch = quant_pitch(gains, st->mode->nbPBands, &st->enc);
330       if (has_pitch)
331          ec_enc_uint(&st->enc, pitch_index, MAX_PERIOD-(2*N-2*N4));
332    } else {
333       /* No pitch, so we just pretend we found a gain of zero */
334       for (i=0;i<st->mode->nbPBands;i++)
335          gains[i] = 0;
336       ec_enc_bits(&st->enc, 0, 7);
337       for (i=0;i<C*N;i++)
338          P[i] = 0;
339    }
340    
341
342    pitch_quant_bands(st->mode, P, gains);
343
344    /*for (i=0;i<B*N;i++) printf("%f ",P[i]);printf("\n");*/
345    /* Compute residual that we're going to encode */
346    for (i=0;i<C*st->mode->eBands[st->mode->nbEBands];i++)
347       X[i] -= P[i];
348
349    /* Residual quantisation */
350    quant_bands(st->mode, X, P, NULL, nbCompressedBytes*8, &st->enc);
351    
352    if (C==2)
353    {
354       stereo_mix(st->mode, X, bandE, -1);
355       renormalise_bands(st->mode, X);
356    }
357    /* Synthesis */
358    denormalise_bands(st->mode, X, freq, bandE);
359
360
361    CELT_MOVE(st->out_mem, st->out_mem+C*N, C*(MAX_PERIOD-N));
362
363    compute_inv_mdcts(st->mode, st->mode->window, freq, st->out_mem, st->mdct_overlap);
364    /* De-emphasis and put everything back at the right place in the synthesis history */
365    for (c=0;c<C;c++)
366    {
367       int j;
368       const celt_sig_t * restrict outp=st->out_mem+C*(MAX_PERIOD-N)+c;
369       celt_int16_t * restrict pcmp = pcm+c;
370       for (j=0;j<N;j++)
371       {
372          celt_sig_t tmp = ADD32(*outp, MULT16_32_Q15(preemph,st->preemph_memD[c]));
373          st->preemph_memD[c] = tmp;
374          *pcmp = SIG2INT16(tmp);
375          pcmp += C;
376          outp += C;
377       }
378    }
379    
380    if (ec_enc_tell(&st->enc, 0) < nbCompressedBytes*8 - 7)
381       celt_warning_int ("many unused bits: ", nbCompressedBytes*8-ec_enc_tell(&st->enc, 0));
382    /*printf ("%d\n", ec_enc_tell(&st->enc, 0)-8*nbCompressedBytes);*/
383    /* Finishing the stream with a 0101... pattern so that the decoder can check is everything's right */
384    {
385       int val = 0;
386       while (ec_enc_tell(&st->enc, 0) < nbCompressedBytes*8)
387       {
388          ec_enc_uint(&st->enc, val, 2);
389          val = 1-val;
390       }
391    }
392    ec_enc_done(&st->enc);
393    {
394       unsigned char *data;
395       int nbBytes = ec_byte_bytes(&st->buf);
396       if (nbBytes > nbCompressedBytes)
397       {
398          celt_warning_int ("got too many bytes:", nbBytes);
399          RESTORE_STACK;
400          return CELT_INTERNAL_ERROR;
401       }
402       /*printf ("%d\n", *nbBytes);*/
403       data = ec_byte_get_buffer(&st->buf);
404       for (i=0;i<nbBytes;i++)
405          compressed[i] = data[i];
406       for (;i<nbCompressedBytes;i++)
407          compressed[i] = 0;
408    }
409    /* Reset the packing for the next encoding */
410    ec_byte_reset(&st->buf);
411    ec_enc_init(&st->enc,&st->buf);
412
413    RESTORE_STACK;
414    return nbCompressedBytes;
415 }
416
417
418 /****************************************************************************/
419 /*                                                                          */
420 /*                                DECODER                                   */
421 /*                                                                          */
422 /****************************************************************************/
423
424
425 /** Decoder state 
426  @brief Decoder state
427  */
428 struct CELTDecoder {
429    const CELTMode *mode;
430    int frame_size;
431    int block_size;
432    int overlap;
433
434    ec_byte_buffer buf;
435    ec_enc         enc;
436
437    celt_sig_t * restrict preemph_memD;
438
439    celt_sig_t *mdct_overlap;
440    celt_sig_t *out_mem;
441
442    celt_word16_t *oldBandE;
443    
444    int last_pitch_index;
445 };
446
447 CELTDecoder EXPORT *celt_decoder_create(const CELTMode *mode)
448 {
449    int N, C;
450    CELTDecoder *st;
451
452    if (check_mode(mode) != CELT_OK)
453       return NULL;
454
455    N = mode->mdctSize;
456    C = CHANNELS(mode);
457    st = celt_alloc(sizeof(CELTDecoder));
458    
459    st->mode = mode;
460    st->frame_size = N;
461    st->block_size = N;
462    st->overlap = mode->overlap;
463
464    st->mdct_overlap = celt_alloc(st->overlap*C*sizeof(celt_sig_t));
465    st->out_mem = celt_alloc(MAX_PERIOD*C*sizeof(celt_sig_t));
466    
467    st->oldBandE = (celt_word16_t*)celt_alloc(C*mode->nbEBands*sizeof(celt_word16_t));
468
469    st->preemph_memD = (celt_sig_t*)celt_alloc(C*sizeof(celt_sig_t));;
470
471    st->last_pitch_index = 0;
472    return st;
473 }
474
475 void EXPORT celt_decoder_destroy(CELTDecoder *st)
476 {
477    if (st == NULL)
478    {
479       celt_warning("NULL passed to celt_encoder_destroy");
480       return;
481    }
482    if (check_mode(st->mode) != CELT_OK)
483       return;
484
485
486    celt_free(st->mdct_overlap);
487    celt_free(st->out_mem);
488    
489    celt_free(st->oldBandE);
490    
491    celt_free(st->preemph_memD);
492
493    celt_free(st);
494 }
495
496 /** Handles lost packets by just copying past data with the same offset as the last
497     pitch period */
498 static void celt_decode_lost(CELTDecoder * restrict st, short * restrict pcm)
499 {
500    int c, N;
501    int pitch_index;
502    VARDECL(celt_sig_t, freq);
503    const int C = CHANNELS(st->mode);
504    SAVE_STACK;
505    N = st->block_size;
506    ALLOC(freq,C*N, celt_sig_t);         /**< Interleaved signal MDCTs */
507    
508    pitch_index = st->last_pitch_index;
509    
510    /* Use the pitch MDCT as the "guessed" signal */
511    compute_mdcts(st->mode, st->mode->window, st->out_mem+pitch_index*C, freq);
512
513    CELT_MOVE(st->out_mem, st->out_mem+C*N, C*(MAX_PERIOD-N));
514    /* Compute inverse MDCTs */
515    compute_inv_mdcts(st->mode, st->mode->window, freq, st->out_mem, st->mdct_overlap);
516
517    for (c=0;c<C;c++)
518    {
519       int j;
520       for (j=0;j<N;j++)
521       {
522          celt_sig_t tmp = ADD32(st->out_mem[C*(MAX_PERIOD-N)+C*j+c],
523                                 MULT16_32_Q15(preemph,st->preemph_memD[c]));
524          st->preemph_memD[c] = tmp;
525          pcm[C*j+c] = SIG2INT16(tmp);
526       }
527    }
528    RESTORE_STACK;
529 }
530
531 int EXPORT celt_decode(CELTDecoder * restrict st, unsigned char *data, int len, celt_int16_t * restrict pcm)
532 {
533    int c, N, N4;
534    int has_pitch;
535    int pitch_index;
536    ec_dec dec;
537    ec_byte_buffer buf;
538    VARDECL(celt_sig_t, freq);
539    VARDECL(celt_norm_t, X);
540    VARDECL(celt_norm_t, P);
541    VARDECL(celt_ener_t, bandE);
542    VARDECL(celt_pgain_t, gains);
543    const int C = CHANNELS(st->mode);
544    SAVE_STACK;
545
546    if (check_mode(st->mode) != CELT_OK)
547       return CELT_INVALID_MODE;
548
549    N = st->block_size;
550    N4 = (N-st->overlap)>>1;
551
552    ALLOC(freq, C*N, celt_sig_t); /**< Interleaved signal MDCTs */
553    ALLOC(X, C*N, celt_norm_t);         /**< Interleaved normalised MDCTs */
554    ALLOC(P, C*N, celt_norm_t);         /**< Interleaved normalised pitch MDCTs*/
555    ALLOC(bandE, st->mode->nbEBands*C, celt_ener_t);
556    ALLOC(gains, st->mode->nbPBands, celt_pgain_t);
557    
558    if (check_mode(st->mode) != CELT_OK)
559    {
560       RESTORE_STACK;
561       return CELT_INVALID_MODE;
562    }
563    if (data == NULL)
564    {
565       celt_decode_lost(st, pcm);
566       RESTORE_STACK;
567       return 0;
568    }
569    
570    ec_byte_readinit(&buf,data,len);
571    ec_dec_init(&dec,&buf);
572    
573    /* Get band energies */
574    unquant_energy(st->mode, bandE, st->oldBandE, len*8/3, &dec);
575    
576    /* Get the pitch gains */
577    has_pitch = unquant_pitch(gains, st->mode->nbPBands, &dec);
578    
579    /* Get the pitch index */
580    if (has_pitch)
581    {
582       pitch_index = ec_dec_uint(&dec, MAX_PERIOD-(2*N-2*N4));
583       st->last_pitch_index = pitch_index;
584    } else {
585       /* FIXME: We could be more intelligent here and just not compute the MDCT */
586       pitch_index = 0;
587    }
588    
589    /* Pitch MDCT */
590    compute_mdcts(st->mode, st->mode->window, st->out_mem+pitch_index*C, freq);
591
592    {
593       VARDECL(celt_ener_t, bandEp);
594       ALLOC(bandEp, st->mode->nbEBands*C, celt_ener_t);
595       compute_band_energies(st->mode, freq, bandEp);
596       normalise_bands(st->mode, freq, P, bandEp);
597    }
598
599    if (C==2)
600       stereo_mix(st->mode, P, bandE, 1);
601
602    /* Apply pitch gains */
603    pitch_quant_bands(st->mode, P, gains);
604
605    /* Decode fixed codebook and merge with pitch */
606    unquant_bands(st->mode, X, P, len*8, &dec);
607
608    if (C==2)
609    {
610       stereo_mix(st->mode, X, bandE, -1);
611       renormalise_bands(st->mode, X);
612    }
613    /* Synthesis */
614    denormalise_bands(st->mode, X, freq, bandE);
615
616
617    CELT_MOVE(st->out_mem, st->out_mem+C*N, C*(MAX_PERIOD-N));
618    /* Compute inverse MDCTs */
619    compute_inv_mdcts(st->mode, st->mode->window, freq, st->out_mem, st->mdct_overlap);
620
621    for (c=0;c<C;c++)
622    {
623       int j;
624       const celt_sig_t * restrict outp=st->out_mem+C*(MAX_PERIOD-N)+c;
625       celt_int16_t * restrict pcmp = pcm+c;
626       for (j=0;j<N;j++)
627       {
628          celt_sig_t tmp = ADD32(*outp, MULT16_32_Q15(preemph,st->preemph_memD[c]));
629          st->preemph_memD[c] = tmp;
630          *pcmp = SIG2INT16(tmp);
631          pcmp += C;
632          outp += C;
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