VP8: unroll MB mode decoding tree
[ffmpeg.git] / libavcodec / aacpsy.c
1 /*
2  * AAC encoder psychoacoustic model
3  * Copyright (C) 2008 Konstantin Shishkov
4  *
5  * This file is part of FFmpeg.
6  *
7  * FFmpeg is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU Lesser General Public
9  * License as published by the Free Software Foundation; either
10  * version 2.1 of the License, or (at your option) any later version.
11  *
12  * FFmpeg is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15  * Lesser General Public License for more details.
16  *
17  * You should have received a copy of the GNU Lesser General Public
18  * License along with FFmpeg; if not, write to the Free Software
19  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20  */
21
22 /**
23  * @file
24  * AAC encoder psychoacoustic model
25  */
26
27 #include "avcodec.h"
28 #include "aactab.h"
29 #include "psymodel.h"
30
31 /***********************************
32  *              TODOs:
33  * thresholds linearization after their modifications for attaining given bitrate
34  * try other bitrate controlling mechanism (maybe use ratecontrol.c?)
35  * control quality for quality-based output
36  **********************************/
37
38 /**
39  * constants for 3GPP AAC psychoacoustic model
40  * @{
41  */
42 #define PSY_3GPP_SPREAD_LOW  1.5f // spreading factor for ascending threshold spreading  (15 dB/Bark)
43 #define PSY_3GPP_SPREAD_HI   3.0f // spreading factor for descending threshold spreading (30 dB/Bark)
44
45 #define PSY_3GPP_RPEMIN      0.01f
46 #define PSY_3GPP_RPELEV      2.0f
47 /**
48  * @}
49  */
50
51 /**
52  * information for single band used by 3GPP TS26.403-inspired psychoacoustic model
53  */
54 typedef struct Psy3gppBand{
55     float energy;    ///< band energy
56     float ffac;      ///< form factor
57     float thr;       ///< energy threshold
58     float min_snr;   ///< minimal SNR
59     float thr_quiet; ///< threshold in quiet
60 }Psy3gppBand;
61
62 /**
63  * single/pair channel context for psychoacoustic model
64  */
65 typedef struct Psy3gppChannel{
66     Psy3gppBand band[128];               ///< bands information
67     Psy3gppBand prev_band[128];          ///< bands information from the previous frame
68
69     float       win_energy;              ///< sliding average of channel energy
70     float       iir_state[2];            ///< hi-pass IIR filter state
71     uint8_t     next_grouping;           ///< stored grouping scheme for the next frame (in case of 8 short window sequence)
72     enum WindowSequence next_window_seq; ///< window sequence to be used in the next frame
73 }Psy3gppChannel;
74
75 /**
76  * psychoacoustic model frame type-dependent coefficients
77  */
78 typedef struct Psy3gppCoeffs{
79     float ath       [64]; ///< absolute threshold of hearing per bands
80     float barks     [64]; ///< Bark value for each spectral band in long frame
81     float spread_low[64]; ///< spreading factor for low-to-high threshold spreading in long frame
82     float spread_hi [64]; ///< spreading factor for high-to-low threshold spreading in long frame
83 }Psy3gppCoeffs;
84
85 /**
86  * 3GPP TS26.403-inspired psychoacoustic model specific data
87  */
88 typedef struct Psy3gppContext{
89     Psy3gppCoeffs psy_coef[2];
90     Psy3gppChannel *ch;
91 }Psy3gppContext;
92
93 /**
94  * Calculate Bark value for given line.
95  */
96 static av_cold float calc_bark(float f)
97 {
98     return 13.3f * atanf(0.00076f * f) + 3.5f * atanf((f / 7500.0f) * (f / 7500.0f));
99 }
100
101 #define ATH_ADD 4
102 /**
103  * Calculate ATH value for given frequency.
104  * Borrowed from Lame.
105  */
106 static av_cold float ath(float f, float add)
107 {
108     f /= 1000.0f;
109     return    3.64 * pow(f, -0.8)
110             - 6.8  * exp(-0.6  * (f - 3.4) * (f - 3.4))
111             + 6.0  * exp(-0.15 * (f - 8.7) * (f - 8.7))
112             + (0.6 + 0.04 * add) * 0.001 * f * f * f * f;
113 }
114
115 static av_cold int psy_3gpp_init(FFPsyContext *ctx) {
116     Psy3gppContext *pctx;
117     float bark;
118     int i, j, g, start;
119     float prev, minscale, minath;
120
121     ctx->model_priv_data = av_mallocz(sizeof(Psy3gppContext));
122     pctx = (Psy3gppContext*) ctx->model_priv_data;
123
124     minath = ath(3410, ATH_ADD);
125     for (j = 0; j < 2; j++) {
126         Psy3gppCoeffs *coeffs = &pctx->psy_coef[j];
127         float line_to_frequency = ctx->avctx->sample_rate / (j ? 256.f : 2048.0f);
128         i = 0;
129         prev = 0.0;
130         for (g = 0; g < ctx->num_bands[j]; g++) {
131             i += ctx->bands[j][g];
132             bark = calc_bark((i-1) * line_to_frequency);
133             coeffs->barks[g] = (bark + prev) / 2.0;
134             prev = bark;
135         }
136         for (g = 0; g < ctx->num_bands[j] - 1; g++) {
137             coeffs->spread_low[g] = pow(10.0, -(coeffs->barks[g+1] - coeffs->barks[g]) * PSY_3GPP_SPREAD_LOW);
138             coeffs->spread_hi [g] = pow(10.0, -(coeffs->barks[g+1] - coeffs->barks[g]) * PSY_3GPP_SPREAD_HI);
139         }
140         start = 0;
141         for (g = 0; g < ctx->num_bands[j]; g++) {
142             minscale = ath(start * line_to_frequency, ATH_ADD);
143             for (i = 1; i < ctx->bands[j][g]; i++)
144                 minscale = FFMIN(minscale, ath((start + i) * line_to_frequency, ATH_ADD));
145             coeffs->ath[g] = minscale - minath;
146             start += ctx->bands[j][g];
147         }
148     }
149
150     pctx->ch = av_mallocz(sizeof(Psy3gppChannel) * ctx->avctx->channels);
151     return 0;
152 }
153
154 /**
155  * IIR filter used in block switching decision
156  */
157 static float iir_filter(int in, float state[2])
158 {
159     float ret;
160
161     ret = 0.7548f * (in - state[0]) + 0.5095f * state[1];
162     state[0] = in;
163     state[1] = ret;
164     return ret;
165 }
166
167 /**
168  * window grouping information stored as bits (0 - new group, 1 - group continues)
169  */
170 static const uint8_t window_grouping[9] = {
171     0xB6, 0x6C, 0xD8, 0xB2, 0x66, 0xC6, 0x96, 0x36, 0x36
172 };
173
174 /**
175  * Tell encoder which window types to use.
176  * @see 3GPP TS26.403 5.4.1 "Blockswitching"
177  */
178 static FFPsyWindowInfo psy_3gpp_window(FFPsyContext *ctx,
179                                        const int16_t *audio, const int16_t *la,
180                                        int channel, int prev_type)
181 {
182     int i, j;
183     int br               = ctx->avctx->bit_rate / ctx->avctx->channels;
184     int attack_ratio     = br <= 16000 ? 18 : 10;
185     Psy3gppContext *pctx = (Psy3gppContext*) ctx->model_priv_data;
186     Psy3gppChannel *pch  = &pctx->ch[channel];
187     uint8_t grouping     = 0;
188     int next_type        = pch->next_window_seq;
189     FFPsyWindowInfo wi;
190
191     memset(&wi, 0, sizeof(wi));
192     if (la) {
193         float s[8], v;
194         int switch_to_eight = 0;
195         float sum = 0.0, sum2 = 0.0;
196         int attack_n = 0;
197         int stay_short = 0;
198         for (i = 0; i < 8; i++) {
199             for (j = 0; j < 128; j++) {
200                 v = iir_filter(la[(i*128+j)*ctx->avctx->channels], pch->iir_state);
201                 sum += v*v;
202             }
203             s[i]  = sum;
204             sum2 += sum;
205         }
206         for (i = 0; i < 8; i++) {
207             if (s[i] > pch->win_energy * attack_ratio) {
208                 attack_n        = i + 1;
209                 switch_to_eight = 1;
210                 break;
211             }
212         }
213         pch->win_energy = pch->win_energy*7/8 + sum2/64;
214
215         wi.window_type[1] = prev_type;
216         switch (prev_type) {
217         case ONLY_LONG_SEQUENCE:
218             wi.window_type[0] = switch_to_eight ? LONG_START_SEQUENCE : ONLY_LONG_SEQUENCE;
219             next_type = switch_to_eight ? EIGHT_SHORT_SEQUENCE : ONLY_LONG_SEQUENCE;
220             break;
221         case LONG_START_SEQUENCE:
222             wi.window_type[0] = EIGHT_SHORT_SEQUENCE;
223             grouping = pch->next_grouping;
224             next_type = switch_to_eight ? EIGHT_SHORT_SEQUENCE : LONG_STOP_SEQUENCE;
225             break;
226         case LONG_STOP_SEQUENCE:
227             wi.window_type[0] = switch_to_eight ? LONG_START_SEQUENCE : ONLY_LONG_SEQUENCE;
228             next_type = switch_to_eight ? EIGHT_SHORT_SEQUENCE : ONLY_LONG_SEQUENCE;
229             break;
230         case EIGHT_SHORT_SEQUENCE:
231             stay_short = next_type == EIGHT_SHORT_SEQUENCE || switch_to_eight;
232             wi.window_type[0] = stay_short ? EIGHT_SHORT_SEQUENCE : LONG_STOP_SEQUENCE;
233             grouping = next_type == EIGHT_SHORT_SEQUENCE ? pch->next_grouping : 0;
234             next_type = switch_to_eight ? EIGHT_SHORT_SEQUENCE : LONG_STOP_SEQUENCE;
235             break;
236         }
237
238         pch->next_grouping = window_grouping[attack_n];
239         pch->next_window_seq = next_type;
240     } else {
241         for (i = 0; i < 3; i++)
242             wi.window_type[i] = prev_type;
243         grouping = (prev_type == EIGHT_SHORT_SEQUENCE) ? window_grouping[0] : 0;
244     }
245
246     wi.window_shape   = 1;
247     if (wi.window_type[0] != EIGHT_SHORT_SEQUENCE) {
248         wi.num_windows = 1;
249         wi.grouping[0] = 1;
250     } else {
251         int lastgrp = 0;
252         wi.num_windows = 8;
253         for (i = 0; i < 8; i++) {
254             if (!((grouping >> i) & 1))
255                 lastgrp = i;
256             wi.grouping[lastgrp]++;
257         }
258     }
259
260     return wi;
261 }
262
263 /**
264  * Calculate band thresholds as suggested in 3GPP TS26.403
265  */
266 static void psy_3gpp_analyze(FFPsyContext *ctx, int channel,
267                              const float *coefs, FFPsyWindowInfo *wi)
268 {
269     Psy3gppContext *pctx = (Psy3gppContext*) ctx->model_priv_data;
270     Psy3gppChannel *pch  = &pctx->ch[channel];
271     int start = 0;
272     int i, w, g;
273     const int num_bands       = ctx->num_bands[wi->num_windows == 8];
274     const uint8_t* band_sizes = ctx->bands[wi->num_windows == 8];
275     Psy3gppCoeffs *coeffs     = &pctx->psy_coef[wi->num_windows == 8];
276
277     //calculate energies, initial thresholds and related values - 5.4.2 "Threshold Calculation"
278     for (w = 0; w < wi->num_windows*16; w += 16) {
279         for (g = 0; g < num_bands; g++) {
280             Psy3gppBand *band = &pch->band[w+g];
281             band->energy = 0.0f;
282             for (i = 0; i < band_sizes[g]; i++)
283                 band->energy += coefs[start+i] * coefs[start+i];
284             band->energy *= 1.0f / (512*512);
285             band->thr     = band->energy * 0.001258925f;
286             start        += band_sizes[g];
287
288             ctx->psy_bands[channel*PSY_MAX_BANDS+w+g].energy = band->energy;
289         }
290     }
291     //modify thresholds - spread, threshold in quiet - 5.4.3 "Spreaded Energy Calculation"
292     for (w = 0; w < wi->num_windows*16; w += 16) {
293         Psy3gppBand *band = &pch->band[w];
294         for (g = 1; g < num_bands; g++)
295             band[g].thr = FFMAX(band[g].thr, band[g-1].thr * coeffs->spread_low[g-1]);
296         for (g = num_bands - 2; g >= 0; g--)
297             band[g].thr = FFMAX(band[g].thr, band[g+1].thr * coeffs->spread_hi [g]);
298         for (g = 0; g < num_bands; g++) {
299             band[g].thr_quiet = FFMAX(band[g].thr, coeffs->ath[g]);
300             if (wi->num_windows != 8 && wi->window_type[1] != EIGHT_SHORT_SEQUENCE)
301                 band[g].thr_quiet = FFMAX(PSY_3GPP_RPEMIN*band[g].thr_quiet,
302                                           FFMIN(band[g].thr_quiet,
303                                           PSY_3GPP_RPELEV*pch->prev_band[w+g].thr_quiet));
304             band[g].thr = FFMAX(band[g].thr, band[g].thr_quiet * 0.25);
305
306             ctx->psy_bands[channel*PSY_MAX_BANDS+w+g].threshold = band[g].thr;
307         }
308     }
309     memcpy(pch->prev_band, pch->band, sizeof(pch->band));
310 }
311
312 static av_cold void psy_3gpp_end(FFPsyContext *apc)
313 {
314     Psy3gppContext *pctx = (Psy3gppContext*) apc->model_priv_data;
315     av_freep(&pctx->ch);
316     av_freep(&apc->model_priv_data);
317 }
318
319
320 const FFPsyModel ff_aac_psy_model =
321 {
322     .name    = "3GPP TS 26.403-inspired model",
323     .init    = psy_3gpp_init,
324     .window  = psy_3gpp_window,
325     .analyze = psy_3gpp_analyze,
326     .end     = psy_3gpp_end,
327 };