1*a58d3d2aSXin Li /* Copyright (c) 2007-2008 CSIRO
2*a58d3d2aSXin Li Copyright (c) 2007-2010 Xiph.Org Foundation
3*a58d3d2aSXin Li Copyright (c) 2008 Gregory Maxwell
4*a58d3d2aSXin Li Written by Jean-Marc Valin and Gregory Maxwell */
5*a58d3d2aSXin Li /*
6*a58d3d2aSXin Li Redistribution and use in source and binary forms, with or without
7*a58d3d2aSXin Li modification, are permitted provided that the following conditions
8*a58d3d2aSXin Li are met:
9*a58d3d2aSXin Li
10*a58d3d2aSXin Li - Redistributions of source code must retain the above copyright
11*a58d3d2aSXin Li notice, this list of conditions and the following disclaimer.
12*a58d3d2aSXin Li
13*a58d3d2aSXin Li - Redistributions in binary form must reproduce the above copyright
14*a58d3d2aSXin Li notice, this list of conditions and the following disclaimer in the
15*a58d3d2aSXin Li documentation and/or other materials provided with the distribution.
16*a58d3d2aSXin Li
17*a58d3d2aSXin Li THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
18*a58d3d2aSXin Li ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
19*a58d3d2aSXin Li LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
20*a58d3d2aSXin Li A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER
21*a58d3d2aSXin Li OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
22*a58d3d2aSXin Li EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
23*a58d3d2aSXin Li PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
24*a58d3d2aSXin Li PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
25*a58d3d2aSXin Li LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
26*a58d3d2aSXin Li NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
27*a58d3d2aSXin Li SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28*a58d3d2aSXin Li */
29*a58d3d2aSXin Li
30*a58d3d2aSXin Li #ifdef HAVE_CONFIG_H
31*a58d3d2aSXin Li #include "config.h"
32*a58d3d2aSXin Li #endif
33*a58d3d2aSXin Li
34*a58d3d2aSXin Li #define CELT_ENCODER_C
35*a58d3d2aSXin Li
36*a58d3d2aSXin Li #include "cpu_support.h"
37*a58d3d2aSXin Li #include "os_support.h"
38*a58d3d2aSXin Li #include "mdct.h"
39*a58d3d2aSXin Li #include <math.h>
40*a58d3d2aSXin Li #include "celt.h"
41*a58d3d2aSXin Li #include "pitch.h"
42*a58d3d2aSXin Li #include "bands.h"
43*a58d3d2aSXin Li #include "modes.h"
44*a58d3d2aSXin Li #include "entcode.h"
45*a58d3d2aSXin Li #include "quant_bands.h"
46*a58d3d2aSXin Li #include "rate.h"
47*a58d3d2aSXin Li #include "stack_alloc.h"
48*a58d3d2aSXin Li #include "mathops.h"
49*a58d3d2aSXin Li #include "float_cast.h"
50*a58d3d2aSXin Li #include <stdarg.h>
51*a58d3d2aSXin Li #include "celt_lpc.h"
52*a58d3d2aSXin Li #include "vq.h"
53*a58d3d2aSXin Li
54*a58d3d2aSXin Li
55*a58d3d2aSXin Li /** Encoder state
56*a58d3d2aSXin Li @brief Encoder state
57*a58d3d2aSXin Li */
58*a58d3d2aSXin Li struct OpusCustomEncoder {
59*a58d3d2aSXin Li const OpusCustomMode *mode; /**< Mode used by the encoder */
60*a58d3d2aSXin Li int channels;
61*a58d3d2aSXin Li int stream_channels;
62*a58d3d2aSXin Li
63*a58d3d2aSXin Li int force_intra;
64*a58d3d2aSXin Li int clip;
65*a58d3d2aSXin Li int disable_pf;
66*a58d3d2aSXin Li int complexity;
67*a58d3d2aSXin Li int upsample;
68*a58d3d2aSXin Li int start, end;
69*a58d3d2aSXin Li
70*a58d3d2aSXin Li opus_int32 bitrate;
71*a58d3d2aSXin Li int vbr;
72*a58d3d2aSXin Li int signalling;
73*a58d3d2aSXin Li int constrained_vbr; /* If zero, VBR can do whatever it likes with the rate */
74*a58d3d2aSXin Li int loss_rate;
75*a58d3d2aSXin Li int lsb_depth;
76*a58d3d2aSXin Li int lfe;
77*a58d3d2aSXin Li int disable_inv;
78*a58d3d2aSXin Li int arch;
79*a58d3d2aSXin Li
80*a58d3d2aSXin Li /* Everything beyond this point gets cleared on a reset */
81*a58d3d2aSXin Li #define ENCODER_RESET_START rng
82*a58d3d2aSXin Li
83*a58d3d2aSXin Li opus_uint32 rng;
84*a58d3d2aSXin Li int spread_decision;
85*a58d3d2aSXin Li opus_val32 delayedIntra;
86*a58d3d2aSXin Li int tonal_average;
87*a58d3d2aSXin Li int lastCodedBands;
88*a58d3d2aSXin Li int hf_average;
89*a58d3d2aSXin Li int tapset_decision;
90*a58d3d2aSXin Li
91*a58d3d2aSXin Li int prefilter_period;
92*a58d3d2aSXin Li opus_val16 prefilter_gain;
93*a58d3d2aSXin Li int prefilter_tapset;
94*a58d3d2aSXin Li #ifdef RESYNTH
95*a58d3d2aSXin Li int prefilter_period_old;
96*a58d3d2aSXin Li opus_val16 prefilter_gain_old;
97*a58d3d2aSXin Li int prefilter_tapset_old;
98*a58d3d2aSXin Li #endif
99*a58d3d2aSXin Li int consec_transient;
100*a58d3d2aSXin Li AnalysisInfo analysis;
101*a58d3d2aSXin Li SILKInfo silk_info;
102*a58d3d2aSXin Li
103*a58d3d2aSXin Li opus_val32 preemph_memE[2];
104*a58d3d2aSXin Li opus_val32 preemph_memD[2];
105*a58d3d2aSXin Li
106*a58d3d2aSXin Li /* VBR-related parameters */
107*a58d3d2aSXin Li opus_int32 vbr_reservoir;
108*a58d3d2aSXin Li opus_int32 vbr_drift;
109*a58d3d2aSXin Li opus_int32 vbr_offset;
110*a58d3d2aSXin Li opus_int32 vbr_count;
111*a58d3d2aSXin Li opus_val32 overlap_max;
112*a58d3d2aSXin Li opus_val16 stereo_saving;
113*a58d3d2aSXin Li int intensity;
114*a58d3d2aSXin Li opus_val16 *energy_mask;
115*a58d3d2aSXin Li opus_val16 spec_avg;
116*a58d3d2aSXin Li
117*a58d3d2aSXin Li #ifdef RESYNTH
118*a58d3d2aSXin Li /* +MAX_PERIOD/2 to make space for overlap */
119*a58d3d2aSXin Li celt_sig syn_mem[2][2*MAX_PERIOD+MAX_PERIOD/2];
120*a58d3d2aSXin Li #endif
121*a58d3d2aSXin Li
122*a58d3d2aSXin Li celt_sig in_mem[1]; /* Size = channels*mode->overlap */
123*a58d3d2aSXin Li /* celt_sig prefilter_mem[], Size = channels*COMBFILTER_MAXPERIOD */
124*a58d3d2aSXin Li /* opus_val16 oldBandE[], Size = channels*mode->nbEBands */
125*a58d3d2aSXin Li /* opus_val16 oldLogE[], Size = channels*mode->nbEBands */
126*a58d3d2aSXin Li /* opus_val16 oldLogE2[], Size = channels*mode->nbEBands */
127*a58d3d2aSXin Li /* opus_val16 energyError[], Size = channels*mode->nbEBands */
128*a58d3d2aSXin Li };
129*a58d3d2aSXin Li
celt_encoder_get_size(int channels)130*a58d3d2aSXin Li int celt_encoder_get_size(int channels)
131*a58d3d2aSXin Li {
132*a58d3d2aSXin Li CELTMode *mode = opus_custom_mode_create(48000, 960, NULL);
133*a58d3d2aSXin Li return opus_custom_encoder_get_size(mode, channels);
134*a58d3d2aSXin Li }
135*a58d3d2aSXin Li
opus_custom_encoder_get_size(const CELTMode * mode,int channels)136*a58d3d2aSXin Li OPUS_CUSTOM_NOSTATIC int opus_custom_encoder_get_size(const CELTMode *mode, int channels)
137*a58d3d2aSXin Li {
138*a58d3d2aSXin Li int size = sizeof(struct CELTEncoder)
139*a58d3d2aSXin Li + (channels*mode->overlap-1)*sizeof(celt_sig) /* celt_sig in_mem[channels*mode->overlap]; */
140*a58d3d2aSXin Li + channels*COMBFILTER_MAXPERIOD*sizeof(celt_sig) /* celt_sig prefilter_mem[channels*COMBFILTER_MAXPERIOD]; */
141*a58d3d2aSXin Li + 4*channels*mode->nbEBands*sizeof(opus_val16); /* opus_val16 oldBandE[channels*mode->nbEBands]; */
142*a58d3d2aSXin Li /* opus_val16 oldLogE[channels*mode->nbEBands]; */
143*a58d3d2aSXin Li /* opus_val16 oldLogE2[channels*mode->nbEBands]; */
144*a58d3d2aSXin Li /* opus_val16 energyError[channels*mode->nbEBands]; */
145*a58d3d2aSXin Li return size;
146*a58d3d2aSXin Li }
147*a58d3d2aSXin Li
148*a58d3d2aSXin Li #ifdef CUSTOM_MODES
opus_custom_encoder_create(const CELTMode * mode,int channels,int * error)149*a58d3d2aSXin Li CELTEncoder *opus_custom_encoder_create(const CELTMode *mode, int channels, int *error)
150*a58d3d2aSXin Li {
151*a58d3d2aSXin Li int ret;
152*a58d3d2aSXin Li CELTEncoder *st = (CELTEncoder *)opus_alloc(opus_custom_encoder_get_size(mode, channels));
153*a58d3d2aSXin Li /* init will handle the NULL case */
154*a58d3d2aSXin Li ret = opus_custom_encoder_init(st, mode, channels);
155*a58d3d2aSXin Li if (ret != OPUS_OK)
156*a58d3d2aSXin Li {
157*a58d3d2aSXin Li opus_custom_encoder_destroy(st);
158*a58d3d2aSXin Li st = NULL;
159*a58d3d2aSXin Li }
160*a58d3d2aSXin Li if (error)
161*a58d3d2aSXin Li *error = ret;
162*a58d3d2aSXin Li return st;
163*a58d3d2aSXin Li }
164*a58d3d2aSXin Li #endif /* CUSTOM_MODES */
165*a58d3d2aSXin Li
opus_custom_encoder_init_arch(CELTEncoder * st,const CELTMode * mode,int channels,int arch)166*a58d3d2aSXin Li static int opus_custom_encoder_init_arch(CELTEncoder *st, const CELTMode *mode,
167*a58d3d2aSXin Li int channels, int arch)
168*a58d3d2aSXin Li {
169*a58d3d2aSXin Li if (channels < 0 || channels > 2)
170*a58d3d2aSXin Li return OPUS_BAD_ARG;
171*a58d3d2aSXin Li
172*a58d3d2aSXin Li if (st==NULL || mode==NULL)
173*a58d3d2aSXin Li return OPUS_ALLOC_FAIL;
174*a58d3d2aSXin Li
175*a58d3d2aSXin Li OPUS_CLEAR((char*)st, opus_custom_encoder_get_size(mode, channels));
176*a58d3d2aSXin Li
177*a58d3d2aSXin Li st->mode = mode;
178*a58d3d2aSXin Li st->stream_channels = st->channels = channels;
179*a58d3d2aSXin Li
180*a58d3d2aSXin Li st->upsample = 1;
181*a58d3d2aSXin Li st->start = 0;
182*a58d3d2aSXin Li st->end = st->mode->effEBands;
183*a58d3d2aSXin Li st->signalling = 1;
184*a58d3d2aSXin Li st->arch = arch;
185*a58d3d2aSXin Li
186*a58d3d2aSXin Li st->constrained_vbr = 1;
187*a58d3d2aSXin Li st->clip = 1;
188*a58d3d2aSXin Li
189*a58d3d2aSXin Li st->bitrate = OPUS_BITRATE_MAX;
190*a58d3d2aSXin Li st->vbr = 0;
191*a58d3d2aSXin Li st->force_intra = 0;
192*a58d3d2aSXin Li st->complexity = 5;
193*a58d3d2aSXin Li st->lsb_depth=24;
194*a58d3d2aSXin Li
195*a58d3d2aSXin Li opus_custom_encoder_ctl(st, OPUS_RESET_STATE);
196*a58d3d2aSXin Li
197*a58d3d2aSXin Li return OPUS_OK;
198*a58d3d2aSXin Li }
199*a58d3d2aSXin Li
200*a58d3d2aSXin Li #ifdef CUSTOM_MODES
opus_custom_encoder_init(CELTEncoder * st,const CELTMode * mode,int channels)201*a58d3d2aSXin Li int opus_custom_encoder_init(CELTEncoder *st, const CELTMode *mode, int channels)
202*a58d3d2aSXin Li {
203*a58d3d2aSXin Li return opus_custom_encoder_init_arch(st, mode, channels, opus_select_arch());
204*a58d3d2aSXin Li }
205*a58d3d2aSXin Li #endif
206*a58d3d2aSXin Li
celt_encoder_init(CELTEncoder * st,opus_int32 sampling_rate,int channels,int arch)207*a58d3d2aSXin Li int celt_encoder_init(CELTEncoder *st, opus_int32 sampling_rate, int channels,
208*a58d3d2aSXin Li int arch)
209*a58d3d2aSXin Li {
210*a58d3d2aSXin Li int ret;
211*a58d3d2aSXin Li ret = opus_custom_encoder_init_arch(st,
212*a58d3d2aSXin Li opus_custom_mode_create(48000, 960, NULL), channels, arch);
213*a58d3d2aSXin Li if (ret != OPUS_OK)
214*a58d3d2aSXin Li return ret;
215*a58d3d2aSXin Li st->upsample = resampling_factor(sampling_rate);
216*a58d3d2aSXin Li return OPUS_OK;
217*a58d3d2aSXin Li }
218*a58d3d2aSXin Li
219*a58d3d2aSXin Li #ifdef CUSTOM_MODES
opus_custom_encoder_destroy(CELTEncoder * st)220*a58d3d2aSXin Li void opus_custom_encoder_destroy(CELTEncoder *st)
221*a58d3d2aSXin Li {
222*a58d3d2aSXin Li opus_free(st);
223*a58d3d2aSXin Li }
224*a58d3d2aSXin Li #endif /* CUSTOM_MODES */
225*a58d3d2aSXin Li
226*a58d3d2aSXin Li
transient_analysis(const opus_val32 * OPUS_RESTRICT in,int len,int C,opus_val16 * tf_estimate,int * tf_chan,int allow_weak_transients,int * weak_transient)227*a58d3d2aSXin Li static int transient_analysis(const opus_val32 * OPUS_RESTRICT in, int len, int C,
228*a58d3d2aSXin Li opus_val16 *tf_estimate, int *tf_chan, int allow_weak_transients,
229*a58d3d2aSXin Li int *weak_transient)
230*a58d3d2aSXin Li {
231*a58d3d2aSXin Li int i;
232*a58d3d2aSXin Li VARDECL(opus_val16, tmp);
233*a58d3d2aSXin Li opus_val32 mem0,mem1;
234*a58d3d2aSXin Li int is_transient = 0;
235*a58d3d2aSXin Li opus_int32 mask_metric = 0;
236*a58d3d2aSXin Li int c;
237*a58d3d2aSXin Li opus_val16 tf_max;
238*a58d3d2aSXin Li int len2;
239*a58d3d2aSXin Li /* Forward masking: 6.7 dB/ms. */
240*a58d3d2aSXin Li #ifdef FIXED_POINT
241*a58d3d2aSXin Li int forward_shift = 4;
242*a58d3d2aSXin Li #else
243*a58d3d2aSXin Li opus_val16 forward_decay = QCONST16(.0625f,15);
244*a58d3d2aSXin Li #endif
245*a58d3d2aSXin Li /* Table of 6*64/x, trained on real data to minimize the average error */
246*a58d3d2aSXin Li static const unsigned char inv_table[128] = {
247*a58d3d2aSXin Li 255,255,156,110, 86, 70, 59, 51, 45, 40, 37, 33, 31, 28, 26, 25,
248*a58d3d2aSXin Li 23, 22, 21, 20, 19, 18, 17, 16, 16, 15, 15, 14, 13, 13, 12, 12,
249*a58d3d2aSXin Li 12, 12, 11, 11, 11, 10, 10, 10, 9, 9, 9, 9, 9, 9, 8, 8,
250*a58d3d2aSXin Li 8, 8, 8, 7, 7, 7, 7, 7, 7, 6, 6, 6, 6, 6, 6, 6,
251*a58d3d2aSXin Li 6, 6, 6, 6, 6, 6, 6, 6, 6, 5, 5, 5, 5, 5, 5, 5,
252*a58d3d2aSXin Li 5, 5, 5, 5, 5, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
253*a58d3d2aSXin Li 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 3, 3,
254*a58d3d2aSXin Li 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 2,
255*a58d3d2aSXin Li };
256*a58d3d2aSXin Li SAVE_STACK;
257*a58d3d2aSXin Li ALLOC(tmp, len, opus_val16);
258*a58d3d2aSXin Li
259*a58d3d2aSXin Li *weak_transient = 0;
260*a58d3d2aSXin Li /* For lower bitrates, let's be more conservative and have a forward masking
261*a58d3d2aSXin Li decay of 3.3 dB/ms. This avoids having to code transients at very low
262*a58d3d2aSXin Li bitrate (mostly for hybrid), which can result in unstable energy and/or
263*a58d3d2aSXin Li partial collapse. */
264*a58d3d2aSXin Li if (allow_weak_transients)
265*a58d3d2aSXin Li {
266*a58d3d2aSXin Li #ifdef FIXED_POINT
267*a58d3d2aSXin Li forward_shift = 5;
268*a58d3d2aSXin Li #else
269*a58d3d2aSXin Li forward_decay = QCONST16(.03125f,15);
270*a58d3d2aSXin Li #endif
271*a58d3d2aSXin Li }
272*a58d3d2aSXin Li len2=len/2;
273*a58d3d2aSXin Li for (c=0;c<C;c++)
274*a58d3d2aSXin Li {
275*a58d3d2aSXin Li opus_val32 mean;
276*a58d3d2aSXin Li opus_int32 unmask=0;
277*a58d3d2aSXin Li opus_val32 norm;
278*a58d3d2aSXin Li opus_val16 maxE;
279*a58d3d2aSXin Li mem0=0;
280*a58d3d2aSXin Li mem1=0;
281*a58d3d2aSXin Li /* High-pass filter: (1 - 2*z^-1 + z^-2) / (1 - z^-1 + .5*z^-2) */
282*a58d3d2aSXin Li for (i=0;i<len;i++)
283*a58d3d2aSXin Li {
284*a58d3d2aSXin Li #ifndef FIXED_POINT
285*a58d3d2aSXin Li float mem00;
286*a58d3d2aSXin Li #endif
287*a58d3d2aSXin Li opus_val32 x,y;
288*a58d3d2aSXin Li x = SHR32(in[i+c*len],SIG_SHIFT);
289*a58d3d2aSXin Li y = ADD32(mem0, x);
290*a58d3d2aSXin Li #ifdef FIXED_POINT
291*a58d3d2aSXin Li mem0 = mem1 + y - SHL32(x,1);
292*a58d3d2aSXin Li mem1 = x - SHR32(y,1);
293*a58d3d2aSXin Li #else
294*a58d3d2aSXin Li /* Original code:
295*a58d3d2aSXin Li mem0 = mem1 + y - 2*x;
296*a58d3d2aSXin Li mem1 = x - .5f*y;
297*a58d3d2aSXin Li Modified code to shorten dependency chains: */
298*a58d3d2aSXin Li mem00=mem0;
299*a58d3d2aSXin Li mem0 = mem0 - x + .5f*mem1;
300*a58d3d2aSXin Li mem1 = x - mem00;
301*a58d3d2aSXin Li #endif
302*a58d3d2aSXin Li tmp[i] = SROUND16(y, 2);
303*a58d3d2aSXin Li /*printf("%f ", tmp[i]);*/
304*a58d3d2aSXin Li }
305*a58d3d2aSXin Li /*printf("\n");*/
306*a58d3d2aSXin Li /* First few samples are bad because we don't propagate the memory */
307*a58d3d2aSXin Li OPUS_CLEAR(tmp, 12);
308*a58d3d2aSXin Li
309*a58d3d2aSXin Li #ifdef FIXED_POINT
310*a58d3d2aSXin Li /* Normalize tmp to max range */
311*a58d3d2aSXin Li {
312*a58d3d2aSXin Li int shift=0;
313*a58d3d2aSXin Li shift = 14-celt_ilog2(MAX16(1, celt_maxabs16(tmp, len)));
314*a58d3d2aSXin Li if (shift!=0)
315*a58d3d2aSXin Li {
316*a58d3d2aSXin Li for (i=0;i<len;i++)
317*a58d3d2aSXin Li tmp[i] = SHL16(tmp[i], shift);
318*a58d3d2aSXin Li }
319*a58d3d2aSXin Li }
320*a58d3d2aSXin Li #endif
321*a58d3d2aSXin Li
322*a58d3d2aSXin Li mean=0;
323*a58d3d2aSXin Li mem0=0;
324*a58d3d2aSXin Li /* Grouping by two to reduce complexity */
325*a58d3d2aSXin Li /* Forward pass to compute the post-echo threshold*/
326*a58d3d2aSXin Li for (i=0;i<len2;i++)
327*a58d3d2aSXin Li {
328*a58d3d2aSXin Li opus_val16 x2 = PSHR32(MULT16_16(tmp[2*i],tmp[2*i]) + MULT16_16(tmp[2*i+1],tmp[2*i+1]),16);
329*a58d3d2aSXin Li mean += x2;
330*a58d3d2aSXin Li #ifdef FIXED_POINT
331*a58d3d2aSXin Li /* FIXME: Use PSHR16() instead */
332*a58d3d2aSXin Li tmp[i] = mem0 + PSHR32(x2-mem0,forward_shift);
333*a58d3d2aSXin Li mem0 = tmp[i];
334*a58d3d2aSXin Li #else
335*a58d3d2aSXin Li mem0 = x2 + (1.f-forward_decay)*mem0;
336*a58d3d2aSXin Li tmp[i] = forward_decay*mem0;
337*a58d3d2aSXin Li #endif
338*a58d3d2aSXin Li }
339*a58d3d2aSXin Li
340*a58d3d2aSXin Li mem0=0;
341*a58d3d2aSXin Li maxE=0;
342*a58d3d2aSXin Li /* Backward pass to compute the pre-echo threshold */
343*a58d3d2aSXin Li for (i=len2-1;i>=0;i--)
344*a58d3d2aSXin Li {
345*a58d3d2aSXin Li /* Backward masking: 13.9 dB/ms. */
346*a58d3d2aSXin Li #ifdef FIXED_POINT
347*a58d3d2aSXin Li /* FIXME: Use PSHR16() instead */
348*a58d3d2aSXin Li tmp[i] = mem0 + PSHR32(tmp[i]-mem0,3);
349*a58d3d2aSXin Li mem0 = tmp[i];
350*a58d3d2aSXin Li maxE = MAX16(maxE, mem0);
351*a58d3d2aSXin Li #else
352*a58d3d2aSXin Li mem0 = tmp[i] + 0.875f*mem0;
353*a58d3d2aSXin Li tmp[i] = 0.125f*mem0;
354*a58d3d2aSXin Li maxE = MAX16(maxE, 0.125f*mem0);
355*a58d3d2aSXin Li #endif
356*a58d3d2aSXin Li }
357*a58d3d2aSXin Li /*for (i=0;i<len2;i++)printf("%f ", tmp[i]/mean);printf("\n");*/
358*a58d3d2aSXin Li
359*a58d3d2aSXin Li /* Compute the ratio of the "frame energy" over the harmonic mean of the energy.
360*a58d3d2aSXin Li This essentially corresponds to a bitrate-normalized temporal noise-to-mask
361*a58d3d2aSXin Li ratio */
362*a58d3d2aSXin Li
363*a58d3d2aSXin Li /* As a compromise with the old transient detector, frame energy is the
364*a58d3d2aSXin Li geometric mean of the energy and half the max */
365*a58d3d2aSXin Li #ifdef FIXED_POINT
366*a58d3d2aSXin Li /* Costs two sqrt() to avoid overflows */
367*a58d3d2aSXin Li mean = MULT16_16(celt_sqrt(mean), celt_sqrt(MULT16_16(maxE,len2>>1)));
368*a58d3d2aSXin Li #else
369*a58d3d2aSXin Li mean = celt_sqrt(mean * maxE*.5*len2);
370*a58d3d2aSXin Li #endif
371*a58d3d2aSXin Li /* Inverse of the mean energy in Q15+6 */
372*a58d3d2aSXin Li norm = SHL32(EXTEND32(len2),6+14)/ADD32(EPSILON,SHR32(mean,1));
373*a58d3d2aSXin Li /* Compute harmonic mean discarding the unreliable boundaries
374*a58d3d2aSXin Li The data is smooth, so we only take 1/4th of the samples */
375*a58d3d2aSXin Li unmask=0;
376*a58d3d2aSXin Li /* We should never see NaNs here. If we find any, then something really bad happened and we better abort
377*a58d3d2aSXin Li before it does any damage later on. If these asserts are disabled (no hardening), then the table
378*a58d3d2aSXin Li lookup a few lines below (id = ...) is likely to crash dur to an out-of-bounds read. DO NOT FIX
379*a58d3d2aSXin Li that crash on NaN since it could result in a worse issue later on. */
380*a58d3d2aSXin Li celt_assert(!celt_isnan(tmp[0]));
381*a58d3d2aSXin Li celt_assert(!celt_isnan(norm));
382*a58d3d2aSXin Li for (i=12;i<len2-5;i+=4)
383*a58d3d2aSXin Li {
384*a58d3d2aSXin Li int id;
385*a58d3d2aSXin Li #ifdef FIXED_POINT
386*a58d3d2aSXin Li id = MAX32(0,MIN32(127,MULT16_32_Q15(tmp[i]+EPSILON,norm))); /* Do not round to nearest */
387*a58d3d2aSXin Li #else
388*a58d3d2aSXin Li id = (int)MAX32(0,MIN32(127,floor(64*norm*(tmp[i]+EPSILON)))); /* Do not round to nearest */
389*a58d3d2aSXin Li #endif
390*a58d3d2aSXin Li unmask += inv_table[id];
391*a58d3d2aSXin Li }
392*a58d3d2aSXin Li /*printf("%d\n", unmask);*/
393*a58d3d2aSXin Li /* Normalize, compensate for the 1/4th of the sample and the factor of 6 in the inverse table */
394*a58d3d2aSXin Li unmask = 64*unmask*4/(6*(len2-17));
395*a58d3d2aSXin Li if (unmask>mask_metric)
396*a58d3d2aSXin Li {
397*a58d3d2aSXin Li *tf_chan = c;
398*a58d3d2aSXin Li mask_metric = unmask;
399*a58d3d2aSXin Li }
400*a58d3d2aSXin Li }
401*a58d3d2aSXin Li is_transient = mask_metric>200;
402*a58d3d2aSXin Li /* For low bitrates, define "weak transients" that need to be
403*a58d3d2aSXin Li handled differently to avoid partial collapse. */
404*a58d3d2aSXin Li if (allow_weak_transients && is_transient && mask_metric<600) {
405*a58d3d2aSXin Li is_transient = 0;
406*a58d3d2aSXin Li *weak_transient = 1;
407*a58d3d2aSXin Li }
408*a58d3d2aSXin Li /* Arbitrary metric for VBR boost */
409*a58d3d2aSXin Li tf_max = MAX16(0,celt_sqrt(27*mask_metric)-42);
410*a58d3d2aSXin Li /* *tf_estimate = 1 + MIN16(1, sqrt(MAX16(0, tf_max-30))/20); */
411*a58d3d2aSXin Li *tf_estimate = celt_sqrt(MAX32(0, SHL32(MULT16_16(QCONST16(0.0069,14),MIN16(163,tf_max)),14)-QCONST32(0.139,28)));
412*a58d3d2aSXin Li /*printf("%d %f\n", tf_max, mask_metric);*/
413*a58d3d2aSXin Li RESTORE_STACK;
414*a58d3d2aSXin Li #ifdef FUZZING
415*a58d3d2aSXin Li is_transient = rand()&0x1;
416*a58d3d2aSXin Li #endif
417*a58d3d2aSXin Li /*printf("%d %f %d\n", is_transient, (float)*tf_estimate, tf_max);*/
418*a58d3d2aSXin Li return is_transient;
419*a58d3d2aSXin Li }
420*a58d3d2aSXin Li
421*a58d3d2aSXin Li /* Looks for sudden increases of energy to decide whether we need to patch
422*a58d3d2aSXin Li the transient decision */
patch_transient_decision(opus_val16 * newE,opus_val16 * oldE,int nbEBands,int start,int end,int C)423*a58d3d2aSXin Li static int patch_transient_decision(opus_val16 *newE, opus_val16 *oldE, int nbEBands,
424*a58d3d2aSXin Li int start, int end, int C)
425*a58d3d2aSXin Li {
426*a58d3d2aSXin Li int i, c;
427*a58d3d2aSXin Li opus_val32 mean_diff=0;
428*a58d3d2aSXin Li opus_val16 spread_old[26];
429*a58d3d2aSXin Li /* Apply an aggressive (-6 dB/Bark) spreading function to the old frame to
430*a58d3d2aSXin Li avoid false detection caused by irrelevant bands */
431*a58d3d2aSXin Li if (C==1)
432*a58d3d2aSXin Li {
433*a58d3d2aSXin Li spread_old[start] = oldE[start];
434*a58d3d2aSXin Li for (i=start+1;i<end;i++)
435*a58d3d2aSXin Li spread_old[i] = MAX16(spread_old[i-1]-QCONST16(1.0f, DB_SHIFT), oldE[i]);
436*a58d3d2aSXin Li } else {
437*a58d3d2aSXin Li spread_old[start] = MAX16(oldE[start],oldE[start+nbEBands]);
438*a58d3d2aSXin Li for (i=start+1;i<end;i++)
439*a58d3d2aSXin Li spread_old[i] = MAX16(spread_old[i-1]-QCONST16(1.0f, DB_SHIFT),
440*a58d3d2aSXin Li MAX16(oldE[i],oldE[i+nbEBands]));
441*a58d3d2aSXin Li }
442*a58d3d2aSXin Li for (i=end-2;i>=start;i--)
443*a58d3d2aSXin Li spread_old[i] = MAX16(spread_old[i], spread_old[i+1]-QCONST16(1.0f, DB_SHIFT));
444*a58d3d2aSXin Li /* Compute mean increase */
445*a58d3d2aSXin Li c=0; do {
446*a58d3d2aSXin Li for (i=IMAX(2,start);i<end-1;i++)
447*a58d3d2aSXin Li {
448*a58d3d2aSXin Li opus_val16 x1, x2;
449*a58d3d2aSXin Li x1 = MAX16(0, newE[i + c*nbEBands]);
450*a58d3d2aSXin Li x2 = MAX16(0, spread_old[i]);
451*a58d3d2aSXin Li mean_diff = ADD32(mean_diff, EXTEND32(MAX16(0, SUB16(x1, x2))));
452*a58d3d2aSXin Li }
453*a58d3d2aSXin Li } while (++c<C);
454*a58d3d2aSXin Li mean_diff = DIV32(mean_diff, C*(end-1-IMAX(2,start)));
455*a58d3d2aSXin Li /*printf("%f %f %d\n", mean_diff, max_diff, count);*/
456*a58d3d2aSXin Li return mean_diff > QCONST16(1.f, DB_SHIFT);
457*a58d3d2aSXin Li }
458*a58d3d2aSXin Li
459*a58d3d2aSXin Li /** Apply window and compute the MDCT for all sub-frames and
460*a58d3d2aSXin Li all channels in a frame */
compute_mdcts(const CELTMode * mode,int shortBlocks,celt_sig * OPUS_RESTRICT in,celt_sig * OPUS_RESTRICT out,int C,int CC,int LM,int upsample,int arch)461*a58d3d2aSXin Li static void compute_mdcts(const CELTMode *mode, int shortBlocks, celt_sig * OPUS_RESTRICT in,
462*a58d3d2aSXin Li celt_sig * OPUS_RESTRICT out, int C, int CC, int LM, int upsample,
463*a58d3d2aSXin Li int arch)
464*a58d3d2aSXin Li {
465*a58d3d2aSXin Li const int overlap = mode->overlap;
466*a58d3d2aSXin Li int N;
467*a58d3d2aSXin Li int B;
468*a58d3d2aSXin Li int shift;
469*a58d3d2aSXin Li int i, b, c;
470*a58d3d2aSXin Li if (shortBlocks)
471*a58d3d2aSXin Li {
472*a58d3d2aSXin Li B = shortBlocks;
473*a58d3d2aSXin Li N = mode->shortMdctSize;
474*a58d3d2aSXin Li shift = mode->maxLM;
475*a58d3d2aSXin Li } else {
476*a58d3d2aSXin Li B = 1;
477*a58d3d2aSXin Li N = mode->shortMdctSize<<LM;
478*a58d3d2aSXin Li shift = mode->maxLM-LM;
479*a58d3d2aSXin Li }
480*a58d3d2aSXin Li c=0; do {
481*a58d3d2aSXin Li for (b=0;b<B;b++)
482*a58d3d2aSXin Li {
483*a58d3d2aSXin Li /* Interleaving the sub-frames while doing the MDCTs */
484*a58d3d2aSXin Li clt_mdct_forward(&mode->mdct, in+c*(B*N+overlap)+b*N,
485*a58d3d2aSXin Li &out[b+c*N*B], mode->window, overlap, shift, B,
486*a58d3d2aSXin Li arch);
487*a58d3d2aSXin Li }
488*a58d3d2aSXin Li } while (++c<CC);
489*a58d3d2aSXin Li if (CC==2&&C==1)
490*a58d3d2aSXin Li {
491*a58d3d2aSXin Li for (i=0;i<B*N;i++)
492*a58d3d2aSXin Li out[i] = ADD32(HALF32(out[i]), HALF32(out[B*N+i]));
493*a58d3d2aSXin Li }
494*a58d3d2aSXin Li if (upsample != 1)
495*a58d3d2aSXin Li {
496*a58d3d2aSXin Li c=0; do
497*a58d3d2aSXin Li {
498*a58d3d2aSXin Li int bound = B*N/upsample;
499*a58d3d2aSXin Li for (i=0;i<bound;i++)
500*a58d3d2aSXin Li out[c*B*N+i] *= upsample;
501*a58d3d2aSXin Li OPUS_CLEAR(&out[c*B*N+bound], B*N-bound);
502*a58d3d2aSXin Li } while (++c<C);
503*a58d3d2aSXin Li }
504*a58d3d2aSXin Li }
505*a58d3d2aSXin Li
506*a58d3d2aSXin Li
celt_preemphasis(const opus_val16 * OPUS_RESTRICT pcmp,celt_sig * OPUS_RESTRICT inp,int N,int CC,int upsample,const opus_val16 * coef,celt_sig * mem,int clip)507*a58d3d2aSXin Li void celt_preemphasis(const opus_val16 * OPUS_RESTRICT pcmp, celt_sig * OPUS_RESTRICT inp,
508*a58d3d2aSXin Li int N, int CC, int upsample, const opus_val16 *coef, celt_sig *mem, int clip)
509*a58d3d2aSXin Li {
510*a58d3d2aSXin Li int i;
511*a58d3d2aSXin Li opus_val16 coef0;
512*a58d3d2aSXin Li celt_sig m;
513*a58d3d2aSXin Li int Nu;
514*a58d3d2aSXin Li
515*a58d3d2aSXin Li coef0 = coef[0];
516*a58d3d2aSXin Li m = *mem;
517*a58d3d2aSXin Li
518*a58d3d2aSXin Li /* Fast path for the normal 48kHz case and no clipping */
519*a58d3d2aSXin Li if (coef[1] == 0 && upsample == 1 && !clip)
520*a58d3d2aSXin Li {
521*a58d3d2aSXin Li for (i=0;i<N;i++)
522*a58d3d2aSXin Li {
523*a58d3d2aSXin Li opus_val16 x;
524*a58d3d2aSXin Li x = SCALEIN(pcmp[CC*i]);
525*a58d3d2aSXin Li /* Apply pre-emphasis */
526*a58d3d2aSXin Li inp[i] = SHL32(x, SIG_SHIFT) - m;
527*a58d3d2aSXin Li m = SHR32(MULT16_16(coef0, x), 15-SIG_SHIFT);
528*a58d3d2aSXin Li }
529*a58d3d2aSXin Li *mem = m;
530*a58d3d2aSXin Li return;
531*a58d3d2aSXin Li }
532*a58d3d2aSXin Li
533*a58d3d2aSXin Li Nu = N/upsample;
534*a58d3d2aSXin Li if (upsample!=1)
535*a58d3d2aSXin Li {
536*a58d3d2aSXin Li OPUS_CLEAR(inp, N);
537*a58d3d2aSXin Li }
538*a58d3d2aSXin Li for (i=0;i<Nu;i++)
539*a58d3d2aSXin Li inp[i*upsample] = SCALEIN(pcmp[CC*i]);
540*a58d3d2aSXin Li
541*a58d3d2aSXin Li #ifndef FIXED_POINT
542*a58d3d2aSXin Li if (clip)
543*a58d3d2aSXin Li {
544*a58d3d2aSXin Li /* Clip input to avoid encoding non-portable files */
545*a58d3d2aSXin Li for (i=0;i<Nu;i++)
546*a58d3d2aSXin Li inp[i*upsample] = MAX32(-65536.f, MIN32(65536.f,inp[i*upsample]));
547*a58d3d2aSXin Li }
548*a58d3d2aSXin Li #else
549*a58d3d2aSXin Li (void)clip; /* Avoids a warning about clip being unused. */
550*a58d3d2aSXin Li #endif
551*a58d3d2aSXin Li #ifdef CUSTOM_MODES
552*a58d3d2aSXin Li if (coef[1] != 0)
553*a58d3d2aSXin Li {
554*a58d3d2aSXin Li opus_val16 coef1 = coef[1];
555*a58d3d2aSXin Li opus_val16 coef2 = coef[2];
556*a58d3d2aSXin Li for (i=0;i<N;i++)
557*a58d3d2aSXin Li {
558*a58d3d2aSXin Li celt_sig x, tmp;
559*a58d3d2aSXin Li x = inp[i];
560*a58d3d2aSXin Li /* Apply pre-emphasis */
561*a58d3d2aSXin Li tmp = MULT16_16(coef2, x);
562*a58d3d2aSXin Li inp[i] = tmp + m;
563*a58d3d2aSXin Li m = MULT16_32_Q15(coef1, inp[i]) - MULT16_32_Q15(coef0, tmp);
564*a58d3d2aSXin Li }
565*a58d3d2aSXin Li } else
566*a58d3d2aSXin Li #endif
567*a58d3d2aSXin Li {
568*a58d3d2aSXin Li for (i=0;i<N;i++)
569*a58d3d2aSXin Li {
570*a58d3d2aSXin Li opus_val16 x;
571*a58d3d2aSXin Li x = inp[i];
572*a58d3d2aSXin Li /* Apply pre-emphasis */
573*a58d3d2aSXin Li inp[i] = SHL32(x, SIG_SHIFT) - m;
574*a58d3d2aSXin Li m = SHR32(MULT16_16(coef0, x), 15-SIG_SHIFT);
575*a58d3d2aSXin Li }
576*a58d3d2aSXin Li }
577*a58d3d2aSXin Li *mem = m;
578*a58d3d2aSXin Li }
579*a58d3d2aSXin Li
580*a58d3d2aSXin Li
581*a58d3d2aSXin Li
l1_metric(const celt_norm * tmp,int N,int LM,opus_val16 bias)582*a58d3d2aSXin Li static opus_val32 l1_metric(const celt_norm *tmp, int N, int LM, opus_val16 bias)
583*a58d3d2aSXin Li {
584*a58d3d2aSXin Li int i;
585*a58d3d2aSXin Li opus_val32 L1;
586*a58d3d2aSXin Li L1 = 0;
587*a58d3d2aSXin Li for (i=0;i<N;i++)
588*a58d3d2aSXin Li L1 += EXTEND32(ABS16(tmp[i]));
589*a58d3d2aSXin Li /* When in doubt, prefer good freq resolution */
590*a58d3d2aSXin Li L1 = MAC16_32_Q15(L1, LM*bias, L1);
591*a58d3d2aSXin Li return L1;
592*a58d3d2aSXin Li
593*a58d3d2aSXin Li }
594*a58d3d2aSXin Li
tf_analysis(const CELTMode * m,int len,int isTransient,int * tf_res,int lambda,celt_norm * X,int N0,int LM,opus_val16 tf_estimate,int tf_chan,int * importance)595*a58d3d2aSXin Li static int tf_analysis(const CELTMode *m, int len, int isTransient,
596*a58d3d2aSXin Li int *tf_res, int lambda, celt_norm *X, int N0, int LM,
597*a58d3d2aSXin Li opus_val16 tf_estimate, int tf_chan, int *importance)
598*a58d3d2aSXin Li {
599*a58d3d2aSXin Li int i;
600*a58d3d2aSXin Li VARDECL(int, metric);
601*a58d3d2aSXin Li int cost0;
602*a58d3d2aSXin Li int cost1;
603*a58d3d2aSXin Li VARDECL(int, path0);
604*a58d3d2aSXin Li VARDECL(int, path1);
605*a58d3d2aSXin Li VARDECL(celt_norm, tmp);
606*a58d3d2aSXin Li VARDECL(celt_norm, tmp_1);
607*a58d3d2aSXin Li int sel;
608*a58d3d2aSXin Li int selcost[2];
609*a58d3d2aSXin Li int tf_select=0;
610*a58d3d2aSXin Li opus_val16 bias;
611*a58d3d2aSXin Li
612*a58d3d2aSXin Li SAVE_STACK;
613*a58d3d2aSXin Li bias = MULT16_16_Q14(QCONST16(.04f,15), MAX16(-QCONST16(.25f,14), QCONST16(.5f,14)-tf_estimate));
614*a58d3d2aSXin Li /*printf("%f ", bias);*/
615*a58d3d2aSXin Li
616*a58d3d2aSXin Li ALLOC(metric, len, int);
617*a58d3d2aSXin Li ALLOC(tmp, (m->eBands[len]-m->eBands[len-1])<<LM, celt_norm);
618*a58d3d2aSXin Li ALLOC(tmp_1, (m->eBands[len]-m->eBands[len-1])<<LM, celt_norm);
619*a58d3d2aSXin Li ALLOC(path0, len, int);
620*a58d3d2aSXin Li ALLOC(path1, len, int);
621*a58d3d2aSXin Li
622*a58d3d2aSXin Li for (i=0;i<len;i++)
623*a58d3d2aSXin Li {
624*a58d3d2aSXin Li int k, N;
625*a58d3d2aSXin Li int narrow;
626*a58d3d2aSXin Li opus_val32 L1, best_L1;
627*a58d3d2aSXin Li int best_level=0;
628*a58d3d2aSXin Li N = (m->eBands[i+1]-m->eBands[i])<<LM;
629*a58d3d2aSXin Li /* band is too narrow to be split down to LM=-1 */
630*a58d3d2aSXin Li narrow = (m->eBands[i+1]-m->eBands[i])==1;
631*a58d3d2aSXin Li OPUS_COPY(tmp, &X[tf_chan*N0 + (m->eBands[i]<<LM)], N);
632*a58d3d2aSXin Li /* Just add the right channel if we're in stereo */
633*a58d3d2aSXin Li /*if (C==2)
634*a58d3d2aSXin Li for (j=0;j<N;j++)
635*a58d3d2aSXin Li tmp[j] = ADD16(SHR16(tmp[j], 1),SHR16(X[N0+j+(m->eBands[i]<<LM)], 1));*/
636*a58d3d2aSXin Li L1 = l1_metric(tmp, N, isTransient ? LM : 0, bias);
637*a58d3d2aSXin Li best_L1 = L1;
638*a58d3d2aSXin Li /* Check the -1 case for transients */
639*a58d3d2aSXin Li if (isTransient && !narrow)
640*a58d3d2aSXin Li {
641*a58d3d2aSXin Li OPUS_COPY(tmp_1, tmp, N);
642*a58d3d2aSXin Li haar1(tmp_1, N>>LM, 1<<LM);
643*a58d3d2aSXin Li L1 = l1_metric(tmp_1, N, LM+1, bias);
644*a58d3d2aSXin Li if (L1<best_L1)
645*a58d3d2aSXin Li {
646*a58d3d2aSXin Li best_L1 = L1;
647*a58d3d2aSXin Li best_level = -1;
648*a58d3d2aSXin Li }
649*a58d3d2aSXin Li }
650*a58d3d2aSXin Li /*printf ("%f ", L1);*/
651*a58d3d2aSXin Li for (k=0;k<LM+!(isTransient||narrow);k++)
652*a58d3d2aSXin Li {
653*a58d3d2aSXin Li int B;
654*a58d3d2aSXin Li
655*a58d3d2aSXin Li if (isTransient)
656*a58d3d2aSXin Li B = (LM-k-1);
657*a58d3d2aSXin Li else
658*a58d3d2aSXin Li B = k+1;
659*a58d3d2aSXin Li
660*a58d3d2aSXin Li haar1(tmp, N>>k, 1<<k);
661*a58d3d2aSXin Li
662*a58d3d2aSXin Li L1 = l1_metric(tmp, N, B, bias);
663*a58d3d2aSXin Li
664*a58d3d2aSXin Li if (L1 < best_L1)
665*a58d3d2aSXin Li {
666*a58d3d2aSXin Li best_L1 = L1;
667*a58d3d2aSXin Li best_level = k+1;
668*a58d3d2aSXin Li }
669*a58d3d2aSXin Li }
670*a58d3d2aSXin Li /*printf ("%d ", isTransient ? LM-best_level : best_level);*/
671*a58d3d2aSXin Li /* metric is in Q1 to be able to select the mid-point (-0.5) for narrower bands */
672*a58d3d2aSXin Li if (isTransient)
673*a58d3d2aSXin Li metric[i] = 2*best_level;
674*a58d3d2aSXin Li else
675*a58d3d2aSXin Li metric[i] = -2*best_level;
676*a58d3d2aSXin Li /* For bands that can't be split to -1, set the metric to the half-way point to avoid
677*a58d3d2aSXin Li biasing the decision */
678*a58d3d2aSXin Li if (narrow && (metric[i]==0 || metric[i]==-2*LM))
679*a58d3d2aSXin Li metric[i]-=1;
680*a58d3d2aSXin Li /*printf("%d ", metric[i]/2 + (!isTransient)*LM);*/
681*a58d3d2aSXin Li }
682*a58d3d2aSXin Li /*printf("\n");*/
683*a58d3d2aSXin Li /* Search for the optimal tf resolution, including tf_select */
684*a58d3d2aSXin Li tf_select = 0;
685*a58d3d2aSXin Li for (sel=0;sel<2;sel++)
686*a58d3d2aSXin Li {
687*a58d3d2aSXin Li cost0 = importance[0]*abs(metric[0]-2*tf_select_table[LM][4*isTransient+2*sel+0]);
688*a58d3d2aSXin Li cost1 = importance[0]*abs(metric[0]-2*tf_select_table[LM][4*isTransient+2*sel+1]) + (isTransient ? 0 : lambda);
689*a58d3d2aSXin Li for (i=1;i<len;i++)
690*a58d3d2aSXin Li {
691*a58d3d2aSXin Li int curr0, curr1;
692*a58d3d2aSXin Li curr0 = IMIN(cost0, cost1 + lambda);
693*a58d3d2aSXin Li curr1 = IMIN(cost0 + lambda, cost1);
694*a58d3d2aSXin Li cost0 = curr0 + importance[i]*abs(metric[i]-2*tf_select_table[LM][4*isTransient+2*sel+0]);
695*a58d3d2aSXin Li cost1 = curr1 + importance[i]*abs(metric[i]-2*tf_select_table[LM][4*isTransient+2*sel+1]);
696*a58d3d2aSXin Li }
697*a58d3d2aSXin Li cost0 = IMIN(cost0, cost1);
698*a58d3d2aSXin Li selcost[sel]=cost0;
699*a58d3d2aSXin Li }
700*a58d3d2aSXin Li /* For now, we're conservative and only allow tf_select=1 for transients.
701*a58d3d2aSXin Li * If tests confirm it's useful for non-transients, we could allow it. */
702*a58d3d2aSXin Li if (selcost[1]<selcost[0] && isTransient)
703*a58d3d2aSXin Li tf_select=1;
704*a58d3d2aSXin Li cost0 = importance[0]*abs(metric[0]-2*tf_select_table[LM][4*isTransient+2*tf_select+0]);
705*a58d3d2aSXin Li cost1 = importance[0]*abs(metric[0]-2*tf_select_table[LM][4*isTransient+2*tf_select+1]) + (isTransient ? 0 : lambda);
706*a58d3d2aSXin Li /* Viterbi forward pass */
707*a58d3d2aSXin Li for (i=1;i<len;i++)
708*a58d3d2aSXin Li {
709*a58d3d2aSXin Li int curr0, curr1;
710*a58d3d2aSXin Li int from0, from1;
711*a58d3d2aSXin Li
712*a58d3d2aSXin Li from0 = cost0;
713*a58d3d2aSXin Li from1 = cost1 + lambda;
714*a58d3d2aSXin Li if (from0 < from1)
715*a58d3d2aSXin Li {
716*a58d3d2aSXin Li curr0 = from0;
717*a58d3d2aSXin Li path0[i]= 0;
718*a58d3d2aSXin Li } else {
719*a58d3d2aSXin Li curr0 = from1;
720*a58d3d2aSXin Li path0[i]= 1;
721*a58d3d2aSXin Li }
722*a58d3d2aSXin Li
723*a58d3d2aSXin Li from0 = cost0 + lambda;
724*a58d3d2aSXin Li from1 = cost1;
725*a58d3d2aSXin Li if (from0 < from1)
726*a58d3d2aSXin Li {
727*a58d3d2aSXin Li curr1 = from0;
728*a58d3d2aSXin Li path1[i]= 0;
729*a58d3d2aSXin Li } else {
730*a58d3d2aSXin Li curr1 = from1;
731*a58d3d2aSXin Li path1[i]= 1;
732*a58d3d2aSXin Li }
733*a58d3d2aSXin Li cost0 = curr0 + importance[i]*abs(metric[i]-2*tf_select_table[LM][4*isTransient+2*tf_select+0]);
734*a58d3d2aSXin Li cost1 = curr1 + importance[i]*abs(metric[i]-2*tf_select_table[LM][4*isTransient+2*tf_select+1]);
735*a58d3d2aSXin Li }
736*a58d3d2aSXin Li tf_res[len-1] = cost0 < cost1 ? 0 : 1;
737*a58d3d2aSXin Li /* Viterbi backward pass to check the decisions */
738*a58d3d2aSXin Li for (i=len-2;i>=0;i--)
739*a58d3d2aSXin Li {
740*a58d3d2aSXin Li if (tf_res[i+1] == 1)
741*a58d3d2aSXin Li tf_res[i] = path1[i+1];
742*a58d3d2aSXin Li else
743*a58d3d2aSXin Li tf_res[i] = path0[i+1];
744*a58d3d2aSXin Li }
745*a58d3d2aSXin Li /*printf("%d %f\n", *tf_sum, tf_estimate);*/
746*a58d3d2aSXin Li RESTORE_STACK;
747*a58d3d2aSXin Li #ifdef FUZZING
748*a58d3d2aSXin Li tf_select = rand()&0x1;
749*a58d3d2aSXin Li tf_res[0] = rand()&0x1;
750*a58d3d2aSXin Li for (i=1;i<len;i++)
751*a58d3d2aSXin Li tf_res[i] = tf_res[i-1] ^ ((rand()&0xF) == 0);
752*a58d3d2aSXin Li #endif
753*a58d3d2aSXin Li return tf_select;
754*a58d3d2aSXin Li }
755*a58d3d2aSXin Li
tf_encode(int start,int end,int isTransient,int * tf_res,int LM,int tf_select,ec_enc * enc)756*a58d3d2aSXin Li static void tf_encode(int start, int end, int isTransient, int *tf_res, int LM, int tf_select, ec_enc *enc)
757*a58d3d2aSXin Li {
758*a58d3d2aSXin Li int curr, i;
759*a58d3d2aSXin Li int tf_select_rsv;
760*a58d3d2aSXin Li int tf_changed;
761*a58d3d2aSXin Li int logp;
762*a58d3d2aSXin Li opus_uint32 budget;
763*a58d3d2aSXin Li opus_uint32 tell;
764*a58d3d2aSXin Li budget = enc->storage*8;
765*a58d3d2aSXin Li tell = ec_tell(enc);
766*a58d3d2aSXin Li logp = isTransient ? 2 : 4;
767*a58d3d2aSXin Li /* Reserve space to code the tf_select decision. */
768*a58d3d2aSXin Li tf_select_rsv = LM>0 && tell+logp+1 <= budget;
769*a58d3d2aSXin Li budget -= tf_select_rsv;
770*a58d3d2aSXin Li curr = tf_changed = 0;
771*a58d3d2aSXin Li for (i=start;i<end;i++)
772*a58d3d2aSXin Li {
773*a58d3d2aSXin Li if (tell+logp<=budget)
774*a58d3d2aSXin Li {
775*a58d3d2aSXin Li ec_enc_bit_logp(enc, tf_res[i] ^ curr, logp);
776*a58d3d2aSXin Li tell = ec_tell(enc);
777*a58d3d2aSXin Li curr = tf_res[i];
778*a58d3d2aSXin Li tf_changed |= curr;
779*a58d3d2aSXin Li }
780*a58d3d2aSXin Li else
781*a58d3d2aSXin Li tf_res[i] = curr;
782*a58d3d2aSXin Li logp = isTransient ? 4 : 5;
783*a58d3d2aSXin Li }
784*a58d3d2aSXin Li /* Only code tf_select if it would actually make a difference. */
785*a58d3d2aSXin Li if (tf_select_rsv &&
786*a58d3d2aSXin Li tf_select_table[LM][4*isTransient+0+tf_changed]!=
787*a58d3d2aSXin Li tf_select_table[LM][4*isTransient+2+tf_changed])
788*a58d3d2aSXin Li ec_enc_bit_logp(enc, tf_select, 1);
789*a58d3d2aSXin Li else
790*a58d3d2aSXin Li tf_select = 0;
791*a58d3d2aSXin Li for (i=start;i<end;i++)
792*a58d3d2aSXin Li tf_res[i] = tf_select_table[LM][4*isTransient+2*tf_select+tf_res[i]];
793*a58d3d2aSXin Li /*for(i=0;i<end;i++)printf("%d ", isTransient ? tf_res[i] : LM+tf_res[i]);printf("\n");*/
794*a58d3d2aSXin Li }
795*a58d3d2aSXin Li
796*a58d3d2aSXin Li
alloc_trim_analysis(const CELTMode * m,const celt_norm * X,const opus_val16 * bandLogE,int end,int LM,int C,int N0,AnalysisInfo * analysis,opus_val16 * stereo_saving,opus_val16 tf_estimate,int intensity,opus_val16 surround_trim,opus_int32 equiv_rate,int arch)797*a58d3d2aSXin Li static int alloc_trim_analysis(const CELTMode *m, const celt_norm *X,
798*a58d3d2aSXin Li const opus_val16 *bandLogE, int end, int LM, int C, int N0,
799*a58d3d2aSXin Li AnalysisInfo *analysis, opus_val16 *stereo_saving, opus_val16 tf_estimate,
800*a58d3d2aSXin Li int intensity, opus_val16 surround_trim, opus_int32 equiv_rate, int arch)
801*a58d3d2aSXin Li {
802*a58d3d2aSXin Li int i;
803*a58d3d2aSXin Li opus_val32 diff=0;
804*a58d3d2aSXin Li int c;
805*a58d3d2aSXin Li int trim_index;
806*a58d3d2aSXin Li opus_val16 trim = QCONST16(5.f, 8);
807*a58d3d2aSXin Li opus_val16 logXC, logXC2;
808*a58d3d2aSXin Li /* At low bitrate, reducing the trim seems to help. At higher bitrates, it's less
809*a58d3d2aSXin Li clear what's best, so we're keeping it as it was before, at least for now. */
810*a58d3d2aSXin Li if (equiv_rate < 64000) {
811*a58d3d2aSXin Li trim = QCONST16(4.f, 8);
812*a58d3d2aSXin Li } else if (equiv_rate < 80000) {
813*a58d3d2aSXin Li opus_int32 frac = (equiv_rate-64000) >> 10;
814*a58d3d2aSXin Li trim = QCONST16(4.f, 8) + QCONST16(1.f/16.f, 8)*frac;
815*a58d3d2aSXin Li }
816*a58d3d2aSXin Li if (C==2)
817*a58d3d2aSXin Li {
818*a58d3d2aSXin Li opus_val16 sum = 0; /* Q10 */
819*a58d3d2aSXin Li opus_val16 minXC; /* Q10 */
820*a58d3d2aSXin Li /* Compute inter-channel correlation for low frequencies */
821*a58d3d2aSXin Li for (i=0;i<8;i++)
822*a58d3d2aSXin Li {
823*a58d3d2aSXin Li opus_val32 partial;
824*a58d3d2aSXin Li partial = celt_inner_prod(&X[m->eBands[i]<<LM], &X[N0+(m->eBands[i]<<LM)],
825*a58d3d2aSXin Li (m->eBands[i+1]-m->eBands[i])<<LM, arch);
826*a58d3d2aSXin Li sum = ADD16(sum, EXTRACT16(SHR32(partial, 18)));
827*a58d3d2aSXin Li }
828*a58d3d2aSXin Li sum = MULT16_16_Q15(QCONST16(1.f/8, 15), sum);
829*a58d3d2aSXin Li sum = MIN16(QCONST16(1.f, 10), ABS16(sum));
830*a58d3d2aSXin Li minXC = sum;
831*a58d3d2aSXin Li for (i=8;i<intensity;i++)
832*a58d3d2aSXin Li {
833*a58d3d2aSXin Li opus_val32 partial;
834*a58d3d2aSXin Li partial = celt_inner_prod(&X[m->eBands[i]<<LM], &X[N0+(m->eBands[i]<<LM)],
835*a58d3d2aSXin Li (m->eBands[i+1]-m->eBands[i])<<LM, arch);
836*a58d3d2aSXin Li minXC = MIN16(minXC, ABS16(EXTRACT16(SHR32(partial, 18))));
837*a58d3d2aSXin Li }
838*a58d3d2aSXin Li minXC = MIN16(QCONST16(1.f, 10), ABS16(minXC));
839*a58d3d2aSXin Li /*printf ("%f\n", sum);*/
840*a58d3d2aSXin Li /* mid-side savings estimations based on the LF average*/
841*a58d3d2aSXin Li logXC = celt_log2(QCONST32(1.001f, 20)-MULT16_16(sum, sum));
842*a58d3d2aSXin Li /* mid-side savings estimations based on min correlation */
843*a58d3d2aSXin Li logXC2 = MAX16(HALF16(logXC), celt_log2(QCONST32(1.001f, 20)-MULT16_16(minXC, minXC)));
844*a58d3d2aSXin Li #ifdef FIXED_POINT
845*a58d3d2aSXin Li /* Compensate for Q20 vs Q14 input and convert output to Q8 */
846*a58d3d2aSXin Li logXC = PSHR32(logXC-QCONST16(6.f, DB_SHIFT),DB_SHIFT-8);
847*a58d3d2aSXin Li logXC2 = PSHR32(logXC2-QCONST16(6.f, DB_SHIFT),DB_SHIFT-8);
848*a58d3d2aSXin Li #endif
849*a58d3d2aSXin Li
850*a58d3d2aSXin Li trim += MAX16(-QCONST16(4.f, 8), MULT16_16_Q15(QCONST16(.75f,15),logXC));
851*a58d3d2aSXin Li *stereo_saving = MIN16(*stereo_saving + QCONST16(0.25f, 8), -HALF16(logXC2));
852*a58d3d2aSXin Li }
853*a58d3d2aSXin Li
854*a58d3d2aSXin Li /* Estimate spectral tilt */
855*a58d3d2aSXin Li c=0; do {
856*a58d3d2aSXin Li for (i=0;i<end-1;i++)
857*a58d3d2aSXin Li {
858*a58d3d2aSXin Li diff += bandLogE[i+c*m->nbEBands]*(opus_int32)(2+2*i-end);
859*a58d3d2aSXin Li }
860*a58d3d2aSXin Li } while (++c<C);
861*a58d3d2aSXin Li diff /= C*(end-1);
862*a58d3d2aSXin Li /*printf("%f\n", diff);*/
863*a58d3d2aSXin Li trim -= MAX32(-QCONST16(2.f, 8), MIN32(QCONST16(2.f, 8), SHR32(diff+QCONST16(1.f, DB_SHIFT),DB_SHIFT-8)/6 ));
864*a58d3d2aSXin Li trim -= SHR16(surround_trim, DB_SHIFT-8);
865*a58d3d2aSXin Li trim -= 2*SHR16(tf_estimate, 14-8);
866*a58d3d2aSXin Li #ifndef DISABLE_FLOAT_API
867*a58d3d2aSXin Li if (analysis->valid)
868*a58d3d2aSXin Li {
869*a58d3d2aSXin Li trim -= MAX16(-QCONST16(2.f, 8), MIN16(QCONST16(2.f, 8),
870*a58d3d2aSXin Li (opus_val16)(QCONST16(2.f, 8)*(analysis->tonality_slope+.05f))));
871*a58d3d2aSXin Li }
872*a58d3d2aSXin Li #else
873*a58d3d2aSXin Li (void)analysis;
874*a58d3d2aSXin Li #endif
875*a58d3d2aSXin Li
876*a58d3d2aSXin Li #ifdef FIXED_POINT
877*a58d3d2aSXin Li trim_index = PSHR32(trim, 8);
878*a58d3d2aSXin Li #else
879*a58d3d2aSXin Li trim_index = (int)floor(.5f+trim);
880*a58d3d2aSXin Li #endif
881*a58d3d2aSXin Li trim_index = IMAX(0, IMIN(10, trim_index));
882*a58d3d2aSXin Li /*printf("%d\n", trim_index);*/
883*a58d3d2aSXin Li #ifdef FUZZING
884*a58d3d2aSXin Li trim_index = rand()%11;
885*a58d3d2aSXin Li #endif
886*a58d3d2aSXin Li return trim_index;
887*a58d3d2aSXin Li }
888*a58d3d2aSXin Li
stereo_analysis(const CELTMode * m,const celt_norm * X,int LM,int N0)889*a58d3d2aSXin Li static int stereo_analysis(const CELTMode *m, const celt_norm *X,
890*a58d3d2aSXin Li int LM, int N0)
891*a58d3d2aSXin Li {
892*a58d3d2aSXin Li int i;
893*a58d3d2aSXin Li int thetas;
894*a58d3d2aSXin Li opus_val32 sumLR = EPSILON, sumMS = EPSILON;
895*a58d3d2aSXin Li
896*a58d3d2aSXin Li /* Use the L1 norm to model the entropy of the L/R signal vs the M/S signal */
897*a58d3d2aSXin Li for (i=0;i<13;i++)
898*a58d3d2aSXin Li {
899*a58d3d2aSXin Li int j;
900*a58d3d2aSXin Li for (j=m->eBands[i]<<LM;j<m->eBands[i+1]<<LM;j++)
901*a58d3d2aSXin Li {
902*a58d3d2aSXin Li opus_val32 L, R, M, S;
903*a58d3d2aSXin Li /* We cast to 32-bit first because of the -32768 case */
904*a58d3d2aSXin Li L = EXTEND32(X[j]);
905*a58d3d2aSXin Li R = EXTEND32(X[N0+j]);
906*a58d3d2aSXin Li M = ADD32(L, R);
907*a58d3d2aSXin Li S = SUB32(L, R);
908*a58d3d2aSXin Li sumLR = ADD32(sumLR, ADD32(ABS32(L), ABS32(R)));
909*a58d3d2aSXin Li sumMS = ADD32(sumMS, ADD32(ABS32(M), ABS32(S)));
910*a58d3d2aSXin Li }
911*a58d3d2aSXin Li }
912*a58d3d2aSXin Li sumMS = MULT16_32_Q15(QCONST16(0.707107f, 15), sumMS);
913*a58d3d2aSXin Li thetas = 13;
914*a58d3d2aSXin Li /* We don't need thetas for lower bands with LM<=1 */
915*a58d3d2aSXin Li if (LM<=1)
916*a58d3d2aSXin Li thetas -= 8;
917*a58d3d2aSXin Li return MULT16_32_Q15((m->eBands[13]<<(LM+1))+thetas, sumMS)
918*a58d3d2aSXin Li > MULT16_32_Q15(m->eBands[13]<<(LM+1), sumLR);
919*a58d3d2aSXin Li }
920*a58d3d2aSXin Li
921*a58d3d2aSXin Li #define MSWAP(a,b) do {opus_val16 tmp = a;a=b;b=tmp;} while(0)
median_of_5(const opus_val16 * x)922*a58d3d2aSXin Li static opus_val16 median_of_5(const opus_val16 *x)
923*a58d3d2aSXin Li {
924*a58d3d2aSXin Li opus_val16 t0, t1, t2, t3, t4;
925*a58d3d2aSXin Li t2 = x[2];
926*a58d3d2aSXin Li if (x[0] > x[1])
927*a58d3d2aSXin Li {
928*a58d3d2aSXin Li t0 = x[1];
929*a58d3d2aSXin Li t1 = x[0];
930*a58d3d2aSXin Li } else {
931*a58d3d2aSXin Li t0 = x[0];
932*a58d3d2aSXin Li t1 = x[1];
933*a58d3d2aSXin Li }
934*a58d3d2aSXin Li if (x[3] > x[4])
935*a58d3d2aSXin Li {
936*a58d3d2aSXin Li t3 = x[4];
937*a58d3d2aSXin Li t4 = x[3];
938*a58d3d2aSXin Li } else {
939*a58d3d2aSXin Li t3 = x[3];
940*a58d3d2aSXin Li t4 = x[4];
941*a58d3d2aSXin Li }
942*a58d3d2aSXin Li if (t0 > t3)
943*a58d3d2aSXin Li {
944*a58d3d2aSXin Li MSWAP(t0, t3);
945*a58d3d2aSXin Li MSWAP(t1, t4);
946*a58d3d2aSXin Li }
947*a58d3d2aSXin Li if (t2 > t1)
948*a58d3d2aSXin Li {
949*a58d3d2aSXin Li if (t1 < t3)
950*a58d3d2aSXin Li return MIN16(t2, t3);
951*a58d3d2aSXin Li else
952*a58d3d2aSXin Li return MIN16(t4, t1);
953*a58d3d2aSXin Li } else {
954*a58d3d2aSXin Li if (t2 < t3)
955*a58d3d2aSXin Li return MIN16(t1, t3);
956*a58d3d2aSXin Li else
957*a58d3d2aSXin Li return MIN16(t2, t4);
958*a58d3d2aSXin Li }
959*a58d3d2aSXin Li }
960*a58d3d2aSXin Li
median_of_3(const opus_val16 * x)961*a58d3d2aSXin Li static opus_val16 median_of_3(const opus_val16 *x)
962*a58d3d2aSXin Li {
963*a58d3d2aSXin Li opus_val16 t0, t1, t2;
964*a58d3d2aSXin Li if (x[0] > x[1])
965*a58d3d2aSXin Li {
966*a58d3d2aSXin Li t0 = x[1];
967*a58d3d2aSXin Li t1 = x[0];
968*a58d3d2aSXin Li } else {
969*a58d3d2aSXin Li t0 = x[0];
970*a58d3d2aSXin Li t1 = x[1];
971*a58d3d2aSXin Li }
972*a58d3d2aSXin Li t2 = x[2];
973*a58d3d2aSXin Li if (t1 < t2)
974*a58d3d2aSXin Li return t1;
975*a58d3d2aSXin Li else if (t0 < t2)
976*a58d3d2aSXin Li return t2;
977*a58d3d2aSXin Li else
978*a58d3d2aSXin Li return t0;
979*a58d3d2aSXin Li }
980*a58d3d2aSXin Li
dynalloc_analysis(const opus_val16 * bandLogE,const opus_val16 * bandLogE2,const opus_val16 * oldBandE,int nbEBands,int start,int end,int C,int * offsets,int lsb_depth,const opus_int16 * logN,int isTransient,int vbr,int constrained_vbr,const opus_int16 * eBands,int LM,int effectiveBytes,opus_int32 * tot_boost_,int lfe,opus_val16 * surround_dynalloc,AnalysisInfo * analysis,int * importance,int * spread_weight)981*a58d3d2aSXin Li static opus_val16 dynalloc_analysis(const opus_val16 *bandLogE, const opus_val16 *bandLogE2, const opus_val16 *oldBandE,
982*a58d3d2aSXin Li int nbEBands, int start, int end, int C, int *offsets, int lsb_depth, const opus_int16 *logN,
983*a58d3d2aSXin Li int isTransient, int vbr, int constrained_vbr, const opus_int16 *eBands, int LM,
984*a58d3d2aSXin Li int effectiveBytes, opus_int32 *tot_boost_, int lfe, opus_val16 *surround_dynalloc,
985*a58d3d2aSXin Li AnalysisInfo *analysis, int *importance, int *spread_weight)
986*a58d3d2aSXin Li {
987*a58d3d2aSXin Li int i, c;
988*a58d3d2aSXin Li opus_int32 tot_boost=0;
989*a58d3d2aSXin Li opus_val16 maxDepth;
990*a58d3d2aSXin Li VARDECL(opus_val16, follower);
991*a58d3d2aSXin Li VARDECL(opus_val16, noise_floor);
992*a58d3d2aSXin Li VARDECL(opus_val16, bandLogE3);
993*a58d3d2aSXin Li SAVE_STACK;
994*a58d3d2aSXin Li ALLOC(follower, C*nbEBands, opus_val16);
995*a58d3d2aSXin Li ALLOC(noise_floor, C*nbEBands, opus_val16);
996*a58d3d2aSXin Li ALLOC(bandLogE3, nbEBands, opus_val16);
997*a58d3d2aSXin Li OPUS_CLEAR(offsets, nbEBands);
998*a58d3d2aSXin Li /* Dynamic allocation code */
999*a58d3d2aSXin Li maxDepth=-QCONST16(31.9f, DB_SHIFT);
1000*a58d3d2aSXin Li for (i=0;i<end;i++)
1001*a58d3d2aSXin Li {
1002*a58d3d2aSXin Li /* Noise floor must take into account eMeans, the depth, the width of the bands
1003*a58d3d2aSXin Li and the preemphasis filter (approx. square of bark band ID) */
1004*a58d3d2aSXin Li noise_floor[i] = MULT16_16(QCONST16(0.0625f, DB_SHIFT),logN[i])
1005*a58d3d2aSXin Li +QCONST16(.5f,DB_SHIFT)+SHL16(9-lsb_depth,DB_SHIFT)-SHL16(eMeans[i],6)
1006*a58d3d2aSXin Li +MULT16_16(QCONST16(.0062,DB_SHIFT),(i+5)*(i+5));
1007*a58d3d2aSXin Li }
1008*a58d3d2aSXin Li c=0;do
1009*a58d3d2aSXin Li {
1010*a58d3d2aSXin Li for (i=0;i<end;i++)
1011*a58d3d2aSXin Li maxDepth = MAX16(maxDepth, bandLogE[c*nbEBands+i]-noise_floor[i]);
1012*a58d3d2aSXin Li } while (++c<C);
1013*a58d3d2aSXin Li {
1014*a58d3d2aSXin Li /* Compute a really simple masking model to avoid taking into account completely masked
1015*a58d3d2aSXin Li bands when computing the spreading decision. */
1016*a58d3d2aSXin Li VARDECL(opus_val16, mask);
1017*a58d3d2aSXin Li VARDECL(opus_val16, sig);
1018*a58d3d2aSXin Li ALLOC(mask, nbEBands, opus_val16);
1019*a58d3d2aSXin Li ALLOC(sig, nbEBands, opus_val16);
1020*a58d3d2aSXin Li for (i=0;i<end;i++)
1021*a58d3d2aSXin Li mask[i] = bandLogE[i]-noise_floor[i];
1022*a58d3d2aSXin Li if (C==2)
1023*a58d3d2aSXin Li {
1024*a58d3d2aSXin Li for (i=0;i<end;i++)
1025*a58d3d2aSXin Li mask[i] = MAX16(mask[i], bandLogE[nbEBands+i]-noise_floor[i]);
1026*a58d3d2aSXin Li }
1027*a58d3d2aSXin Li OPUS_COPY(sig, mask, end);
1028*a58d3d2aSXin Li for (i=1;i<end;i++)
1029*a58d3d2aSXin Li mask[i] = MAX16(mask[i], mask[i-1] - QCONST16(2.f, DB_SHIFT));
1030*a58d3d2aSXin Li for (i=end-2;i>=0;i--)
1031*a58d3d2aSXin Li mask[i] = MAX16(mask[i], mask[i+1] - QCONST16(3.f, DB_SHIFT));
1032*a58d3d2aSXin Li for (i=0;i<end;i++)
1033*a58d3d2aSXin Li {
1034*a58d3d2aSXin Li /* Compute SMR: Mask is never more than 72 dB below the peak and never below the noise floor.*/
1035*a58d3d2aSXin Li opus_val16 smr = sig[i]-MAX16(MAX16(0, maxDepth-QCONST16(12.f, DB_SHIFT)), mask[i]);
1036*a58d3d2aSXin Li /* Clamp SMR to make sure we're not shifting by something negative or too large. */
1037*a58d3d2aSXin Li #ifdef FIXED_POINT
1038*a58d3d2aSXin Li /* FIXME: Use PSHR16() instead */
1039*a58d3d2aSXin Li int shift = -PSHR32(MAX16(-QCONST16(5.f, DB_SHIFT), MIN16(0, smr)), DB_SHIFT);
1040*a58d3d2aSXin Li #else
1041*a58d3d2aSXin Li int shift = IMIN(5, IMAX(0, -(int)floor(.5f + smr)));
1042*a58d3d2aSXin Li #endif
1043*a58d3d2aSXin Li spread_weight[i] = 32 >> shift;
1044*a58d3d2aSXin Li }
1045*a58d3d2aSXin Li /*for (i=0;i<end;i++)
1046*a58d3d2aSXin Li printf("%d ", spread_weight[i]);
1047*a58d3d2aSXin Li printf("\n");*/
1048*a58d3d2aSXin Li }
1049*a58d3d2aSXin Li /* Make sure that dynamic allocation can't make us bust the budget.
1050*a58d3d2aSXin Li We enable the feature starting at 24 kb/s for 20-ms frames
1051*a58d3d2aSXin Li and 96 kb/s for 2.5 ms frames. */
1052*a58d3d2aSXin Li if (effectiveBytes >= (30 + 5*LM) && !lfe)
1053*a58d3d2aSXin Li {
1054*a58d3d2aSXin Li int last=0;
1055*a58d3d2aSXin Li c=0;do
1056*a58d3d2aSXin Li {
1057*a58d3d2aSXin Li opus_val16 offset;
1058*a58d3d2aSXin Li opus_val16 tmp;
1059*a58d3d2aSXin Li opus_val16 *f;
1060*a58d3d2aSXin Li OPUS_COPY(bandLogE3, &bandLogE2[c*nbEBands], end);
1061*a58d3d2aSXin Li if (LM==0) {
1062*a58d3d2aSXin Li /* For 2.5 ms frames, the first 8 bands have just one bin, so the
1063*a58d3d2aSXin Li energy is highly unreliable (high variance). For that reason,
1064*a58d3d2aSXin Li we take the max with the previous energy so that at least 2 bins
1065*a58d3d2aSXin Li are getting used. */
1066*a58d3d2aSXin Li for (i=0;i<IMIN(8,end);i++) bandLogE3[i] = MAX16(bandLogE2[c*nbEBands+i], oldBandE[c*nbEBands+i]);
1067*a58d3d2aSXin Li }
1068*a58d3d2aSXin Li f = &follower[c*nbEBands];
1069*a58d3d2aSXin Li f[0] = bandLogE3[0];
1070*a58d3d2aSXin Li for (i=1;i<end;i++)
1071*a58d3d2aSXin Li {
1072*a58d3d2aSXin Li /* The last band to be at least 3 dB higher than the previous one
1073*a58d3d2aSXin Li is the last we'll consider. Otherwise, we run into problems on
1074*a58d3d2aSXin Li bandlimited signals. */
1075*a58d3d2aSXin Li if (bandLogE3[i] > bandLogE3[i-1]+QCONST16(.5f,DB_SHIFT))
1076*a58d3d2aSXin Li last=i;
1077*a58d3d2aSXin Li f[i] = MIN16(f[i-1]+QCONST16(1.5f,DB_SHIFT), bandLogE3[i]);
1078*a58d3d2aSXin Li }
1079*a58d3d2aSXin Li for (i=last-1;i>=0;i--)
1080*a58d3d2aSXin Li f[i] = MIN16(f[i], MIN16(f[i+1]+QCONST16(2.f,DB_SHIFT), bandLogE3[i]));
1081*a58d3d2aSXin Li
1082*a58d3d2aSXin Li /* Combine with a median filter to avoid dynalloc triggering unnecessarily.
1083*a58d3d2aSXin Li The "offset" value controls how conservative we are -- a higher offset
1084*a58d3d2aSXin Li reduces the impact of the median filter and makes dynalloc use more bits. */
1085*a58d3d2aSXin Li offset = QCONST16(1.f, DB_SHIFT);
1086*a58d3d2aSXin Li for (i=2;i<end-2;i++)
1087*a58d3d2aSXin Li f[i] = MAX16(f[i], median_of_5(&bandLogE3[i-2])-offset);
1088*a58d3d2aSXin Li tmp = median_of_3(&bandLogE3[0])-offset;
1089*a58d3d2aSXin Li f[0] = MAX16(f[0], tmp);
1090*a58d3d2aSXin Li f[1] = MAX16(f[1], tmp);
1091*a58d3d2aSXin Li tmp = median_of_3(&bandLogE3[end-3])-offset;
1092*a58d3d2aSXin Li f[end-2] = MAX16(f[end-2], tmp);
1093*a58d3d2aSXin Li f[end-1] = MAX16(f[end-1], tmp);
1094*a58d3d2aSXin Li
1095*a58d3d2aSXin Li for (i=0;i<end;i++)
1096*a58d3d2aSXin Li f[i] = MAX16(f[i], noise_floor[i]);
1097*a58d3d2aSXin Li } while (++c<C);
1098*a58d3d2aSXin Li if (C==2)
1099*a58d3d2aSXin Li {
1100*a58d3d2aSXin Li for (i=start;i<end;i++)
1101*a58d3d2aSXin Li {
1102*a58d3d2aSXin Li /* Consider 24 dB "cross-talk" */
1103*a58d3d2aSXin Li follower[nbEBands+i] = MAX16(follower[nbEBands+i], follower[ i]-QCONST16(4.f,DB_SHIFT));
1104*a58d3d2aSXin Li follower[ i] = MAX16(follower[ i], follower[nbEBands+i]-QCONST16(4.f,DB_SHIFT));
1105*a58d3d2aSXin Li follower[i] = HALF16(MAX16(0, bandLogE[i]-follower[i]) + MAX16(0, bandLogE[nbEBands+i]-follower[nbEBands+i]));
1106*a58d3d2aSXin Li }
1107*a58d3d2aSXin Li } else {
1108*a58d3d2aSXin Li for (i=start;i<end;i++)
1109*a58d3d2aSXin Li {
1110*a58d3d2aSXin Li follower[i] = MAX16(0, bandLogE[i]-follower[i]);
1111*a58d3d2aSXin Li }
1112*a58d3d2aSXin Li }
1113*a58d3d2aSXin Li for (i=start;i<end;i++)
1114*a58d3d2aSXin Li follower[i] = MAX16(follower[i], surround_dynalloc[i]);
1115*a58d3d2aSXin Li for (i=start;i<end;i++)
1116*a58d3d2aSXin Li {
1117*a58d3d2aSXin Li #ifdef FIXED_POINT
1118*a58d3d2aSXin Li importance[i] = PSHR32(13*celt_exp2(MIN16(follower[i], QCONST16(4.f, DB_SHIFT))), 16);
1119*a58d3d2aSXin Li #else
1120*a58d3d2aSXin Li importance[i] = (int)floor(.5f+13*celt_exp2(MIN16(follower[i], QCONST16(4.f, DB_SHIFT))));
1121*a58d3d2aSXin Li #endif
1122*a58d3d2aSXin Li }
1123*a58d3d2aSXin Li /* For non-transient CBR/CVBR frames, halve the dynalloc contribution */
1124*a58d3d2aSXin Li if ((!vbr || constrained_vbr)&&!isTransient)
1125*a58d3d2aSXin Li {
1126*a58d3d2aSXin Li for (i=start;i<end;i++)
1127*a58d3d2aSXin Li follower[i] = HALF16(follower[i]);
1128*a58d3d2aSXin Li }
1129*a58d3d2aSXin Li for (i=start;i<end;i++)
1130*a58d3d2aSXin Li {
1131*a58d3d2aSXin Li if (i<8)
1132*a58d3d2aSXin Li follower[i] *= 2;
1133*a58d3d2aSXin Li if (i>=12)
1134*a58d3d2aSXin Li follower[i] = HALF16(follower[i]);
1135*a58d3d2aSXin Li }
1136*a58d3d2aSXin Li #ifdef DISABLE_FLOAT_API
1137*a58d3d2aSXin Li (void)analysis;
1138*a58d3d2aSXin Li #else
1139*a58d3d2aSXin Li if (analysis->valid)
1140*a58d3d2aSXin Li {
1141*a58d3d2aSXin Li for (i=start;i<IMIN(LEAK_BANDS, end);i++)
1142*a58d3d2aSXin Li follower[i] = follower[i] + QCONST16(1.f/64.f, DB_SHIFT)*analysis->leak_boost[i];
1143*a58d3d2aSXin Li }
1144*a58d3d2aSXin Li #endif
1145*a58d3d2aSXin Li for (i=start;i<end;i++)
1146*a58d3d2aSXin Li {
1147*a58d3d2aSXin Li int width;
1148*a58d3d2aSXin Li int boost;
1149*a58d3d2aSXin Li int boost_bits;
1150*a58d3d2aSXin Li
1151*a58d3d2aSXin Li follower[i] = MIN16(follower[i], QCONST16(4, DB_SHIFT));
1152*a58d3d2aSXin Li
1153*a58d3d2aSXin Li width = C*(eBands[i+1]-eBands[i])<<LM;
1154*a58d3d2aSXin Li if (width<6)
1155*a58d3d2aSXin Li {
1156*a58d3d2aSXin Li boost = (int)SHR32(EXTEND32(follower[i]),DB_SHIFT);
1157*a58d3d2aSXin Li boost_bits = boost*width<<BITRES;
1158*a58d3d2aSXin Li } else if (width > 48) {
1159*a58d3d2aSXin Li boost = (int)SHR32(EXTEND32(follower[i])*8,DB_SHIFT);
1160*a58d3d2aSXin Li boost_bits = (boost*width<<BITRES)/8;
1161*a58d3d2aSXin Li } else {
1162*a58d3d2aSXin Li boost = (int)SHR32(EXTEND32(follower[i])*width/6,DB_SHIFT);
1163*a58d3d2aSXin Li boost_bits = boost*6<<BITRES;
1164*a58d3d2aSXin Li }
1165*a58d3d2aSXin Li /* For CBR and non-transient CVBR frames, limit dynalloc to 2/3 of the bits */
1166*a58d3d2aSXin Li if ((!vbr || (constrained_vbr&&!isTransient))
1167*a58d3d2aSXin Li && (tot_boost+boost_bits)>>BITRES>>3 > 2*effectiveBytes/3)
1168*a58d3d2aSXin Li {
1169*a58d3d2aSXin Li opus_int32 cap = ((2*effectiveBytes/3)<<BITRES<<3);
1170*a58d3d2aSXin Li offsets[i] = cap-tot_boost;
1171*a58d3d2aSXin Li tot_boost = cap;
1172*a58d3d2aSXin Li break;
1173*a58d3d2aSXin Li } else {
1174*a58d3d2aSXin Li offsets[i] = boost;
1175*a58d3d2aSXin Li tot_boost += boost_bits;
1176*a58d3d2aSXin Li }
1177*a58d3d2aSXin Li }
1178*a58d3d2aSXin Li } else {
1179*a58d3d2aSXin Li for (i=start;i<end;i++)
1180*a58d3d2aSXin Li importance[i] = 13;
1181*a58d3d2aSXin Li }
1182*a58d3d2aSXin Li *tot_boost_ = tot_boost;
1183*a58d3d2aSXin Li RESTORE_STACK;
1184*a58d3d2aSXin Li return maxDepth;
1185*a58d3d2aSXin Li }
1186*a58d3d2aSXin Li
1187*a58d3d2aSXin Li
run_prefilter(CELTEncoder * st,celt_sig * in,celt_sig * prefilter_mem,int CC,int N,int prefilter_tapset,int * pitch,opus_val16 * gain,int * qgain,int enabled,int nbAvailableBytes,AnalysisInfo * analysis)1188*a58d3d2aSXin Li static int run_prefilter(CELTEncoder *st, celt_sig *in, celt_sig *prefilter_mem, int CC, int N,
1189*a58d3d2aSXin Li int prefilter_tapset, int *pitch, opus_val16 *gain, int *qgain, int enabled, int nbAvailableBytes, AnalysisInfo *analysis)
1190*a58d3d2aSXin Li {
1191*a58d3d2aSXin Li int c;
1192*a58d3d2aSXin Li VARDECL(celt_sig, _pre);
1193*a58d3d2aSXin Li celt_sig *pre[2];
1194*a58d3d2aSXin Li const CELTMode *mode;
1195*a58d3d2aSXin Li int pitch_index;
1196*a58d3d2aSXin Li opus_val16 gain1;
1197*a58d3d2aSXin Li opus_val16 pf_threshold;
1198*a58d3d2aSXin Li int pf_on;
1199*a58d3d2aSXin Li int qg;
1200*a58d3d2aSXin Li int overlap;
1201*a58d3d2aSXin Li SAVE_STACK;
1202*a58d3d2aSXin Li
1203*a58d3d2aSXin Li mode = st->mode;
1204*a58d3d2aSXin Li overlap = mode->overlap;
1205*a58d3d2aSXin Li ALLOC(_pre, CC*(N+COMBFILTER_MAXPERIOD), celt_sig);
1206*a58d3d2aSXin Li
1207*a58d3d2aSXin Li pre[0] = _pre;
1208*a58d3d2aSXin Li pre[1] = _pre + (N+COMBFILTER_MAXPERIOD);
1209*a58d3d2aSXin Li
1210*a58d3d2aSXin Li
1211*a58d3d2aSXin Li c=0; do {
1212*a58d3d2aSXin Li OPUS_COPY(pre[c], prefilter_mem+c*COMBFILTER_MAXPERIOD, COMBFILTER_MAXPERIOD);
1213*a58d3d2aSXin Li OPUS_COPY(pre[c]+COMBFILTER_MAXPERIOD, in+c*(N+overlap)+overlap, N);
1214*a58d3d2aSXin Li } while (++c<CC);
1215*a58d3d2aSXin Li
1216*a58d3d2aSXin Li if (enabled)
1217*a58d3d2aSXin Li {
1218*a58d3d2aSXin Li VARDECL(opus_val16, pitch_buf);
1219*a58d3d2aSXin Li ALLOC(pitch_buf, (COMBFILTER_MAXPERIOD+N)>>1, opus_val16);
1220*a58d3d2aSXin Li
1221*a58d3d2aSXin Li pitch_downsample(pre, pitch_buf, COMBFILTER_MAXPERIOD+N, CC, st->arch);
1222*a58d3d2aSXin Li /* Don't search for the fir last 1.5 octave of the range because
1223*a58d3d2aSXin Li there's too many false-positives due to short-term correlation */
1224*a58d3d2aSXin Li pitch_search(pitch_buf+(COMBFILTER_MAXPERIOD>>1), pitch_buf, N,
1225*a58d3d2aSXin Li COMBFILTER_MAXPERIOD-3*COMBFILTER_MINPERIOD, &pitch_index,
1226*a58d3d2aSXin Li st->arch);
1227*a58d3d2aSXin Li pitch_index = COMBFILTER_MAXPERIOD-pitch_index;
1228*a58d3d2aSXin Li
1229*a58d3d2aSXin Li gain1 = remove_doubling(pitch_buf, COMBFILTER_MAXPERIOD, COMBFILTER_MINPERIOD,
1230*a58d3d2aSXin Li N, &pitch_index, st->prefilter_period, st->prefilter_gain, st->arch);
1231*a58d3d2aSXin Li if (pitch_index > COMBFILTER_MAXPERIOD-2)
1232*a58d3d2aSXin Li pitch_index = COMBFILTER_MAXPERIOD-2;
1233*a58d3d2aSXin Li gain1 = MULT16_16_Q15(QCONST16(.7f,15),gain1);
1234*a58d3d2aSXin Li /*printf("%d %d %f %f\n", pitch_change, pitch_index, gain1, st->analysis.tonality);*/
1235*a58d3d2aSXin Li if (st->loss_rate>2)
1236*a58d3d2aSXin Li gain1 = HALF32(gain1);
1237*a58d3d2aSXin Li if (st->loss_rate>4)
1238*a58d3d2aSXin Li gain1 = HALF32(gain1);
1239*a58d3d2aSXin Li if (st->loss_rate>8)
1240*a58d3d2aSXin Li gain1 = 0;
1241*a58d3d2aSXin Li } else {
1242*a58d3d2aSXin Li gain1 = 0;
1243*a58d3d2aSXin Li pitch_index = COMBFILTER_MINPERIOD;
1244*a58d3d2aSXin Li }
1245*a58d3d2aSXin Li #ifndef DISABLE_FLOAT_API
1246*a58d3d2aSXin Li if (analysis->valid)
1247*a58d3d2aSXin Li gain1 = (opus_val16)(gain1 * analysis->max_pitch_ratio);
1248*a58d3d2aSXin Li #else
1249*a58d3d2aSXin Li (void)analysis;
1250*a58d3d2aSXin Li #endif
1251*a58d3d2aSXin Li /* Gain threshold for enabling the prefilter/postfilter */
1252*a58d3d2aSXin Li pf_threshold = QCONST16(.2f,15);
1253*a58d3d2aSXin Li
1254*a58d3d2aSXin Li /* Adjusting the threshold based on rate and continuity */
1255*a58d3d2aSXin Li if (abs(pitch_index-st->prefilter_period)*10>pitch_index)
1256*a58d3d2aSXin Li pf_threshold += QCONST16(.2f,15);
1257*a58d3d2aSXin Li if (nbAvailableBytes<25)
1258*a58d3d2aSXin Li pf_threshold += QCONST16(.1f,15);
1259*a58d3d2aSXin Li if (nbAvailableBytes<35)
1260*a58d3d2aSXin Li pf_threshold += QCONST16(.1f,15);
1261*a58d3d2aSXin Li if (st->prefilter_gain > QCONST16(.4f,15))
1262*a58d3d2aSXin Li pf_threshold -= QCONST16(.1f,15);
1263*a58d3d2aSXin Li if (st->prefilter_gain > QCONST16(.55f,15))
1264*a58d3d2aSXin Li pf_threshold -= QCONST16(.1f,15);
1265*a58d3d2aSXin Li
1266*a58d3d2aSXin Li /* Hard threshold at 0.2 */
1267*a58d3d2aSXin Li pf_threshold = MAX16(pf_threshold, QCONST16(.2f,15));
1268*a58d3d2aSXin Li if (gain1<pf_threshold)
1269*a58d3d2aSXin Li {
1270*a58d3d2aSXin Li gain1 = 0;
1271*a58d3d2aSXin Li pf_on = 0;
1272*a58d3d2aSXin Li qg = 0;
1273*a58d3d2aSXin Li } else {
1274*a58d3d2aSXin Li /*This block is not gated by a total bits check only because
1275*a58d3d2aSXin Li of the nbAvailableBytes check above.*/
1276*a58d3d2aSXin Li if (ABS16(gain1-st->prefilter_gain)<QCONST16(.1f,15))
1277*a58d3d2aSXin Li gain1=st->prefilter_gain;
1278*a58d3d2aSXin Li
1279*a58d3d2aSXin Li #ifdef FIXED_POINT
1280*a58d3d2aSXin Li qg = ((gain1+1536)>>10)/3-1;
1281*a58d3d2aSXin Li #else
1282*a58d3d2aSXin Li qg = (int)floor(.5f+gain1*32/3)-1;
1283*a58d3d2aSXin Li #endif
1284*a58d3d2aSXin Li qg = IMAX(0, IMIN(7, qg));
1285*a58d3d2aSXin Li gain1 = QCONST16(0.09375f,15)*(qg+1);
1286*a58d3d2aSXin Li pf_on = 1;
1287*a58d3d2aSXin Li }
1288*a58d3d2aSXin Li /*printf("%d %f\n", pitch_index, gain1);*/
1289*a58d3d2aSXin Li
1290*a58d3d2aSXin Li c=0; do {
1291*a58d3d2aSXin Li int offset = mode->shortMdctSize-overlap;
1292*a58d3d2aSXin Li st->prefilter_period=IMAX(st->prefilter_period, COMBFILTER_MINPERIOD);
1293*a58d3d2aSXin Li OPUS_COPY(in+c*(N+overlap), st->in_mem+c*(overlap), overlap);
1294*a58d3d2aSXin Li if (offset)
1295*a58d3d2aSXin Li comb_filter(in+c*(N+overlap)+overlap, pre[c]+COMBFILTER_MAXPERIOD,
1296*a58d3d2aSXin Li st->prefilter_period, st->prefilter_period, offset, -st->prefilter_gain, -st->prefilter_gain,
1297*a58d3d2aSXin Li st->prefilter_tapset, st->prefilter_tapset, NULL, 0, st->arch);
1298*a58d3d2aSXin Li
1299*a58d3d2aSXin Li comb_filter(in+c*(N+overlap)+overlap+offset, pre[c]+COMBFILTER_MAXPERIOD+offset,
1300*a58d3d2aSXin Li st->prefilter_period, pitch_index, N-offset, -st->prefilter_gain, -gain1,
1301*a58d3d2aSXin Li st->prefilter_tapset, prefilter_tapset, mode->window, overlap, st->arch);
1302*a58d3d2aSXin Li OPUS_COPY(st->in_mem+c*(overlap), in+c*(N+overlap)+N, overlap);
1303*a58d3d2aSXin Li
1304*a58d3d2aSXin Li if (N>COMBFILTER_MAXPERIOD)
1305*a58d3d2aSXin Li {
1306*a58d3d2aSXin Li OPUS_COPY(prefilter_mem+c*COMBFILTER_MAXPERIOD, pre[c]+N, COMBFILTER_MAXPERIOD);
1307*a58d3d2aSXin Li } else {
1308*a58d3d2aSXin Li OPUS_MOVE(prefilter_mem+c*COMBFILTER_MAXPERIOD, prefilter_mem+c*COMBFILTER_MAXPERIOD+N, COMBFILTER_MAXPERIOD-N);
1309*a58d3d2aSXin Li OPUS_COPY(prefilter_mem+c*COMBFILTER_MAXPERIOD+COMBFILTER_MAXPERIOD-N, pre[c]+COMBFILTER_MAXPERIOD, N);
1310*a58d3d2aSXin Li }
1311*a58d3d2aSXin Li } while (++c<CC);
1312*a58d3d2aSXin Li
1313*a58d3d2aSXin Li RESTORE_STACK;
1314*a58d3d2aSXin Li *gain = gain1;
1315*a58d3d2aSXin Li *pitch = pitch_index;
1316*a58d3d2aSXin Li *qgain = qg;
1317*a58d3d2aSXin Li return pf_on;
1318*a58d3d2aSXin Li }
1319*a58d3d2aSXin Li
compute_vbr(const CELTMode * mode,AnalysisInfo * analysis,opus_int32 base_target,int LM,opus_int32 bitrate,int lastCodedBands,int C,int intensity,int constrained_vbr,opus_val16 stereo_saving,int tot_boost,opus_val16 tf_estimate,int pitch_change,opus_val16 maxDepth,int lfe,int has_surround_mask,opus_val16 surround_masking,opus_val16 temporal_vbr)1320*a58d3d2aSXin Li static int compute_vbr(const CELTMode *mode, AnalysisInfo *analysis, opus_int32 base_target,
1321*a58d3d2aSXin Li int LM, opus_int32 bitrate, int lastCodedBands, int C, int intensity,
1322*a58d3d2aSXin Li int constrained_vbr, opus_val16 stereo_saving, int tot_boost,
1323*a58d3d2aSXin Li opus_val16 tf_estimate, int pitch_change, opus_val16 maxDepth,
1324*a58d3d2aSXin Li int lfe, int has_surround_mask, opus_val16 surround_masking,
1325*a58d3d2aSXin Li opus_val16 temporal_vbr)
1326*a58d3d2aSXin Li {
1327*a58d3d2aSXin Li /* The target rate in 8th bits per frame */
1328*a58d3d2aSXin Li opus_int32 target;
1329*a58d3d2aSXin Li int coded_bins;
1330*a58d3d2aSXin Li int coded_bands;
1331*a58d3d2aSXin Li opus_val16 tf_calibration;
1332*a58d3d2aSXin Li int nbEBands;
1333*a58d3d2aSXin Li const opus_int16 *eBands;
1334*a58d3d2aSXin Li
1335*a58d3d2aSXin Li nbEBands = mode->nbEBands;
1336*a58d3d2aSXin Li eBands = mode->eBands;
1337*a58d3d2aSXin Li
1338*a58d3d2aSXin Li coded_bands = lastCodedBands ? lastCodedBands : nbEBands;
1339*a58d3d2aSXin Li coded_bins = eBands[coded_bands]<<LM;
1340*a58d3d2aSXin Li if (C==2)
1341*a58d3d2aSXin Li coded_bins += eBands[IMIN(intensity, coded_bands)]<<LM;
1342*a58d3d2aSXin Li
1343*a58d3d2aSXin Li target = base_target;
1344*a58d3d2aSXin Li
1345*a58d3d2aSXin Li /*printf("%f %f %f %f %d %d ", st->analysis.activity, st->analysis.tonality, tf_estimate, st->stereo_saving, tot_boost, coded_bands);*/
1346*a58d3d2aSXin Li #ifndef DISABLE_FLOAT_API
1347*a58d3d2aSXin Li if (analysis->valid && analysis->activity<.4)
1348*a58d3d2aSXin Li target -= (opus_int32)((coded_bins<<BITRES)*(.4f-analysis->activity));
1349*a58d3d2aSXin Li #endif
1350*a58d3d2aSXin Li /* Stereo savings */
1351*a58d3d2aSXin Li if (C==2)
1352*a58d3d2aSXin Li {
1353*a58d3d2aSXin Li int coded_stereo_bands;
1354*a58d3d2aSXin Li int coded_stereo_dof;
1355*a58d3d2aSXin Li opus_val16 max_frac;
1356*a58d3d2aSXin Li coded_stereo_bands = IMIN(intensity, coded_bands);
1357*a58d3d2aSXin Li coded_stereo_dof = (eBands[coded_stereo_bands]<<LM)-coded_stereo_bands;
1358*a58d3d2aSXin Li /* Maximum fraction of the bits we can save if the signal is mono. */
1359*a58d3d2aSXin Li max_frac = DIV32_16(MULT16_16(QCONST16(0.8f, 15), coded_stereo_dof), coded_bins);
1360*a58d3d2aSXin Li stereo_saving = MIN16(stereo_saving, QCONST16(1.f, 8));
1361*a58d3d2aSXin Li /*printf("%d %d %d ", coded_stereo_dof, coded_bins, tot_boost);*/
1362*a58d3d2aSXin Li target -= (opus_int32)MIN32(MULT16_32_Q15(max_frac,target),
1363*a58d3d2aSXin Li SHR32(MULT16_16(stereo_saving-QCONST16(0.1f,8),(coded_stereo_dof<<BITRES)),8));
1364*a58d3d2aSXin Li }
1365*a58d3d2aSXin Li /* Boost the rate according to dynalloc (minus the dynalloc average for calibration). */
1366*a58d3d2aSXin Li target += tot_boost-(19<<LM);
1367*a58d3d2aSXin Li /* Apply transient boost, compensating for average boost. */
1368*a58d3d2aSXin Li tf_calibration = QCONST16(0.044f,14);
1369*a58d3d2aSXin Li target += (opus_int32)SHL32(MULT16_32_Q15(tf_estimate-tf_calibration, target),1);
1370*a58d3d2aSXin Li
1371*a58d3d2aSXin Li #ifndef DISABLE_FLOAT_API
1372*a58d3d2aSXin Li /* Apply tonality boost */
1373*a58d3d2aSXin Li if (analysis->valid && !lfe)
1374*a58d3d2aSXin Li {
1375*a58d3d2aSXin Li opus_int32 tonal_target;
1376*a58d3d2aSXin Li float tonal;
1377*a58d3d2aSXin Li
1378*a58d3d2aSXin Li /* Tonality boost (compensating for the average). */
1379*a58d3d2aSXin Li tonal = MAX16(0.f,analysis->tonality-.15f)-0.12f;
1380*a58d3d2aSXin Li tonal_target = target + (opus_int32)((coded_bins<<BITRES)*1.2f*tonal);
1381*a58d3d2aSXin Li if (pitch_change)
1382*a58d3d2aSXin Li tonal_target += (opus_int32)((coded_bins<<BITRES)*.8f);
1383*a58d3d2aSXin Li /*printf("%f %f ", analysis->tonality, tonal);*/
1384*a58d3d2aSXin Li target = tonal_target;
1385*a58d3d2aSXin Li }
1386*a58d3d2aSXin Li #else
1387*a58d3d2aSXin Li (void)analysis;
1388*a58d3d2aSXin Li (void)pitch_change;
1389*a58d3d2aSXin Li #endif
1390*a58d3d2aSXin Li
1391*a58d3d2aSXin Li if (has_surround_mask&&!lfe)
1392*a58d3d2aSXin Li {
1393*a58d3d2aSXin Li opus_int32 surround_target = target + (opus_int32)SHR32(MULT16_16(surround_masking,coded_bins<<BITRES), DB_SHIFT);
1394*a58d3d2aSXin Li /*printf("%f %d %d %d %d %d %d ", surround_masking, coded_bins, st->end, st->intensity, surround_target, target, st->bitrate);*/
1395*a58d3d2aSXin Li target = IMAX(target/4, surround_target);
1396*a58d3d2aSXin Li }
1397*a58d3d2aSXin Li
1398*a58d3d2aSXin Li {
1399*a58d3d2aSXin Li opus_int32 floor_depth;
1400*a58d3d2aSXin Li int bins;
1401*a58d3d2aSXin Li bins = eBands[nbEBands-2]<<LM;
1402*a58d3d2aSXin Li /*floor_depth = SHR32(MULT16_16((C*bins<<BITRES),celt_log2(SHL32(MAX16(1,sample_max),13))), DB_SHIFT);*/
1403*a58d3d2aSXin Li floor_depth = (opus_int32)SHR32(MULT16_16((C*bins<<BITRES),maxDepth), DB_SHIFT);
1404*a58d3d2aSXin Li floor_depth = IMAX(floor_depth, target>>2);
1405*a58d3d2aSXin Li target = IMIN(target, floor_depth);
1406*a58d3d2aSXin Li /*printf("%f %d\n", maxDepth, floor_depth);*/
1407*a58d3d2aSXin Li }
1408*a58d3d2aSXin Li
1409*a58d3d2aSXin Li /* Make VBR less aggressive for constrained VBR because we can't keep a higher bitrate
1410*a58d3d2aSXin Li for long. Needs tuning. */
1411*a58d3d2aSXin Li if ((!has_surround_mask||lfe) && constrained_vbr)
1412*a58d3d2aSXin Li {
1413*a58d3d2aSXin Li target = base_target + (opus_int32)MULT16_32_Q15(QCONST16(0.67f, 15), target-base_target);
1414*a58d3d2aSXin Li }
1415*a58d3d2aSXin Li
1416*a58d3d2aSXin Li if (!has_surround_mask && tf_estimate < QCONST16(.2f, 14))
1417*a58d3d2aSXin Li {
1418*a58d3d2aSXin Li opus_val16 amount;
1419*a58d3d2aSXin Li opus_val16 tvbr_factor;
1420*a58d3d2aSXin Li amount = MULT16_16_Q15(QCONST16(.0000031f, 30), IMAX(0, IMIN(32000, 96000-bitrate)));
1421*a58d3d2aSXin Li tvbr_factor = SHR32(MULT16_16(temporal_vbr, amount), DB_SHIFT);
1422*a58d3d2aSXin Li target += (opus_int32)MULT16_32_Q15(tvbr_factor, target);
1423*a58d3d2aSXin Li }
1424*a58d3d2aSXin Li
1425*a58d3d2aSXin Li /* Don't allow more than doubling the rate */
1426*a58d3d2aSXin Li target = IMIN(2*base_target, target);
1427*a58d3d2aSXin Li
1428*a58d3d2aSXin Li return target;
1429*a58d3d2aSXin Li }
1430*a58d3d2aSXin Li
celt_encode_with_ec(CELTEncoder * OPUS_RESTRICT st,const opus_val16 * pcm,int frame_size,unsigned char * compressed,int nbCompressedBytes,ec_enc * enc)1431*a58d3d2aSXin Li int celt_encode_with_ec(CELTEncoder * OPUS_RESTRICT st, const opus_val16 * pcm, int frame_size, unsigned char *compressed, int nbCompressedBytes, ec_enc *enc)
1432*a58d3d2aSXin Li {
1433*a58d3d2aSXin Li int i, c, N;
1434*a58d3d2aSXin Li opus_int32 bits;
1435*a58d3d2aSXin Li ec_enc _enc;
1436*a58d3d2aSXin Li VARDECL(celt_sig, in);
1437*a58d3d2aSXin Li VARDECL(celt_sig, freq);
1438*a58d3d2aSXin Li VARDECL(celt_norm, X);
1439*a58d3d2aSXin Li VARDECL(celt_ener, bandE);
1440*a58d3d2aSXin Li VARDECL(opus_val16, bandLogE);
1441*a58d3d2aSXin Li VARDECL(opus_val16, bandLogE2);
1442*a58d3d2aSXin Li VARDECL(int, fine_quant);
1443*a58d3d2aSXin Li VARDECL(opus_val16, error);
1444*a58d3d2aSXin Li VARDECL(int, pulses);
1445*a58d3d2aSXin Li VARDECL(int, cap);
1446*a58d3d2aSXin Li VARDECL(int, offsets);
1447*a58d3d2aSXin Li VARDECL(int, importance);
1448*a58d3d2aSXin Li VARDECL(int, spread_weight);
1449*a58d3d2aSXin Li VARDECL(int, fine_priority);
1450*a58d3d2aSXin Li VARDECL(int, tf_res);
1451*a58d3d2aSXin Li VARDECL(unsigned char, collapse_masks);
1452*a58d3d2aSXin Li celt_sig *prefilter_mem;
1453*a58d3d2aSXin Li opus_val16 *oldBandE, *oldLogE, *oldLogE2, *energyError;
1454*a58d3d2aSXin Li int shortBlocks=0;
1455*a58d3d2aSXin Li int isTransient=0;
1456*a58d3d2aSXin Li const int CC = st->channels;
1457*a58d3d2aSXin Li const int C = st->stream_channels;
1458*a58d3d2aSXin Li int LM, M;
1459*a58d3d2aSXin Li int tf_select;
1460*a58d3d2aSXin Li int nbFilledBytes, nbAvailableBytes;
1461*a58d3d2aSXin Li int start;
1462*a58d3d2aSXin Li int end;
1463*a58d3d2aSXin Li int effEnd;
1464*a58d3d2aSXin Li int codedBands;
1465*a58d3d2aSXin Li int alloc_trim;
1466*a58d3d2aSXin Li int pitch_index=COMBFILTER_MINPERIOD;
1467*a58d3d2aSXin Li opus_val16 gain1 = 0;
1468*a58d3d2aSXin Li int dual_stereo=0;
1469*a58d3d2aSXin Li int effectiveBytes;
1470*a58d3d2aSXin Li int dynalloc_logp;
1471*a58d3d2aSXin Li opus_int32 vbr_rate;
1472*a58d3d2aSXin Li opus_int32 total_bits;
1473*a58d3d2aSXin Li opus_int32 total_boost;
1474*a58d3d2aSXin Li opus_int32 balance;
1475*a58d3d2aSXin Li opus_int32 tell;
1476*a58d3d2aSXin Li opus_int32 tell0_frac;
1477*a58d3d2aSXin Li int prefilter_tapset=0;
1478*a58d3d2aSXin Li int pf_on;
1479*a58d3d2aSXin Li int anti_collapse_rsv;
1480*a58d3d2aSXin Li int anti_collapse_on=0;
1481*a58d3d2aSXin Li int silence=0;
1482*a58d3d2aSXin Li int tf_chan = 0;
1483*a58d3d2aSXin Li opus_val16 tf_estimate;
1484*a58d3d2aSXin Li int pitch_change=0;
1485*a58d3d2aSXin Li opus_int32 tot_boost;
1486*a58d3d2aSXin Li opus_val32 sample_max;
1487*a58d3d2aSXin Li opus_val16 maxDepth;
1488*a58d3d2aSXin Li const OpusCustomMode *mode;
1489*a58d3d2aSXin Li int nbEBands;
1490*a58d3d2aSXin Li int overlap;
1491*a58d3d2aSXin Li const opus_int16 *eBands;
1492*a58d3d2aSXin Li int secondMdct;
1493*a58d3d2aSXin Li int signalBandwidth;
1494*a58d3d2aSXin Li int transient_got_disabled=0;
1495*a58d3d2aSXin Li opus_val16 surround_masking=0;
1496*a58d3d2aSXin Li opus_val16 temporal_vbr=0;
1497*a58d3d2aSXin Li opus_val16 surround_trim = 0;
1498*a58d3d2aSXin Li opus_int32 equiv_rate;
1499*a58d3d2aSXin Li int hybrid;
1500*a58d3d2aSXin Li int weak_transient = 0;
1501*a58d3d2aSXin Li int enable_tf_analysis;
1502*a58d3d2aSXin Li VARDECL(opus_val16, surround_dynalloc);
1503*a58d3d2aSXin Li ALLOC_STACK;
1504*a58d3d2aSXin Li
1505*a58d3d2aSXin Li mode = st->mode;
1506*a58d3d2aSXin Li nbEBands = mode->nbEBands;
1507*a58d3d2aSXin Li overlap = mode->overlap;
1508*a58d3d2aSXin Li eBands = mode->eBands;
1509*a58d3d2aSXin Li start = st->start;
1510*a58d3d2aSXin Li end = st->end;
1511*a58d3d2aSXin Li hybrid = start != 0;
1512*a58d3d2aSXin Li tf_estimate = 0;
1513*a58d3d2aSXin Li if (nbCompressedBytes<2 || pcm==NULL)
1514*a58d3d2aSXin Li {
1515*a58d3d2aSXin Li RESTORE_STACK;
1516*a58d3d2aSXin Li return OPUS_BAD_ARG;
1517*a58d3d2aSXin Li }
1518*a58d3d2aSXin Li
1519*a58d3d2aSXin Li frame_size *= st->upsample;
1520*a58d3d2aSXin Li for (LM=0;LM<=mode->maxLM;LM++)
1521*a58d3d2aSXin Li if (mode->shortMdctSize<<LM==frame_size)
1522*a58d3d2aSXin Li break;
1523*a58d3d2aSXin Li if (LM>mode->maxLM)
1524*a58d3d2aSXin Li {
1525*a58d3d2aSXin Li RESTORE_STACK;
1526*a58d3d2aSXin Li return OPUS_BAD_ARG;
1527*a58d3d2aSXin Li }
1528*a58d3d2aSXin Li M=1<<LM;
1529*a58d3d2aSXin Li N = M*mode->shortMdctSize;
1530*a58d3d2aSXin Li
1531*a58d3d2aSXin Li prefilter_mem = st->in_mem+CC*(overlap);
1532*a58d3d2aSXin Li oldBandE = (opus_val16*)(st->in_mem+CC*(overlap+COMBFILTER_MAXPERIOD));
1533*a58d3d2aSXin Li oldLogE = oldBandE + CC*nbEBands;
1534*a58d3d2aSXin Li oldLogE2 = oldLogE + CC*nbEBands;
1535*a58d3d2aSXin Li energyError = oldLogE2 + CC*nbEBands;
1536*a58d3d2aSXin Li
1537*a58d3d2aSXin Li if (enc==NULL)
1538*a58d3d2aSXin Li {
1539*a58d3d2aSXin Li tell0_frac=tell=1;
1540*a58d3d2aSXin Li nbFilledBytes=0;
1541*a58d3d2aSXin Li } else {
1542*a58d3d2aSXin Li tell0_frac=ec_tell_frac(enc);
1543*a58d3d2aSXin Li tell=ec_tell(enc);
1544*a58d3d2aSXin Li nbFilledBytes=(tell+4)>>3;
1545*a58d3d2aSXin Li }
1546*a58d3d2aSXin Li
1547*a58d3d2aSXin Li #ifdef CUSTOM_MODES
1548*a58d3d2aSXin Li if (st->signalling && enc==NULL)
1549*a58d3d2aSXin Li {
1550*a58d3d2aSXin Li int tmp = (mode->effEBands-end)>>1;
1551*a58d3d2aSXin Li end = st->end = IMAX(1, mode->effEBands-tmp);
1552*a58d3d2aSXin Li compressed[0] = tmp<<5;
1553*a58d3d2aSXin Li compressed[0] |= LM<<3;
1554*a58d3d2aSXin Li compressed[0] |= (C==2)<<2;
1555*a58d3d2aSXin Li /* Convert "standard mode" to Opus header */
1556*a58d3d2aSXin Li if (mode->Fs==48000 && mode->shortMdctSize==120)
1557*a58d3d2aSXin Li {
1558*a58d3d2aSXin Li int c0 = toOpus(compressed[0]);
1559*a58d3d2aSXin Li if (c0<0)
1560*a58d3d2aSXin Li {
1561*a58d3d2aSXin Li RESTORE_STACK;
1562*a58d3d2aSXin Li return OPUS_BAD_ARG;
1563*a58d3d2aSXin Li }
1564*a58d3d2aSXin Li compressed[0] = c0;
1565*a58d3d2aSXin Li }
1566*a58d3d2aSXin Li compressed++;
1567*a58d3d2aSXin Li nbCompressedBytes--;
1568*a58d3d2aSXin Li }
1569*a58d3d2aSXin Li #else
1570*a58d3d2aSXin Li celt_assert(st->signalling==0);
1571*a58d3d2aSXin Li #endif
1572*a58d3d2aSXin Li
1573*a58d3d2aSXin Li /* Can't produce more than 1275 output bytes */
1574*a58d3d2aSXin Li nbCompressedBytes = IMIN(nbCompressedBytes,1275);
1575*a58d3d2aSXin Li nbAvailableBytes = nbCompressedBytes - nbFilledBytes;
1576*a58d3d2aSXin Li
1577*a58d3d2aSXin Li if (st->vbr && st->bitrate!=OPUS_BITRATE_MAX)
1578*a58d3d2aSXin Li {
1579*a58d3d2aSXin Li opus_int32 den=mode->Fs>>BITRES;
1580*a58d3d2aSXin Li vbr_rate=(st->bitrate*frame_size+(den>>1))/den;
1581*a58d3d2aSXin Li #ifdef CUSTOM_MODES
1582*a58d3d2aSXin Li if (st->signalling)
1583*a58d3d2aSXin Li vbr_rate -= 8<<BITRES;
1584*a58d3d2aSXin Li #endif
1585*a58d3d2aSXin Li effectiveBytes = vbr_rate>>(3+BITRES);
1586*a58d3d2aSXin Li } else {
1587*a58d3d2aSXin Li opus_int32 tmp;
1588*a58d3d2aSXin Li vbr_rate = 0;
1589*a58d3d2aSXin Li tmp = st->bitrate*frame_size;
1590*a58d3d2aSXin Li if (tell>1)
1591*a58d3d2aSXin Li tmp += tell*mode->Fs;
1592*a58d3d2aSXin Li if (st->bitrate!=OPUS_BITRATE_MAX)
1593*a58d3d2aSXin Li {
1594*a58d3d2aSXin Li nbCompressedBytes = IMAX(2, IMIN(nbCompressedBytes,
1595*a58d3d2aSXin Li (tmp+4*mode->Fs)/(8*mode->Fs)-!!st->signalling));
1596*a58d3d2aSXin Li ec_enc_shrink(enc, nbCompressedBytes);
1597*a58d3d2aSXin Li }
1598*a58d3d2aSXin Li effectiveBytes = nbCompressedBytes - nbFilledBytes;
1599*a58d3d2aSXin Li }
1600*a58d3d2aSXin Li equiv_rate = ((opus_int32)nbCompressedBytes*8*50 << (3-LM)) - (40*C+20)*((400>>LM) - 50);
1601*a58d3d2aSXin Li if (st->bitrate != OPUS_BITRATE_MAX)
1602*a58d3d2aSXin Li equiv_rate = IMIN(equiv_rate, st->bitrate - (40*C+20)*((400>>LM) - 50));
1603*a58d3d2aSXin Li
1604*a58d3d2aSXin Li if (enc==NULL)
1605*a58d3d2aSXin Li {
1606*a58d3d2aSXin Li ec_enc_init(&_enc, compressed, nbCompressedBytes);
1607*a58d3d2aSXin Li enc = &_enc;
1608*a58d3d2aSXin Li }
1609*a58d3d2aSXin Li
1610*a58d3d2aSXin Li if (vbr_rate>0)
1611*a58d3d2aSXin Li {
1612*a58d3d2aSXin Li /* Computes the max bit-rate allowed in VBR mode to avoid violating the
1613*a58d3d2aSXin Li target rate and buffering.
1614*a58d3d2aSXin Li We must do this up front so that bust-prevention logic triggers
1615*a58d3d2aSXin Li correctly if we don't have enough bits. */
1616*a58d3d2aSXin Li if (st->constrained_vbr)
1617*a58d3d2aSXin Li {
1618*a58d3d2aSXin Li opus_int32 vbr_bound;
1619*a58d3d2aSXin Li opus_int32 max_allowed;
1620*a58d3d2aSXin Li /* We could use any multiple of vbr_rate as bound (depending on the
1621*a58d3d2aSXin Li delay).
1622*a58d3d2aSXin Li This is clamped to ensure we use at least two bytes if the encoder
1623*a58d3d2aSXin Li was entirely empty, but to allow 0 in hybrid mode. */
1624*a58d3d2aSXin Li vbr_bound = vbr_rate;
1625*a58d3d2aSXin Li max_allowed = IMIN(IMAX(tell==1?2:0,
1626*a58d3d2aSXin Li (vbr_rate+vbr_bound-st->vbr_reservoir)>>(BITRES+3)),
1627*a58d3d2aSXin Li nbAvailableBytes);
1628*a58d3d2aSXin Li if(max_allowed < nbAvailableBytes)
1629*a58d3d2aSXin Li {
1630*a58d3d2aSXin Li nbCompressedBytes = nbFilledBytes+max_allowed;
1631*a58d3d2aSXin Li nbAvailableBytes = max_allowed;
1632*a58d3d2aSXin Li ec_enc_shrink(enc, nbCompressedBytes);
1633*a58d3d2aSXin Li }
1634*a58d3d2aSXin Li }
1635*a58d3d2aSXin Li }
1636*a58d3d2aSXin Li total_bits = nbCompressedBytes*8;
1637*a58d3d2aSXin Li
1638*a58d3d2aSXin Li effEnd = end;
1639*a58d3d2aSXin Li if (effEnd > mode->effEBands)
1640*a58d3d2aSXin Li effEnd = mode->effEBands;
1641*a58d3d2aSXin Li
1642*a58d3d2aSXin Li ALLOC(in, CC*(N+overlap), celt_sig);
1643*a58d3d2aSXin Li
1644*a58d3d2aSXin Li sample_max=MAX32(st->overlap_max, celt_maxabs16(pcm, C*(N-overlap)/st->upsample));
1645*a58d3d2aSXin Li st->overlap_max=celt_maxabs16(pcm+C*(N-overlap)/st->upsample, C*overlap/st->upsample);
1646*a58d3d2aSXin Li sample_max=MAX32(sample_max, st->overlap_max);
1647*a58d3d2aSXin Li #ifdef FIXED_POINT
1648*a58d3d2aSXin Li silence = (sample_max==0);
1649*a58d3d2aSXin Li #else
1650*a58d3d2aSXin Li silence = (sample_max <= (opus_val16)1/(1<<st->lsb_depth));
1651*a58d3d2aSXin Li #endif
1652*a58d3d2aSXin Li #ifdef FUZZING
1653*a58d3d2aSXin Li if ((rand()&0x3F)==0)
1654*a58d3d2aSXin Li silence = 1;
1655*a58d3d2aSXin Li #endif
1656*a58d3d2aSXin Li if (tell==1)
1657*a58d3d2aSXin Li ec_enc_bit_logp(enc, silence, 15);
1658*a58d3d2aSXin Li else
1659*a58d3d2aSXin Li silence=0;
1660*a58d3d2aSXin Li if (silence)
1661*a58d3d2aSXin Li {
1662*a58d3d2aSXin Li /*In VBR mode there is no need to send more than the minimum. */
1663*a58d3d2aSXin Li if (vbr_rate>0)
1664*a58d3d2aSXin Li {
1665*a58d3d2aSXin Li effectiveBytes=nbCompressedBytes=IMIN(nbCompressedBytes, nbFilledBytes+2);
1666*a58d3d2aSXin Li total_bits=nbCompressedBytes*8;
1667*a58d3d2aSXin Li nbAvailableBytes=2;
1668*a58d3d2aSXin Li ec_enc_shrink(enc, nbCompressedBytes);
1669*a58d3d2aSXin Li }
1670*a58d3d2aSXin Li /* Pretend we've filled all the remaining bits with zeros
1671*a58d3d2aSXin Li (that's what the initialiser did anyway) */
1672*a58d3d2aSXin Li tell = nbCompressedBytes*8;
1673*a58d3d2aSXin Li enc->nbits_total+=tell-ec_tell(enc);
1674*a58d3d2aSXin Li }
1675*a58d3d2aSXin Li c=0; do {
1676*a58d3d2aSXin Li int need_clip=0;
1677*a58d3d2aSXin Li #ifndef FIXED_POINT
1678*a58d3d2aSXin Li need_clip = st->clip && sample_max>65536.f;
1679*a58d3d2aSXin Li #endif
1680*a58d3d2aSXin Li celt_preemphasis(pcm+c, in+c*(N+overlap)+overlap, N, CC, st->upsample,
1681*a58d3d2aSXin Li mode->preemph, st->preemph_memE+c, need_clip);
1682*a58d3d2aSXin Li } while (++c<CC);
1683*a58d3d2aSXin Li
1684*a58d3d2aSXin Li
1685*a58d3d2aSXin Li
1686*a58d3d2aSXin Li /* Find pitch period and gain */
1687*a58d3d2aSXin Li {
1688*a58d3d2aSXin Li int enabled;
1689*a58d3d2aSXin Li int qg;
1690*a58d3d2aSXin Li enabled = ((st->lfe&&nbAvailableBytes>3) || nbAvailableBytes>12*C) && !hybrid && !silence && !st->disable_pf
1691*a58d3d2aSXin Li && st->complexity >= 5;
1692*a58d3d2aSXin Li
1693*a58d3d2aSXin Li prefilter_tapset = st->tapset_decision;
1694*a58d3d2aSXin Li pf_on = run_prefilter(st, in, prefilter_mem, CC, N, prefilter_tapset, &pitch_index, &gain1, &qg, enabled, nbAvailableBytes, &st->analysis);
1695*a58d3d2aSXin Li if ((gain1 > QCONST16(.4f,15) || st->prefilter_gain > QCONST16(.4f,15)) && (!st->analysis.valid || st->analysis.tonality > .3)
1696*a58d3d2aSXin Li && (pitch_index > 1.26*st->prefilter_period || pitch_index < .79*st->prefilter_period))
1697*a58d3d2aSXin Li pitch_change = 1;
1698*a58d3d2aSXin Li if (pf_on==0)
1699*a58d3d2aSXin Li {
1700*a58d3d2aSXin Li if(!hybrid && tell+16<=total_bits)
1701*a58d3d2aSXin Li ec_enc_bit_logp(enc, 0, 1);
1702*a58d3d2aSXin Li } else {
1703*a58d3d2aSXin Li /*This block is not gated by a total bits check only because
1704*a58d3d2aSXin Li of the nbAvailableBytes check above.*/
1705*a58d3d2aSXin Li int octave;
1706*a58d3d2aSXin Li ec_enc_bit_logp(enc, 1, 1);
1707*a58d3d2aSXin Li pitch_index += 1;
1708*a58d3d2aSXin Li octave = EC_ILOG(pitch_index)-5;
1709*a58d3d2aSXin Li ec_enc_uint(enc, octave, 6);
1710*a58d3d2aSXin Li ec_enc_bits(enc, pitch_index-(16<<octave), 4+octave);
1711*a58d3d2aSXin Li pitch_index -= 1;
1712*a58d3d2aSXin Li ec_enc_bits(enc, qg, 3);
1713*a58d3d2aSXin Li ec_enc_icdf(enc, prefilter_tapset, tapset_icdf, 2);
1714*a58d3d2aSXin Li }
1715*a58d3d2aSXin Li }
1716*a58d3d2aSXin Li
1717*a58d3d2aSXin Li isTransient = 0;
1718*a58d3d2aSXin Li shortBlocks = 0;
1719*a58d3d2aSXin Li if (st->complexity >= 1 && !st->lfe)
1720*a58d3d2aSXin Li {
1721*a58d3d2aSXin Li /* Reduces the likelihood of energy instability on fricatives at low bitrate
1722*a58d3d2aSXin Li in hybrid mode. It seems like we still want to have real transients on vowels
1723*a58d3d2aSXin Li though (small SILK quantization offset value). */
1724*a58d3d2aSXin Li int allow_weak_transients = hybrid && effectiveBytes<15 && st->silk_info.signalType != 2;
1725*a58d3d2aSXin Li isTransient = transient_analysis(in, N+overlap, CC,
1726*a58d3d2aSXin Li &tf_estimate, &tf_chan, allow_weak_transients, &weak_transient);
1727*a58d3d2aSXin Li }
1728*a58d3d2aSXin Li if (LM>0 && ec_tell(enc)+3<=total_bits)
1729*a58d3d2aSXin Li {
1730*a58d3d2aSXin Li if (isTransient)
1731*a58d3d2aSXin Li shortBlocks = M;
1732*a58d3d2aSXin Li } else {
1733*a58d3d2aSXin Li isTransient = 0;
1734*a58d3d2aSXin Li transient_got_disabled=1;
1735*a58d3d2aSXin Li }
1736*a58d3d2aSXin Li
1737*a58d3d2aSXin Li ALLOC(freq, CC*N, celt_sig); /**< Interleaved signal MDCTs */
1738*a58d3d2aSXin Li ALLOC(bandE,nbEBands*CC, celt_ener);
1739*a58d3d2aSXin Li ALLOC(bandLogE,nbEBands*CC, opus_val16);
1740*a58d3d2aSXin Li
1741*a58d3d2aSXin Li secondMdct = shortBlocks && st->complexity>=8;
1742*a58d3d2aSXin Li ALLOC(bandLogE2, C*nbEBands, opus_val16);
1743*a58d3d2aSXin Li if (secondMdct)
1744*a58d3d2aSXin Li {
1745*a58d3d2aSXin Li compute_mdcts(mode, 0, in, freq, C, CC, LM, st->upsample, st->arch);
1746*a58d3d2aSXin Li compute_band_energies(mode, freq, bandE, effEnd, C, LM, st->arch);
1747*a58d3d2aSXin Li amp2Log2(mode, effEnd, end, bandE, bandLogE2, C);
1748*a58d3d2aSXin Li for (c=0;c<C;c++)
1749*a58d3d2aSXin Li {
1750*a58d3d2aSXin Li for (i=0;i<end;i++)
1751*a58d3d2aSXin Li bandLogE2[nbEBands*c+i] += HALF16(SHL16(LM, DB_SHIFT));
1752*a58d3d2aSXin Li }
1753*a58d3d2aSXin Li }
1754*a58d3d2aSXin Li
1755*a58d3d2aSXin Li compute_mdcts(mode, shortBlocks, in, freq, C, CC, LM, st->upsample, st->arch);
1756*a58d3d2aSXin Li /* This should catch any NaN in the CELT input. Since we're not supposed to see any (they're filtered
1757*a58d3d2aSXin Li at the Opus layer), just abort. */
1758*a58d3d2aSXin Li celt_assert(!celt_isnan(freq[0]) && (C==1 || !celt_isnan(freq[N])));
1759*a58d3d2aSXin Li if (CC==2&&C==1)
1760*a58d3d2aSXin Li tf_chan = 0;
1761*a58d3d2aSXin Li compute_band_energies(mode, freq, bandE, effEnd, C, LM, st->arch);
1762*a58d3d2aSXin Li
1763*a58d3d2aSXin Li if (st->lfe)
1764*a58d3d2aSXin Li {
1765*a58d3d2aSXin Li for (i=2;i<end;i++)
1766*a58d3d2aSXin Li {
1767*a58d3d2aSXin Li bandE[i] = IMIN(bandE[i], MULT16_32_Q15(QCONST16(1e-4f,15),bandE[0]));
1768*a58d3d2aSXin Li bandE[i] = MAX32(bandE[i], EPSILON);
1769*a58d3d2aSXin Li }
1770*a58d3d2aSXin Li }
1771*a58d3d2aSXin Li amp2Log2(mode, effEnd, end, bandE, bandLogE, C);
1772*a58d3d2aSXin Li
1773*a58d3d2aSXin Li ALLOC(surround_dynalloc, C*nbEBands, opus_val16);
1774*a58d3d2aSXin Li OPUS_CLEAR(surround_dynalloc, end);
1775*a58d3d2aSXin Li /* This computes how much masking takes place between surround channels */
1776*a58d3d2aSXin Li if (!hybrid&&st->energy_mask&&!st->lfe)
1777*a58d3d2aSXin Li {
1778*a58d3d2aSXin Li int mask_end;
1779*a58d3d2aSXin Li int midband;
1780*a58d3d2aSXin Li int count_dynalloc;
1781*a58d3d2aSXin Li opus_val32 mask_avg=0;
1782*a58d3d2aSXin Li opus_val32 diff=0;
1783*a58d3d2aSXin Li int count=0;
1784*a58d3d2aSXin Li mask_end = IMAX(2,st->lastCodedBands);
1785*a58d3d2aSXin Li for (c=0;c<C;c++)
1786*a58d3d2aSXin Li {
1787*a58d3d2aSXin Li for(i=0;i<mask_end;i++)
1788*a58d3d2aSXin Li {
1789*a58d3d2aSXin Li opus_val16 mask;
1790*a58d3d2aSXin Li mask = MAX16(MIN16(st->energy_mask[nbEBands*c+i],
1791*a58d3d2aSXin Li QCONST16(.25f, DB_SHIFT)), -QCONST16(2.0f, DB_SHIFT));
1792*a58d3d2aSXin Li if (mask > 0)
1793*a58d3d2aSXin Li mask = HALF16(mask);
1794*a58d3d2aSXin Li mask_avg += MULT16_16(mask, eBands[i+1]-eBands[i]);
1795*a58d3d2aSXin Li count += eBands[i+1]-eBands[i];
1796*a58d3d2aSXin Li diff += MULT16_16(mask, 1+2*i-mask_end);
1797*a58d3d2aSXin Li }
1798*a58d3d2aSXin Li }
1799*a58d3d2aSXin Li celt_assert(count>0);
1800*a58d3d2aSXin Li mask_avg = DIV32_16(mask_avg,count);
1801*a58d3d2aSXin Li mask_avg += QCONST16(.2f, DB_SHIFT);
1802*a58d3d2aSXin Li diff = diff*6/(C*(mask_end-1)*(mask_end+1)*mask_end);
1803*a58d3d2aSXin Li /* Again, being conservative */
1804*a58d3d2aSXin Li diff = HALF32(diff);
1805*a58d3d2aSXin Li diff = MAX32(MIN32(diff, QCONST32(.031f, DB_SHIFT)), -QCONST32(.031f, DB_SHIFT));
1806*a58d3d2aSXin Li /* Find the band that's in the middle of the coded spectrum */
1807*a58d3d2aSXin Li for (midband=0;eBands[midband+1] < eBands[mask_end]/2;midband++);
1808*a58d3d2aSXin Li count_dynalloc=0;
1809*a58d3d2aSXin Li for(i=0;i<mask_end;i++)
1810*a58d3d2aSXin Li {
1811*a58d3d2aSXin Li opus_val32 lin;
1812*a58d3d2aSXin Li opus_val16 unmask;
1813*a58d3d2aSXin Li lin = mask_avg + diff*(i-midband);
1814*a58d3d2aSXin Li if (C==2)
1815*a58d3d2aSXin Li unmask = MAX16(st->energy_mask[i], st->energy_mask[nbEBands+i]);
1816*a58d3d2aSXin Li else
1817*a58d3d2aSXin Li unmask = st->energy_mask[i];
1818*a58d3d2aSXin Li unmask = MIN16(unmask, QCONST16(.0f, DB_SHIFT));
1819*a58d3d2aSXin Li unmask -= lin;
1820*a58d3d2aSXin Li if (unmask > QCONST16(.25f, DB_SHIFT))
1821*a58d3d2aSXin Li {
1822*a58d3d2aSXin Li surround_dynalloc[i] = unmask - QCONST16(.25f, DB_SHIFT);
1823*a58d3d2aSXin Li count_dynalloc++;
1824*a58d3d2aSXin Li }
1825*a58d3d2aSXin Li }
1826*a58d3d2aSXin Li if (count_dynalloc>=3)
1827*a58d3d2aSXin Li {
1828*a58d3d2aSXin Li /* If we need dynalloc in many bands, it's probably because our
1829*a58d3d2aSXin Li initial masking rate was too low. */
1830*a58d3d2aSXin Li mask_avg += QCONST16(.25f, DB_SHIFT);
1831*a58d3d2aSXin Li if (mask_avg>0)
1832*a58d3d2aSXin Li {
1833*a58d3d2aSXin Li /* Something went really wrong in the original calculations,
1834*a58d3d2aSXin Li disabling masking. */
1835*a58d3d2aSXin Li mask_avg = 0;
1836*a58d3d2aSXin Li diff = 0;
1837*a58d3d2aSXin Li OPUS_CLEAR(surround_dynalloc, mask_end);
1838*a58d3d2aSXin Li } else {
1839*a58d3d2aSXin Li for(i=0;i<mask_end;i++)
1840*a58d3d2aSXin Li surround_dynalloc[i] = MAX16(0, surround_dynalloc[i]-QCONST16(.25f, DB_SHIFT));
1841*a58d3d2aSXin Li }
1842*a58d3d2aSXin Li }
1843*a58d3d2aSXin Li mask_avg += QCONST16(.2f, DB_SHIFT);
1844*a58d3d2aSXin Li /* Convert to 1/64th units used for the trim */
1845*a58d3d2aSXin Li surround_trim = 64*diff;
1846*a58d3d2aSXin Li /*printf("%d %d ", mask_avg, surround_trim);*/
1847*a58d3d2aSXin Li surround_masking = mask_avg;
1848*a58d3d2aSXin Li }
1849*a58d3d2aSXin Li /* Temporal VBR (but not for LFE) */
1850*a58d3d2aSXin Li if (!st->lfe)
1851*a58d3d2aSXin Li {
1852*a58d3d2aSXin Li opus_val16 follow=-QCONST16(10.0f,DB_SHIFT);
1853*a58d3d2aSXin Li opus_val32 frame_avg=0;
1854*a58d3d2aSXin Li opus_val16 offset = shortBlocks?HALF16(SHL16(LM, DB_SHIFT)):0;
1855*a58d3d2aSXin Li for(i=start;i<end;i++)
1856*a58d3d2aSXin Li {
1857*a58d3d2aSXin Li follow = MAX16(follow-QCONST16(1.f, DB_SHIFT), bandLogE[i]-offset);
1858*a58d3d2aSXin Li if (C==2)
1859*a58d3d2aSXin Li follow = MAX16(follow, bandLogE[i+nbEBands]-offset);
1860*a58d3d2aSXin Li frame_avg += follow;
1861*a58d3d2aSXin Li }
1862*a58d3d2aSXin Li frame_avg /= (end-start);
1863*a58d3d2aSXin Li temporal_vbr = SUB16(frame_avg,st->spec_avg);
1864*a58d3d2aSXin Li temporal_vbr = MIN16(QCONST16(3.f, DB_SHIFT), MAX16(-QCONST16(1.5f, DB_SHIFT), temporal_vbr));
1865*a58d3d2aSXin Li st->spec_avg += MULT16_16_Q15(QCONST16(.02f, 15), temporal_vbr);
1866*a58d3d2aSXin Li }
1867*a58d3d2aSXin Li /*for (i=0;i<21;i++)
1868*a58d3d2aSXin Li printf("%f ", bandLogE[i]);
1869*a58d3d2aSXin Li printf("\n");*/
1870*a58d3d2aSXin Li
1871*a58d3d2aSXin Li if (!secondMdct)
1872*a58d3d2aSXin Li {
1873*a58d3d2aSXin Li OPUS_COPY(bandLogE2, bandLogE, C*nbEBands);
1874*a58d3d2aSXin Li }
1875*a58d3d2aSXin Li
1876*a58d3d2aSXin Li /* Last chance to catch any transient we might have missed in the
1877*a58d3d2aSXin Li time-domain analysis */
1878*a58d3d2aSXin Li if (LM>0 && ec_tell(enc)+3<=total_bits && !isTransient && st->complexity>=5 && !st->lfe && !hybrid)
1879*a58d3d2aSXin Li {
1880*a58d3d2aSXin Li if (patch_transient_decision(bandLogE, oldBandE, nbEBands, start, end, C))
1881*a58d3d2aSXin Li {
1882*a58d3d2aSXin Li isTransient = 1;
1883*a58d3d2aSXin Li shortBlocks = M;
1884*a58d3d2aSXin Li compute_mdcts(mode, shortBlocks, in, freq, C, CC, LM, st->upsample, st->arch);
1885*a58d3d2aSXin Li compute_band_energies(mode, freq, bandE, effEnd, C, LM, st->arch);
1886*a58d3d2aSXin Li amp2Log2(mode, effEnd, end, bandE, bandLogE, C);
1887*a58d3d2aSXin Li /* Compensate for the scaling of short vs long mdcts */
1888*a58d3d2aSXin Li for (c=0;c<C;c++)
1889*a58d3d2aSXin Li {
1890*a58d3d2aSXin Li for (i=0;i<end;i++)
1891*a58d3d2aSXin Li bandLogE2[nbEBands*c+i] += HALF16(SHL16(LM, DB_SHIFT));
1892*a58d3d2aSXin Li }
1893*a58d3d2aSXin Li tf_estimate = QCONST16(.2f,14);
1894*a58d3d2aSXin Li }
1895*a58d3d2aSXin Li }
1896*a58d3d2aSXin Li
1897*a58d3d2aSXin Li if (LM>0 && ec_tell(enc)+3<=total_bits)
1898*a58d3d2aSXin Li ec_enc_bit_logp(enc, isTransient, 3);
1899*a58d3d2aSXin Li
1900*a58d3d2aSXin Li ALLOC(X, C*N, celt_norm); /**< Interleaved normalised MDCTs */
1901*a58d3d2aSXin Li
1902*a58d3d2aSXin Li /* Band normalisation */
1903*a58d3d2aSXin Li normalise_bands(mode, freq, X, bandE, effEnd, C, M);
1904*a58d3d2aSXin Li
1905*a58d3d2aSXin Li enable_tf_analysis = effectiveBytes>=15*C && !hybrid && st->complexity>=2 && !st->lfe;
1906*a58d3d2aSXin Li
1907*a58d3d2aSXin Li ALLOC(offsets, nbEBands, int);
1908*a58d3d2aSXin Li ALLOC(importance, nbEBands, int);
1909*a58d3d2aSXin Li ALLOC(spread_weight, nbEBands, int);
1910*a58d3d2aSXin Li
1911*a58d3d2aSXin Li maxDepth = dynalloc_analysis(bandLogE, bandLogE2, oldBandE, nbEBands, start, end, C, offsets,
1912*a58d3d2aSXin Li st->lsb_depth, mode->logN, isTransient, st->vbr, st->constrained_vbr,
1913*a58d3d2aSXin Li eBands, LM, effectiveBytes, &tot_boost, st->lfe, surround_dynalloc, &st->analysis, importance, spread_weight);
1914*a58d3d2aSXin Li
1915*a58d3d2aSXin Li ALLOC(tf_res, nbEBands, int);
1916*a58d3d2aSXin Li /* Disable variable tf resolution for hybrid and at very low bitrate */
1917*a58d3d2aSXin Li if (enable_tf_analysis)
1918*a58d3d2aSXin Li {
1919*a58d3d2aSXin Li int lambda;
1920*a58d3d2aSXin Li lambda = IMAX(80, 20480/effectiveBytes + 2);
1921*a58d3d2aSXin Li tf_select = tf_analysis(mode, effEnd, isTransient, tf_res, lambda, X, N, LM, tf_estimate, tf_chan, importance);
1922*a58d3d2aSXin Li for (i=effEnd;i<end;i++)
1923*a58d3d2aSXin Li tf_res[i] = tf_res[effEnd-1];
1924*a58d3d2aSXin Li } else if (hybrid && weak_transient)
1925*a58d3d2aSXin Li {
1926*a58d3d2aSXin Li /* For weak transients, we rely on the fact that improving time resolution using
1927*a58d3d2aSXin Li TF on a long window is imperfect and will not result in an energy collapse at
1928*a58d3d2aSXin Li low bitrate. */
1929*a58d3d2aSXin Li for (i=0;i<end;i++)
1930*a58d3d2aSXin Li tf_res[i] = 1;
1931*a58d3d2aSXin Li tf_select=0;
1932*a58d3d2aSXin Li } else if (hybrid && effectiveBytes<15 && st->silk_info.signalType != 2)
1933*a58d3d2aSXin Li {
1934*a58d3d2aSXin Li /* For low bitrate hybrid, we force temporal resolution to 5 ms rather than 2.5 ms. */
1935*a58d3d2aSXin Li for (i=0;i<end;i++)
1936*a58d3d2aSXin Li tf_res[i] = 0;
1937*a58d3d2aSXin Li tf_select=isTransient;
1938*a58d3d2aSXin Li } else {
1939*a58d3d2aSXin Li for (i=0;i<end;i++)
1940*a58d3d2aSXin Li tf_res[i] = isTransient;
1941*a58d3d2aSXin Li tf_select=0;
1942*a58d3d2aSXin Li }
1943*a58d3d2aSXin Li
1944*a58d3d2aSXin Li ALLOC(error, C*nbEBands, opus_val16);
1945*a58d3d2aSXin Li c=0;
1946*a58d3d2aSXin Li do {
1947*a58d3d2aSXin Li for (i=start;i<end;i++)
1948*a58d3d2aSXin Li {
1949*a58d3d2aSXin Li /* When the energy is stable, slightly bias energy quantization towards
1950*a58d3d2aSXin Li the previous error to make the gain more stable (a constant offset is
1951*a58d3d2aSXin Li better than fluctuations). */
1952*a58d3d2aSXin Li if (ABS32(SUB32(bandLogE[i+c*nbEBands], oldBandE[i+c*nbEBands])) < QCONST16(2.f, DB_SHIFT))
1953*a58d3d2aSXin Li {
1954*a58d3d2aSXin Li bandLogE[i+c*nbEBands] -= MULT16_16_Q15(energyError[i+c*nbEBands], QCONST16(0.25f, 15));
1955*a58d3d2aSXin Li }
1956*a58d3d2aSXin Li }
1957*a58d3d2aSXin Li } while (++c < C);
1958*a58d3d2aSXin Li quant_coarse_energy(mode, start, end, effEnd, bandLogE,
1959*a58d3d2aSXin Li oldBandE, total_bits, error, enc,
1960*a58d3d2aSXin Li C, LM, nbAvailableBytes, st->force_intra,
1961*a58d3d2aSXin Li &st->delayedIntra, st->complexity >= 4, st->loss_rate, st->lfe);
1962*a58d3d2aSXin Li
1963*a58d3d2aSXin Li tf_encode(start, end, isTransient, tf_res, LM, tf_select, enc);
1964*a58d3d2aSXin Li
1965*a58d3d2aSXin Li if (ec_tell(enc)+4<=total_bits)
1966*a58d3d2aSXin Li {
1967*a58d3d2aSXin Li if (st->lfe)
1968*a58d3d2aSXin Li {
1969*a58d3d2aSXin Li st->tapset_decision = 0;
1970*a58d3d2aSXin Li st->spread_decision = SPREAD_NORMAL;
1971*a58d3d2aSXin Li } else if (hybrid)
1972*a58d3d2aSXin Li {
1973*a58d3d2aSXin Li if (st->complexity == 0)
1974*a58d3d2aSXin Li st->spread_decision = SPREAD_NONE;
1975*a58d3d2aSXin Li else if (isTransient)
1976*a58d3d2aSXin Li st->spread_decision = SPREAD_NORMAL;
1977*a58d3d2aSXin Li else
1978*a58d3d2aSXin Li st->spread_decision = SPREAD_AGGRESSIVE;
1979*a58d3d2aSXin Li } else if (shortBlocks || st->complexity < 3 || nbAvailableBytes < 10*C)
1980*a58d3d2aSXin Li {
1981*a58d3d2aSXin Li if (st->complexity == 0)
1982*a58d3d2aSXin Li st->spread_decision = SPREAD_NONE;
1983*a58d3d2aSXin Li else
1984*a58d3d2aSXin Li st->spread_decision = SPREAD_NORMAL;
1985*a58d3d2aSXin Li } else {
1986*a58d3d2aSXin Li /* Disable new spreading+tapset estimator until we can show it works
1987*a58d3d2aSXin Li better than the old one. So far it seems like spreading_decision()
1988*a58d3d2aSXin Li works best. */
1989*a58d3d2aSXin Li #if 0
1990*a58d3d2aSXin Li if (st->analysis.valid)
1991*a58d3d2aSXin Li {
1992*a58d3d2aSXin Li static const opus_val16 spread_thresholds[3] = {-QCONST16(.6f, 15), -QCONST16(.2f, 15), -QCONST16(.07f, 15)};
1993*a58d3d2aSXin Li static const opus_val16 spread_histeresis[3] = {QCONST16(.15f, 15), QCONST16(.07f, 15), QCONST16(.02f, 15)};
1994*a58d3d2aSXin Li static const opus_val16 tapset_thresholds[2] = {QCONST16(.0f, 15), QCONST16(.15f, 15)};
1995*a58d3d2aSXin Li static const opus_val16 tapset_histeresis[2] = {QCONST16(.1f, 15), QCONST16(.05f, 15)};
1996*a58d3d2aSXin Li st->spread_decision = hysteresis_decision(-st->analysis.tonality, spread_thresholds, spread_histeresis, 3, st->spread_decision);
1997*a58d3d2aSXin Li st->tapset_decision = hysteresis_decision(st->analysis.tonality_slope, tapset_thresholds, tapset_histeresis, 2, st->tapset_decision);
1998*a58d3d2aSXin Li } else
1999*a58d3d2aSXin Li #endif
2000*a58d3d2aSXin Li {
2001*a58d3d2aSXin Li st->spread_decision = spreading_decision(mode, X,
2002*a58d3d2aSXin Li &st->tonal_average, st->spread_decision, &st->hf_average,
2003*a58d3d2aSXin Li &st->tapset_decision, pf_on&&!shortBlocks, effEnd, C, M, spread_weight);
2004*a58d3d2aSXin Li }
2005*a58d3d2aSXin Li /*printf("%d %d\n", st->tapset_decision, st->spread_decision);*/
2006*a58d3d2aSXin Li /*printf("%f %d %f %d\n\n", st->analysis.tonality, st->spread_decision, st->analysis.tonality_slope, st->tapset_decision);*/
2007*a58d3d2aSXin Li }
2008*a58d3d2aSXin Li ec_enc_icdf(enc, st->spread_decision, spread_icdf, 5);
2009*a58d3d2aSXin Li }
2010*a58d3d2aSXin Li
2011*a58d3d2aSXin Li /* For LFE, everything interesting is in the first band */
2012*a58d3d2aSXin Li if (st->lfe)
2013*a58d3d2aSXin Li offsets[0] = IMIN(8, effectiveBytes/3);
2014*a58d3d2aSXin Li ALLOC(cap, nbEBands, int);
2015*a58d3d2aSXin Li init_caps(mode,cap,LM,C);
2016*a58d3d2aSXin Li
2017*a58d3d2aSXin Li dynalloc_logp = 6;
2018*a58d3d2aSXin Li total_bits<<=BITRES;
2019*a58d3d2aSXin Li total_boost = 0;
2020*a58d3d2aSXin Li tell = ec_tell_frac(enc);
2021*a58d3d2aSXin Li for (i=start;i<end;i++)
2022*a58d3d2aSXin Li {
2023*a58d3d2aSXin Li int width, quanta;
2024*a58d3d2aSXin Li int dynalloc_loop_logp;
2025*a58d3d2aSXin Li int boost;
2026*a58d3d2aSXin Li int j;
2027*a58d3d2aSXin Li width = C*(eBands[i+1]-eBands[i])<<LM;
2028*a58d3d2aSXin Li /* quanta is 6 bits, but no more than 1 bit/sample
2029*a58d3d2aSXin Li and no less than 1/8 bit/sample */
2030*a58d3d2aSXin Li quanta = IMIN(width<<BITRES, IMAX(6<<BITRES, width));
2031*a58d3d2aSXin Li dynalloc_loop_logp = dynalloc_logp;
2032*a58d3d2aSXin Li boost = 0;
2033*a58d3d2aSXin Li for (j = 0; tell+(dynalloc_loop_logp<<BITRES) < total_bits-total_boost
2034*a58d3d2aSXin Li && boost < cap[i]; j++)
2035*a58d3d2aSXin Li {
2036*a58d3d2aSXin Li int flag;
2037*a58d3d2aSXin Li flag = j<offsets[i];
2038*a58d3d2aSXin Li ec_enc_bit_logp(enc, flag, dynalloc_loop_logp);
2039*a58d3d2aSXin Li tell = ec_tell_frac(enc);
2040*a58d3d2aSXin Li if (!flag)
2041*a58d3d2aSXin Li break;
2042*a58d3d2aSXin Li boost += quanta;
2043*a58d3d2aSXin Li total_boost += quanta;
2044*a58d3d2aSXin Li dynalloc_loop_logp = 1;
2045*a58d3d2aSXin Li }
2046*a58d3d2aSXin Li /* Making dynalloc more likely */
2047*a58d3d2aSXin Li if (j)
2048*a58d3d2aSXin Li dynalloc_logp = IMAX(2, dynalloc_logp-1);
2049*a58d3d2aSXin Li offsets[i] = boost;
2050*a58d3d2aSXin Li }
2051*a58d3d2aSXin Li
2052*a58d3d2aSXin Li if (C==2)
2053*a58d3d2aSXin Li {
2054*a58d3d2aSXin Li static const opus_val16 intensity_thresholds[21]=
2055*a58d3d2aSXin Li /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 off*/
2056*a58d3d2aSXin Li { 1, 2, 3, 4, 5, 6, 7, 8,16,24,36,44,50,56,62,67,72,79,88,106,134};
2057*a58d3d2aSXin Li static const opus_val16 intensity_histeresis[21]=
2058*a58d3d2aSXin Li { 1, 1, 1, 1, 1, 1, 1, 2, 2, 2, 2, 2, 2, 2, 3, 3, 4, 5, 6, 8, 8};
2059*a58d3d2aSXin Li
2060*a58d3d2aSXin Li /* Always use MS for 2.5 ms frames until we can do a better analysis */
2061*a58d3d2aSXin Li if (LM!=0)
2062*a58d3d2aSXin Li dual_stereo = stereo_analysis(mode, X, LM, N);
2063*a58d3d2aSXin Li
2064*a58d3d2aSXin Li st->intensity = hysteresis_decision((opus_val16)(equiv_rate/1000),
2065*a58d3d2aSXin Li intensity_thresholds, intensity_histeresis, 21, st->intensity);
2066*a58d3d2aSXin Li st->intensity = IMIN(end,IMAX(start, st->intensity));
2067*a58d3d2aSXin Li }
2068*a58d3d2aSXin Li
2069*a58d3d2aSXin Li alloc_trim = 5;
2070*a58d3d2aSXin Li if (tell+(6<<BITRES) <= total_bits - total_boost)
2071*a58d3d2aSXin Li {
2072*a58d3d2aSXin Li if (start > 0 || st->lfe)
2073*a58d3d2aSXin Li {
2074*a58d3d2aSXin Li st->stereo_saving = 0;
2075*a58d3d2aSXin Li alloc_trim = 5;
2076*a58d3d2aSXin Li } else {
2077*a58d3d2aSXin Li alloc_trim = alloc_trim_analysis(mode, X, bandLogE,
2078*a58d3d2aSXin Li end, LM, C, N, &st->analysis, &st->stereo_saving, tf_estimate,
2079*a58d3d2aSXin Li st->intensity, surround_trim, equiv_rate, st->arch);
2080*a58d3d2aSXin Li }
2081*a58d3d2aSXin Li ec_enc_icdf(enc, alloc_trim, trim_icdf, 7);
2082*a58d3d2aSXin Li tell = ec_tell_frac(enc);
2083*a58d3d2aSXin Li }
2084*a58d3d2aSXin Li
2085*a58d3d2aSXin Li /* Variable bitrate */
2086*a58d3d2aSXin Li if (vbr_rate>0)
2087*a58d3d2aSXin Li {
2088*a58d3d2aSXin Li opus_val16 alpha;
2089*a58d3d2aSXin Li opus_int32 delta;
2090*a58d3d2aSXin Li /* The target rate in 8th bits per frame */
2091*a58d3d2aSXin Li opus_int32 target, base_target;
2092*a58d3d2aSXin Li opus_int32 min_allowed;
2093*a58d3d2aSXin Li int lm_diff = mode->maxLM - LM;
2094*a58d3d2aSXin Li
2095*a58d3d2aSXin Li /* Don't attempt to use more than 510 kb/s, even for frames smaller than 20 ms.
2096*a58d3d2aSXin Li The CELT allocator will just not be able to use more than that anyway. */
2097*a58d3d2aSXin Li nbCompressedBytes = IMIN(nbCompressedBytes,1275>>(3-LM));
2098*a58d3d2aSXin Li if (!hybrid)
2099*a58d3d2aSXin Li {
2100*a58d3d2aSXin Li base_target = vbr_rate - ((40*C+20)<<BITRES);
2101*a58d3d2aSXin Li } else {
2102*a58d3d2aSXin Li base_target = IMAX(0, vbr_rate - ((9*C+4)<<BITRES));
2103*a58d3d2aSXin Li }
2104*a58d3d2aSXin Li
2105*a58d3d2aSXin Li if (st->constrained_vbr)
2106*a58d3d2aSXin Li base_target += (st->vbr_offset>>lm_diff);
2107*a58d3d2aSXin Li
2108*a58d3d2aSXin Li if (!hybrid)
2109*a58d3d2aSXin Li {
2110*a58d3d2aSXin Li target = compute_vbr(mode, &st->analysis, base_target, LM, equiv_rate,
2111*a58d3d2aSXin Li st->lastCodedBands, C, st->intensity, st->constrained_vbr,
2112*a58d3d2aSXin Li st->stereo_saving, tot_boost, tf_estimate, pitch_change, maxDepth,
2113*a58d3d2aSXin Li st->lfe, st->energy_mask!=NULL, surround_masking,
2114*a58d3d2aSXin Li temporal_vbr);
2115*a58d3d2aSXin Li } else {
2116*a58d3d2aSXin Li target = base_target;
2117*a58d3d2aSXin Li /* Tonal frames (offset<100) need more bits than noisy (offset>100) ones. */
2118*a58d3d2aSXin Li if (st->silk_info.offset < 100) target += 12 << BITRES >> (3-LM);
2119*a58d3d2aSXin Li if (st->silk_info.offset > 100) target -= 18 << BITRES >> (3-LM);
2120*a58d3d2aSXin Li /* Boosting bitrate on transients and vowels with significant temporal
2121*a58d3d2aSXin Li spikes. */
2122*a58d3d2aSXin Li target += (opus_int32)MULT16_16_Q14(tf_estimate-QCONST16(.25f,14), (50<<BITRES));
2123*a58d3d2aSXin Li /* If we have a strong transient, let's make sure it has enough bits to code
2124*a58d3d2aSXin Li the first two bands, so that it can use folding rather than noise. */
2125*a58d3d2aSXin Li if (tf_estimate > QCONST16(.7f,14))
2126*a58d3d2aSXin Li target = IMAX(target, 50<<BITRES);
2127*a58d3d2aSXin Li }
2128*a58d3d2aSXin Li /* The current offset is removed from the target and the space used
2129*a58d3d2aSXin Li so far is added*/
2130*a58d3d2aSXin Li target=target+tell;
2131*a58d3d2aSXin Li /* In VBR mode the frame size must not be reduced so much that it would
2132*a58d3d2aSXin Li result in the encoder running out of bits.
2133*a58d3d2aSXin Li The margin of 2 bytes ensures that none of the bust-prevention logic
2134*a58d3d2aSXin Li in the decoder will have triggered so far. */
2135*a58d3d2aSXin Li min_allowed = ((tell+total_boost+(1<<(BITRES+3))-1)>>(BITRES+3)) + 2;
2136*a58d3d2aSXin Li /* Take into account the 37 bits we need to have left in the packet to
2137*a58d3d2aSXin Li signal a redundant frame in hybrid mode. Creating a shorter packet would
2138*a58d3d2aSXin Li create an entropy coder desync. */
2139*a58d3d2aSXin Li if (hybrid)
2140*a58d3d2aSXin Li min_allowed = IMAX(min_allowed, (tell0_frac+(37<<BITRES)+total_boost+(1<<(BITRES+3))-1)>>(BITRES+3));
2141*a58d3d2aSXin Li
2142*a58d3d2aSXin Li nbAvailableBytes = (target+(1<<(BITRES+2)))>>(BITRES+3);
2143*a58d3d2aSXin Li nbAvailableBytes = IMAX(min_allowed,nbAvailableBytes);
2144*a58d3d2aSXin Li nbAvailableBytes = IMIN(nbCompressedBytes,nbAvailableBytes);
2145*a58d3d2aSXin Li
2146*a58d3d2aSXin Li /* By how much did we "miss" the target on that frame */
2147*a58d3d2aSXin Li delta = target - vbr_rate;
2148*a58d3d2aSXin Li
2149*a58d3d2aSXin Li target=nbAvailableBytes<<(BITRES+3);
2150*a58d3d2aSXin Li
2151*a58d3d2aSXin Li /*If the frame is silent we don't adjust our drift, otherwise
2152*a58d3d2aSXin Li the encoder will shoot to very high rates after hitting a
2153*a58d3d2aSXin Li span of silence, but we do allow the bitres to refill.
2154*a58d3d2aSXin Li This means that we'll undershoot our target in CVBR/VBR modes
2155*a58d3d2aSXin Li on files with lots of silence. */
2156*a58d3d2aSXin Li if(silence)
2157*a58d3d2aSXin Li {
2158*a58d3d2aSXin Li nbAvailableBytes = 2;
2159*a58d3d2aSXin Li target = 2*8<<BITRES;
2160*a58d3d2aSXin Li delta = 0;
2161*a58d3d2aSXin Li }
2162*a58d3d2aSXin Li
2163*a58d3d2aSXin Li if (st->vbr_count < 970)
2164*a58d3d2aSXin Li {
2165*a58d3d2aSXin Li st->vbr_count++;
2166*a58d3d2aSXin Li alpha = celt_rcp(SHL32(EXTEND32(st->vbr_count+20),16));
2167*a58d3d2aSXin Li } else
2168*a58d3d2aSXin Li alpha = QCONST16(.001f,15);
2169*a58d3d2aSXin Li /* How many bits have we used in excess of what we're allowed */
2170*a58d3d2aSXin Li if (st->constrained_vbr)
2171*a58d3d2aSXin Li st->vbr_reservoir += target - vbr_rate;
2172*a58d3d2aSXin Li /*printf ("%d\n", st->vbr_reservoir);*/
2173*a58d3d2aSXin Li
2174*a58d3d2aSXin Li /* Compute the offset we need to apply in order to reach the target */
2175*a58d3d2aSXin Li if (st->constrained_vbr)
2176*a58d3d2aSXin Li {
2177*a58d3d2aSXin Li st->vbr_drift += (opus_int32)MULT16_32_Q15(alpha,(delta*(1<<lm_diff))-st->vbr_offset-st->vbr_drift);
2178*a58d3d2aSXin Li st->vbr_offset = -st->vbr_drift;
2179*a58d3d2aSXin Li }
2180*a58d3d2aSXin Li /*printf ("%d\n", st->vbr_drift);*/
2181*a58d3d2aSXin Li
2182*a58d3d2aSXin Li if (st->constrained_vbr && st->vbr_reservoir < 0)
2183*a58d3d2aSXin Li {
2184*a58d3d2aSXin Li /* We're under the min value -- increase rate */
2185*a58d3d2aSXin Li int adjust = (-st->vbr_reservoir)/(8<<BITRES);
2186*a58d3d2aSXin Li /* Unless we're just coding silence */
2187*a58d3d2aSXin Li nbAvailableBytes += silence?0:adjust;
2188*a58d3d2aSXin Li st->vbr_reservoir = 0;
2189*a58d3d2aSXin Li /*printf ("+%d\n", adjust);*/
2190*a58d3d2aSXin Li }
2191*a58d3d2aSXin Li nbCompressedBytes = IMIN(nbCompressedBytes,nbAvailableBytes);
2192*a58d3d2aSXin Li /*printf("%d\n", nbCompressedBytes*50*8);*/
2193*a58d3d2aSXin Li /* This moves the raw bits to take into account the new compressed size */
2194*a58d3d2aSXin Li ec_enc_shrink(enc, nbCompressedBytes);
2195*a58d3d2aSXin Li }
2196*a58d3d2aSXin Li
2197*a58d3d2aSXin Li /* Bit allocation */
2198*a58d3d2aSXin Li ALLOC(fine_quant, nbEBands, int);
2199*a58d3d2aSXin Li ALLOC(pulses, nbEBands, int);
2200*a58d3d2aSXin Li ALLOC(fine_priority, nbEBands, int);
2201*a58d3d2aSXin Li
2202*a58d3d2aSXin Li /* bits = packet size - where we are - safety*/
2203*a58d3d2aSXin Li bits = (((opus_int32)nbCompressedBytes*8)<<BITRES) - ec_tell_frac(enc) - 1;
2204*a58d3d2aSXin Li anti_collapse_rsv = isTransient&&LM>=2&&bits>=((LM+2)<<BITRES) ? (1<<BITRES) : 0;
2205*a58d3d2aSXin Li bits -= anti_collapse_rsv;
2206*a58d3d2aSXin Li signalBandwidth = end-1;
2207*a58d3d2aSXin Li #ifndef DISABLE_FLOAT_API
2208*a58d3d2aSXin Li if (st->analysis.valid)
2209*a58d3d2aSXin Li {
2210*a58d3d2aSXin Li int min_bandwidth;
2211*a58d3d2aSXin Li if (equiv_rate < (opus_int32)32000*C)
2212*a58d3d2aSXin Li min_bandwidth = 13;
2213*a58d3d2aSXin Li else if (equiv_rate < (opus_int32)48000*C)
2214*a58d3d2aSXin Li min_bandwidth = 16;
2215*a58d3d2aSXin Li else if (equiv_rate < (opus_int32)60000*C)
2216*a58d3d2aSXin Li min_bandwidth = 18;
2217*a58d3d2aSXin Li else if (equiv_rate < (opus_int32)80000*C)
2218*a58d3d2aSXin Li min_bandwidth = 19;
2219*a58d3d2aSXin Li else
2220*a58d3d2aSXin Li min_bandwidth = 20;
2221*a58d3d2aSXin Li signalBandwidth = IMAX(st->analysis.bandwidth, min_bandwidth);
2222*a58d3d2aSXin Li }
2223*a58d3d2aSXin Li #endif
2224*a58d3d2aSXin Li if (st->lfe)
2225*a58d3d2aSXin Li signalBandwidth = 1;
2226*a58d3d2aSXin Li codedBands = clt_compute_allocation(mode, start, end, offsets, cap,
2227*a58d3d2aSXin Li alloc_trim, &st->intensity, &dual_stereo, bits, &balance, pulses,
2228*a58d3d2aSXin Li fine_quant, fine_priority, C, LM, enc, 1, st->lastCodedBands, signalBandwidth);
2229*a58d3d2aSXin Li if (st->lastCodedBands)
2230*a58d3d2aSXin Li st->lastCodedBands = IMIN(st->lastCodedBands+1,IMAX(st->lastCodedBands-1,codedBands));
2231*a58d3d2aSXin Li else
2232*a58d3d2aSXin Li st->lastCodedBands = codedBands;
2233*a58d3d2aSXin Li
2234*a58d3d2aSXin Li quant_fine_energy(mode, start, end, oldBandE, error, fine_quant, enc, C);
2235*a58d3d2aSXin Li
2236*a58d3d2aSXin Li /* Residual quantisation */
2237*a58d3d2aSXin Li ALLOC(collapse_masks, C*nbEBands, unsigned char);
2238*a58d3d2aSXin Li quant_all_bands(1, mode, start, end, X, C==2 ? X+N : NULL, collapse_masks,
2239*a58d3d2aSXin Li bandE, pulses, shortBlocks, st->spread_decision,
2240*a58d3d2aSXin Li dual_stereo, st->intensity, tf_res, nbCompressedBytes*(8<<BITRES)-anti_collapse_rsv,
2241*a58d3d2aSXin Li balance, enc, LM, codedBands, &st->rng, st->complexity, st->arch, st->disable_inv);
2242*a58d3d2aSXin Li
2243*a58d3d2aSXin Li if (anti_collapse_rsv > 0)
2244*a58d3d2aSXin Li {
2245*a58d3d2aSXin Li anti_collapse_on = st->consec_transient<2;
2246*a58d3d2aSXin Li #ifdef FUZZING
2247*a58d3d2aSXin Li anti_collapse_on = rand()&0x1;
2248*a58d3d2aSXin Li #endif
2249*a58d3d2aSXin Li ec_enc_bits(enc, anti_collapse_on, 1);
2250*a58d3d2aSXin Li }
2251*a58d3d2aSXin Li quant_energy_finalise(mode, start, end, oldBandE, error, fine_quant, fine_priority, nbCompressedBytes*8-ec_tell(enc), enc, C);
2252*a58d3d2aSXin Li OPUS_CLEAR(energyError, nbEBands*CC);
2253*a58d3d2aSXin Li c=0;
2254*a58d3d2aSXin Li do {
2255*a58d3d2aSXin Li for (i=start;i<end;i++)
2256*a58d3d2aSXin Li {
2257*a58d3d2aSXin Li energyError[i+c*nbEBands] = MAX16(-QCONST16(0.5f, 15), MIN16(QCONST16(0.5f, 15), error[i+c*nbEBands]));
2258*a58d3d2aSXin Li }
2259*a58d3d2aSXin Li } while (++c < C);
2260*a58d3d2aSXin Li
2261*a58d3d2aSXin Li if (silence)
2262*a58d3d2aSXin Li {
2263*a58d3d2aSXin Li for (i=0;i<C*nbEBands;i++)
2264*a58d3d2aSXin Li oldBandE[i] = -QCONST16(28.f,DB_SHIFT);
2265*a58d3d2aSXin Li }
2266*a58d3d2aSXin Li
2267*a58d3d2aSXin Li #ifdef RESYNTH
2268*a58d3d2aSXin Li /* Re-synthesis of the coded audio if required */
2269*a58d3d2aSXin Li {
2270*a58d3d2aSXin Li celt_sig *out_mem[2];
2271*a58d3d2aSXin Li
2272*a58d3d2aSXin Li if (anti_collapse_on)
2273*a58d3d2aSXin Li {
2274*a58d3d2aSXin Li anti_collapse(mode, X, collapse_masks, LM, C, N,
2275*a58d3d2aSXin Li start, end, oldBandE, oldLogE, oldLogE2, pulses, st->rng, st->arch);
2276*a58d3d2aSXin Li }
2277*a58d3d2aSXin Li
2278*a58d3d2aSXin Li c=0; do {
2279*a58d3d2aSXin Li OPUS_MOVE(st->syn_mem[c], st->syn_mem[c]+N, 2*MAX_PERIOD-N+overlap/2);
2280*a58d3d2aSXin Li } while (++c<CC);
2281*a58d3d2aSXin Li
2282*a58d3d2aSXin Li c=0; do {
2283*a58d3d2aSXin Li out_mem[c] = st->syn_mem[c]+2*MAX_PERIOD-N;
2284*a58d3d2aSXin Li } while (++c<CC);
2285*a58d3d2aSXin Li
2286*a58d3d2aSXin Li celt_synthesis(mode, X, out_mem, oldBandE, start, effEnd,
2287*a58d3d2aSXin Li C, CC, isTransient, LM, st->upsample, silence, st->arch);
2288*a58d3d2aSXin Li
2289*a58d3d2aSXin Li c=0; do {
2290*a58d3d2aSXin Li st->prefilter_period=IMAX(st->prefilter_period, COMBFILTER_MINPERIOD);
2291*a58d3d2aSXin Li st->prefilter_period_old=IMAX(st->prefilter_period_old, COMBFILTER_MINPERIOD);
2292*a58d3d2aSXin Li comb_filter(out_mem[c], out_mem[c], st->prefilter_period_old, st->prefilter_period, mode->shortMdctSize,
2293*a58d3d2aSXin Li st->prefilter_gain_old, st->prefilter_gain, st->prefilter_tapset_old, st->prefilter_tapset,
2294*a58d3d2aSXin Li mode->window, overlap, st->arch);
2295*a58d3d2aSXin Li if (LM!=0)
2296*a58d3d2aSXin Li comb_filter(out_mem[c]+mode->shortMdctSize, out_mem[c]+mode->shortMdctSize, st->prefilter_period, pitch_index, N-mode->shortMdctSize,
2297*a58d3d2aSXin Li st->prefilter_gain, gain1, st->prefilter_tapset, prefilter_tapset,
2298*a58d3d2aSXin Li mode->window, overlap, st->arch);
2299*a58d3d2aSXin Li } while (++c<CC);
2300*a58d3d2aSXin Li
2301*a58d3d2aSXin Li /* We reuse freq[] as scratch space for the de-emphasis */
2302*a58d3d2aSXin Li deemphasis(out_mem, (opus_val16*)pcm, N, CC, st->upsample, mode->preemph, st->preemph_memD, 0);
2303*a58d3d2aSXin Li st->prefilter_period_old = st->prefilter_period;
2304*a58d3d2aSXin Li st->prefilter_gain_old = st->prefilter_gain;
2305*a58d3d2aSXin Li st->prefilter_tapset_old = st->prefilter_tapset;
2306*a58d3d2aSXin Li }
2307*a58d3d2aSXin Li #endif
2308*a58d3d2aSXin Li
2309*a58d3d2aSXin Li st->prefilter_period = pitch_index;
2310*a58d3d2aSXin Li st->prefilter_gain = gain1;
2311*a58d3d2aSXin Li st->prefilter_tapset = prefilter_tapset;
2312*a58d3d2aSXin Li #ifdef RESYNTH
2313*a58d3d2aSXin Li if (LM!=0)
2314*a58d3d2aSXin Li {
2315*a58d3d2aSXin Li st->prefilter_period_old = st->prefilter_period;
2316*a58d3d2aSXin Li st->prefilter_gain_old = st->prefilter_gain;
2317*a58d3d2aSXin Li st->prefilter_tapset_old = st->prefilter_tapset;
2318*a58d3d2aSXin Li }
2319*a58d3d2aSXin Li #endif
2320*a58d3d2aSXin Li
2321*a58d3d2aSXin Li if (CC==2&&C==1) {
2322*a58d3d2aSXin Li OPUS_COPY(&oldBandE[nbEBands], oldBandE, nbEBands);
2323*a58d3d2aSXin Li }
2324*a58d3d2aSXin Li
2325*a58d3d2aSXin Li if (!isTransient)
2326*a58d3d2aSXin Li {
2327*a58d3d2aSXin Li OPUS_COPY(oldLogE2, oldLogE, CC*nbEBands);
2328*a58d3d2aSXin Li OPUS_COPY(oldLogE, oldBandE, CC*nbEBands);
2329*a58d3d2aSXin Li } else {
2330*a58d3d2aSXin Li for (i=0;i<CC*nbEBands;i++)
2331*a58d3d2aSXin Li oldLogE[i] = MIN16(oldLogE[i], oldBandE[i]);
2332*a58d3d2aSXin Li }
2333*a58d3d2aSXin Li /* In case start or end were to change */
2334*a58d3d2aSXin Li c=0; do
2335*a58d3d2aSXin Li {
2336*a58d3d2aSXin Li for (i=0;i<start;i++)
2337*a58d3d2aSXin Li {
2338*a58d3d2aSXin Li oldBandE[c*nbEBands+i]=0;
2339*a58d3d2aSXin Li oldLogE[c*nbEBands+i]=oldLogE2[c*nbEBands+i]=-QCONST16(28.f,DB_SHIFT);
2340*a58d3d2aSXin Li }
2341*a58d3d2aSXin Li for (i=end;i<nbEBands;i++)
2342*a58d3d2aSXin Li {
2343*a58d3d2aSXin Li oldBandE[c*nbEBands+i]=0;
2344*a58d3d2aSXin Li oldLogE[c*nbEBands+i]=oldLogE2[c*nbEBands+i]=-QCONST16(28.f,DB_SHIFT);
2345*a58d3d2aSXin Li }
2346*a58d3d2aSXin Li } while (++c<CC);
2347*a58d3d2aSXin Li
2348*a58d3d2aSXin Li if (isTransient || transient_got_disabled)
2349*a58d3d2aSXin Li st->consec_transient++;
2350*a58d3d2aSXin Li else
2351*a58d3d2aSXin Li st->consec_transient=0;
2352*a58d3d2aSXin Li st->rng = enc->rng;
2353*a58d3d2aSXin Li
2354*a58d3d2aSXin Li /* If there's any room left (can only happen for very high rates),
2355*a58d3d2aSXin Li it's already filled with zeros */
2356*a58d3d2aSXin Li ec_enc_done(enc);
2357*a58d3d2aSXin Li
2358*a58d3d2aSXin Li #ifdef CUSTOM_MODES
2359*a58d3d2aSXin Li if (st->signalling)
2360*a58d3d2aSXin Li nbCompressedBytes++;
2361*a58d3d2aSXin Li #endif
2362*a58d3d2aSXin Li
2363*a58d3d2aSXin Li RESTORE_STACK;
2364*a58d3d2aSXin Li if (ec_get_error(enc))
2365*a58d3d2aSXin Li return OPUS_INTERNAL_ERROR;
2366*a58d3d2aSXin Li else
2367*a58d3d2aSXin Li return nbCompressedBytes;
2368*a58d3d2aSXin Li }
2369*a58d3d2aSXin Li
2370*a58d3d2aSXin Li
2371*a58d3d2aSXin Li #ifdef CUSTOM_MODES
2372*a58d3d2aSXin Li
2373*a58d3d2aSXin Li #ifdef FIXED_POINT
opus_custom_encode(CELTEncoder * OPUS_RESTRICT st,const opus_int16 * pcm,int frame_size,unsigned char * compressed,int nbCompressedBytes)2374*a58d3d2aSXin Li int opus_custom_encode(CELTEncoder * OPUS_RESTRICT st, const opus_int16 * pcm, int frame_size, unsigned char *compressed, int nbCompressedBytes)
2375*a58d3d2aSXin Li {
2376*a58d3d2aSXin Li return celt_encode_with_ec(st, pcm, frame_size, compressed, nbCompressedBytes, NULL);
2377*a58d3d2aSXin Li }
2378*a58d3d2aSXin Li
2379*a58d3d2aSXin Li #ifndef DISABLE_FLOAT_API
opus_custom_encode_float(CELTEncoder * OPUS_RESTRICT st,const float * pcm,int frame_size,unsigned char * compressed,int nbCompressedBytes)2380*a58d3d2aSXin Li int opus_custom_encode_float(CELTEncoder * OPUS_RESTRICT st, const float * pcm, int frame_size, unsigned char *compressed, int nbCompressedBytes)
2381*a58d3d2aSXin Li {
2382*a58d3d2aSXin Li int j, ret, C, N;
2383*a58d3d2aSXin Li VARDECL(opus_int16, in);
2384*a58d3d2aSXin Li ALLOC_STACK;
2385*a58d3d2aSXin Li
2386*a58d3d2aSXin Li if (pcm==NULL)
2387*a58d3d2aSXin Li return OPUS_BAD_ARG;
2388*a58d3d2aSXin Li
2389*a58d3d2aSXin Li C = st->channels;
2390*a58d3d2aSXin Li N = frame_size;
2391*a58d3d2aSXin Li ALLOC(in, C*N, opus_int16);
2392*a58d3d2aSXin Li
2393*a58d3d2aSXin Li for (j=0;j<C*N;j++)
2394*a58d3d2aSXin Li in[j] = FLOAT2INT16(pcm[j]);
2395*a58d3d2aSXin Li
2396*a58d3d2aSXin Li ret=celt_encode_with_ec(st,in,frame_size,compressed,nbCompressedBytes, NULL);
2397*a58d3d2aSXin Li #ifdef RESYNTH
2398*a58d3d2aSXin Li for (j=0;j<C*N;j++)
2399*a58d3d2aSXin Li ((float*)pcm)[j]=in[j]*(1.f/32768.f);
2400*a58d3d2aSXin Li #endif
2401*a58d3d2aSXin Li RESTORE_STACK;
2402*a58d3d2aSXin Li return ret;
2403*a58d3d2aSXin Li }
2404*a58d3d2aSXin Li #endif /* DISABLE_FLOAT_API */
2405*a58d3d2aSXin Li #else
2406*a58d3d2aSXin Li
opus_custom_encode(CELTEncoder * OPUS_RESTRICT st,const opus_int16 * pcm,int frame_size,unsigned char * compressed,int nbCompressedBytes)2407*a58d3d2aSXin Li int opus_custom_encode(CELTEncoder * OPUS_RESTRICT st, const opus_int16 * pcm, int frame_size, unsigned char *compressed, int nbCompressedBytes)
2408*a58d3d2aSXin Li {
2409*a58d3d2aSXin Li int j, ret, C, N;
2410*a58d3d2aSXin Li VARDECL(celt_sig, in);
2411*a58d3d2aSXin Li ALLOC_STACK;
2412*a58d3d2aSXin Li
2413*a58d3d2aSXin Li if (pcm==NULL)
2414*a58d3d2aSXin Li return OPUS_BAD_ARG;
2415*a58d3d2aSXin Li
2416*a58d3d2aSXin Li C=st->channels;
2417*a58d3d2aSXin Li N=frame_size;
2418*a58d3d2aSXin Li ALLOC(in, C*N, celt_sig);
2419*a58d3d2aSXin Li for (j=0;j<C*N;j++) {
2420*a58d3d2aSXin Li in[j] = SCALEOUT(pcm[j]);
2421*a58d3d2aSXin Li }
2422*a58d3d2aSXin Li
2423*a58d3d2aSXin Li ret = celt_encode_with_ec(st,in,frame_size,compressed,nbCompressedBytes, NULL);
2424*a58d3d2aSXin Li #ifdef RESYNTH
2425*a58d3d2aSXin Li for (j=0;j<C*N;j++)
2426*a58d3d2aSXin Li ((opus_int16*)pcm)[j] = FLOAT2INT16(in[j]);
2427*a58d3d2aSXin Li #endif
2428*a58d3d2aSXin Li RESTORE_STACK;
2429*a58d3d2aSXin Li return ret;
2430*a58d3d2aSXin Li }
2431*a58d3d2aSXin Li
opus_custom_encode_float(CELTEncoder * OPUS_RESTRICT st,const float * pcm,int frame_size,unsigned char * compressed,int nbCompressedBytes)2432*a58d3d2aSXin Li int opus_custom_encode_float(CELTEncoder * OPUS_RESTRICT st, const float * pcm, int frame_size, unsigned char *compressed, int nbCompressedBytes)
2433*a58d3d2aSXin Li {
2434*a58d3d2aSXin Li return celt_encode_with_ec(st, pcm, frame_size, compressed, nbCompressedBytes, NULL);
2435*a58d3d2aSXin Li }
2436*a58d3d2aSXin Li
2437*a58d3d2aSXin Li #endif
2438*a58d3d2aSXin Li
2439*a58d3d2aSXin Li #endif /* CUSTOM_MODES */
2440*a58d3d2aSXin Li
opus_custom_encoder_ctl(CELTEncoder * OPUS_RESTRICT st,int request,...)2441*a58d3d2aSXin Li int opus_custom_encoder_ctl(CELTEncoder * OPUS_RESTRICT st, int request, ...)
2442*a58d3d2aSXin Li {
2443*a58d3d2aSXin Li va_list ap;
2444*a58d3d2aSXin Li
2445*a58d3d2aSXin Li va_start(ap, request);
2446*a58d3d2aSXin Li switch (request)
2447*a58d3d2aSXin Li {
2448*a58d3d2aSXin Li case OPUS_SET_COMPLEXITY_REQUEST:
2449*a58d3d2aSXin Li {
2450*a58d3d2aSXin Li int value = va_arg(ap, opus_int32);
2451*a58d3d2aSXin Li if (value<0 || value>10)
2452*a58d3d2aSXin Li goto bad_arg;
2453*a58d3d2aSXin Li st->complexity = value;
2454*a58d3d2aSXin Li }
2455*a58d3d2aSXin Li break;
2456*a58d3d2aSXin Li case CELT_SET_START_BAND_REQUEST:
2457*a58d3d2aSXin Li {
2458*a58d3d2aSXin Li opus_int32 value = va_arg(ap, opus_int32);
2459*a58d3d2aSXin Li if (value<0 || value>=st->mode->nbEBands)
2460*a58d3d2aSXin Li goto bad_arg;
2461*a58d3d2aSXin Li st->start = value;
2462*a58d3d2aSXin Li }
2463*a58d3d2aSXin Li break;
2464*a58d3d2aSXin Li case CELT_SET_END_BAND_REQUEST:
2465*a58d3d2aSXin Li {
2466*a58d3d2aSXin Li opus_int32 value = va_arg(ap, opus_int32);
2467*a58d3d2aSXin Li if (value<1 || value>st->mode->nbEBands)
2468*a58d3d2aSXin Li goto bad_arg;
2469*a58d3d2aSXin Li st->end = value;
2470*a58d3d2aSXin Li }
2471*a58d3d2aSXin Li break;
2472*a58d3d2aSXin Li case CELT_SET_PREDICTION_REQUEST:
2473*a58d3d2aSXin Li {
2474*a58d3d2aSXin Li int value = va_arg(ap, opus_int32);
2475*a58d3d2aSXin Li if (value<0 || value>2)
2476*a58d3d2aSXin Li goto bad_arg;
2477*a58d3d2aSXin Li st->disable_pf = value<=1;
2478*a58d3d2aSXin Li st->force_intra = value==0;
2479*a58d3d2aSXin Li }
2480*a58d3d2aSXin Li break;
2481*a58d3d2aSXin Li case OPUS_SET_PACKET_LOSS_PERC_REQUEST:
2482*a58d3d2aSXin Li {
2483*a58d3d2aSXin Li int value = va_arg(ap, opus_int32);
2484*a58d3d2aSXin Li if (value<0 || value>100)
2485*a58d3d2aSXin Li goto bad_arg;
2486*a58d3d2aSXin Li st->loss_rate = value;
2487*a58d3d2aSXin Li }
2488*a58d3d2aSXin Li break;
2489*a58d3d2aSXin Li case OPUS_SET_VBR_CONSTRAINT_REQUEST:
2490*a58d3d2aSXin Li {
2491*a58d3d2aSXin Li opus_int32 value = va_arg(ap, opus_int32);
2492*a58d3d2aSXin Li st->constrained_vbr = value;
2493*a58d3d2aSXin Li }
2494*a58d3d2aSXin Li break;
2495*a58d3d2aSXin Li case OPUS_SET_VBR_REQUEST:
2496*a58d3d2aSXin Li {
2497*a58d3d2aSXin Li opus_int32 value = va_arg(ap, opus_int32);
2498*a58d3d2aSXin Li st->vbr = value;
2499*a58d3d2aSXin Li }
2500*a58d3d2aSXin Li break;
2501*a58d3d2aSXin Li case OPUS_SET_BITRATE_REQUEST:
2502*a58d3d2aSXin Li {
2503*a58d3d2aSXin Li opus_int32 value = va_arg(ap, opus_int32);
2504*a58d3d2aSXin Li if (value<=500 && value!=OPUS_BITRATE_MAX)
2505*a58d3d2aSXin Li goto bad_arg;
2506*a58d3d2aSXin Li value = IMIN(value, 260000*st->channels);
2507*a58d3d2aSXin Li st->bitrate = value;
2508*a58d3d2aSXin Li }
2509*a58d3d2aSXin Li break;
2510*a58d3d2aSXin Li case CELT_SET_CHANNELS_REQUEST:
2511*a58d3d2aSXin Li {
2512*a58d3d2aSXin Li opus_int32 value = va_arg(ap, opus_int32);
2513*a58d3d2aSXin Li if (value<1 || value>2)
2514*a58d3d2aSXin Li goto bad_arg;
2515*a58d3d2aSXin Li st->stream_channels = value;
2516*a58d3d2aSXin Li }
2517*a58d3d2aSXin Li break;
2518*a58d3d2aSXin Li case OPUS_SET_LSB_DEPTH_REQUEST:
2519*a58d3d2aSXin Li {
2520*a58d3d2aSXin Li opus_int32 value = va_arg(ap, opus_int32);
2521*a58d3d2aSXin Li if (value<8 || value>24)
2522*a58d3d2aSXin Li goto bad_arg;
2523*a58d3d2aSXin Li st->lsb_depth=value;
2524*a58d3d2aSXin Li }
2525*a58d3d2aSXin Li break;
2526*a58d3d2aSXin Li case OPUS_GET_LSB_DEPTH_REQUEST:
2527*a58d3d2aSXin Li {
2528*a58d3d2aSXin Li opus_int32 *value = va_arg(ap, opus_int32*);
2529*a58d3d2aSXin Li *value=st->lsb_depth;
2530*a58d3d2aSXin Li }
2531*a58d3d2aSXin Li break;
2532*a58d3d2aSXin Li case OPUS_SET_PHASE_INVERSION_DISABLED_REQUEST:
2533*a58d3d2aSXin Li {
2534*a58d3d2aSXin Li opus_int32 value = va_arg(ap, opus_int32);
2535*a58d3d2aSXin Li if(value<0 || value>1)
2536*a58d3d2aSXin Li {
2537*a58d3d2aSXin Li goto bad_arg;
2538*a58d3d2aSXin Li }
2539*a58d3d2aSXin Li st->disable_inv = value;
2540*a58d3d2aSXin Li }
2541*a58d3d2aSXin Li break;
2542*a58d3d2aSXin Li case OPUS_GET_PHASE_INVERSION_DISABLED_REQUEST:
2543*a58d3d2aSXin Li {
2544*a58d3d2aSXin Li opus_int32 *value = va_arg(ap, opus_int32*);
2545*a58d3d2aSXin Li if (!value)
2546*a58d3d2aSXin Li {
2547*a58d3d2aSXin Li goto bad_arg;
2548*a58d3d2aSXin Li }
2549*a58d3d2aSXin Li *value = st->disable_inv;
2550*a58d3d2aSXin Li }
2551*a58d3d2aSXin Li break;
2552*a58d3d2aSXin Li case OPUS_RESET_STATE:
2553*a58d3d2aSXin Li {
2554*a58d3d2aSXin Li int i;
2555*a58d3d2aSXin Li opus_val16 *oldBandE, *oldLogE, *oldLogE2;
2556*a58d3d2aSXin Li oldBandE = (opus_val16*)(st->in_mem+st->channels*(st->mode->overlap+COMBFILTER_MAXPERIOD));
2557*a58d3d2aSXin Li oldLogE = oldBandE + st->channels*st->mode->nbEBands;
2558*a58d3d2aSXin Li oldLogE2 = oldLogE + st->channels*st->mode->nbEBands;
2559*a58d3d2aSXin Li OPUS_CLEAR((char*)&st->ENCODER_RESET_START,
2560*a58d3d2aSXin Li opus_custom_encoder_get_size(st->mode, st->channels)-
2561*a58d3d2aSXin Li ((char*)&st->ENCODER_RESET_START - (char*)st));
2562*a58d3d2aSXin Li for (i=0;i<st->channels*st->mode->nbEBands;i++)
2563*a58d3d2aSXin Li oldLogE[i]=oldLogE2[i]=-QCONST16(28.f,DB_SHIFT);
2564*a58d3d2aSXin Li st->vbr_offset = 0;
2565*a58d3d2aSXin Li st->delayedIntra = 1;
2566*a58d3d2aSXin Li st->spread_decision = SPREAD_NORMAL;
2567*a58d3d2aSXin Li st->tonal_average = 256;
2568*a58d3d2aSXin Li st->hf_average = 0;
2569*a58d3d2aSXin Li st->tapset_decision = 0;
2570*a58d3d2aSXin Li }
2571*a58d3d2aSXin Li break;
2572*a58d3d2aSXin Li #ifdef CUSTOM_MODES
2573*a58d3d2aSXin Li case CELT_SET_INPUT_CLIPPING_REQUEST:
2574*a58d3d2aSXin Li {
2575*a58d3d2aSXin Li opus_int32 value = va_arg(ap, opus_int32);
2576*a58d3d2aSXin Li st->clip = value;
2577*a58d3d2aSXin Li }
2578*a58d3d2aSXin Li break;
2579*a58d3d2aSXin Li #endif
2580*a58d3d2aSXin Li case CELT_SET_SIGNALLING_REQUEST:
2581*a58d3d2aSXin Li {
2582*a58d3d2aSXin Li opus_int32 value = va_arg(ap, opus_int32);
2583*a58d3d2aSXin Li st->signalling = value;
2584*a58d3d2aSXin Li }
2585*a58d3d2aSXin Li break;
2586*a58d3d2aSXin Li case CELT_SET_ANALYSIS_REQUEST:
2587*a58d3d2aSXin Li {
2588*a58d3d2aSXin Li AnalysisInfo *info = va_arg(ap, AnalysisInfo *);
2589*a58d3d2aSXin Li if (info)
2590*a58d3d2aSXin Li OPUS_COPY(&st->analysis, info, 1);
2591*a58d3d2aSXin Li }
2592*a58d3d2aSXin Li break;
2593*a58d3d2aSXin Li case CELT_SET_SILK_INFO_REQUEST:
2594*a58d3d2aSXin Li {
2595*a58d3d2aSXin Li SILKInfo *info = va_arg(ap, SILKInfo *);
2596*a58d3d2aSXin Li if (info)
2597*a58d3d2aSXin Li OPUS_COPY(&st->silk_info, info, 1);
2598*a58d3d2aSXin Li }
2599*a58d3d2aSXin Li break;
2600*a58d3d2aSXin Li case CELT_GET_MODE_REQUEST:
2601*a58d3d2aSXin Li {
2602*a58d3d2aSXin Li const CELTMode ** value = va_arg(ap, const CELTMode**);
2603*a58d3d2aSXin Li if (value==0)
2604*a58d3d2aSXin Li goto bad_arg;
2605*a58d3d2aSXin Li *value=st->mode;
2606*a58d3d2aSXin Li }
2607*a58d3d2aSXin Li break;
2608*a58d3d2aSXin Li case OPUS_GET_FINAL_RANGE_REQUEST:
2609*a58d3d2aSXin Li {
2610*a58d3d2aSXin Li opus_uint32 * value = va_arg(ap, opus_uint32 *);
2611*a58d3d2aSXin Li if (value==0)
2612*a58d3d2aSXin Li goto bad_arg;
2613*a58d3d2aSXin Li *value=st->rng;
2614*a58d3d2aSXin Li }
2615*a58d3d2aSXin Li break;
2616*a58d3d2aSXin Li case OPUS_SET_LFE_REQUEST:
2617*a58d3d2aSXin Li {
2618*a58d3d2aSXin Li opus_int32 value = va_arg(ap, opus_int32);
2619*a58d3d2aSXin Li st->lfe = value;
2620*a58d3d2aSXin Li }
2621*a58d3d2aSXin Li break;
2622*a58d3d2aSXin Li case OPUS_SET_ENERGY_MASK_REQUEST:
2623*a58d3d2aSXin Li {
2624*a58d3d2aSXin Li opus_val16 *value = va_arg(ap, opus_val16*);
2625*a58d3d2aSXin Li st->energy_mask = value;
2626*a58d3d2aSXin Li }
2627*a58d3d2aSXin Li break;
2628*a58d3d2aSXin Li default:
2629*a58d3d2aSXin Li goto bad_request;
2630*a58d3d2aSXin Li }
2631*a58d3d2aSXin Li va_end(ap);
2632*a58d3d2aSXin Li return OPUS_OK;
2633*a58d3d2aSXin Li bad_arg:
2634*a58d3d2aSXin Li va_end(ap);
2635*a58d3d2aSXin Li return OPUS_BAD_ARG;
2636*a58d3d2aSXin Li bad_request:
2637*a58d3d2aSXin Li va_end(ap);
2638*a58d3d2aSXin Li return OPUS_UNIMPLEMENTED;
2639*a58d3d2aSXin Li }
2640