mirror of
https://github.com/godotengine/godot.git
synced 2024-12-15 10:12:40 +08:00
46ae64cd60
This reverts commit e00426c512
.
The way we handle platform-specific intrinsics is not good, so the
current state will not compile on armv8. This commit also requires
SSE4.1 support, which is likely not a good idea for portable binaries.
We'll have to redo this with more caution after 3.2 is released, or
we might simply drop opus as we're only using it as dependency for
theora right now.
Fixes #33606.
673 lines
25 KiB
C
673 lines
25 KiB
C
/* Copyright (c) 2011 Xiph.Org Foundation
|
|
Written by Jean-Marc Valin */
|
|
/*
|
|
Redistribution and use in source and binary forms, with or without
|
|
modification, are permitted provided that the following conditions
|
|
are met:
|
|
|
|
- Redistributions of source code must retain the above copyright
|
|
notice, this list of conditions and the following disclaimer.
|
|
|
|
- Redistributions in binary form must reproduce the above copyright
|
|
notice, this list of conditions and the following disclaimer in the
|
|
documentation and/or other materials provided with the distribution.
|
|
|
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
|
A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR
|
|
CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
|
EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
|
PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
|
PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
|
SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#include "kiss_fft.h"
|
|
#include "celt.h"
|
|
#include "modes.h"
|
|
#include "arch.h"
|
|
#include "quant_bands.h"
|
|
#include <stdio.h>
|
|
#include "analysis.h"
|
|
#include "mlp.h"
|
|
#include "stack_alloc.h"
|
|
|
|
#ifndef M_PI
|
|
#define M_PI 3.141592653
|
|
#endif
|
|
|
|
static const float dct_table[128] = {
|
|
0.250000f, 0.250000f, 0.250000f, 0.250000f, 0.250000f, 0.250000f, 0.250000f, 0.250000f,
|
|
0.250000f, 0.250000f, 0.250000f, 0.250000f, 0.250000f, 0.250000f, 0.250000f, 0.250000f,
|
|
0.351851f, 0.338330f, 0.311806f, 0.273300f, 0.224292f, 0.166664f, 0.102631f, 0.034654f,
|
|
-0.034654f,-0.102631f,-0.166664f,-0.224292f,-0.273300f,-0.311806f,-0.338330f,-0.351851f,
|
|
0.346760f, 0.293969f, 0.196424f, 0.068975f,-0.068975f,-0.196424f,-0.293969f,-0.346760f,
|
|
-0.346760f,-0.293969f,-0.196424f,-0.068975f, 0.068975f, 0.196424f, 0.293969f, 0.346760f,
|
|
0.338330f, 0.224292f, 0.034654f,-0.166664f,-0.311806f,-0.351851f,-0.273300f,-0.102631f,
|
|
0.102631f, 0.273300f, 0.351851f, 0.311806f, 0.166664f,-0.034654f,-0.224292f,-0.338330f,
|
|
0.326641f, 0.135299f,-0.135299f,-0.326641f,-0.326641f,-0.135299f, 0.135299f, 0.326641f,
|
|
0.326641f, 0.135299f,-0.135299f,-0.326641f,-0.326641f,-0.135299f, 0.135299f, 0.326641f,
|
|
0.311806f, 0.034654f,-0.273300f,-0.338330f,-0.102631f, 0.224292f, 0.351851f, 0.166664f,
|
|
-0.166664f,-0.351851f,-0.224292f, 0.102631f, 0.338330f, 0.273300f,-0.034654f,-0.311806f,
|
|
0.293969f,-0.068975f,-0.346760f,-0.196424f, 0.196424f, 0.346760f, 0.068975f,-0.293969f,
|
|
-0.293969f, 0.068975f, 0.346760f, 0.196424f,-0.196424f,-0.346760f,-0.068975f, 0.293969f,
|
|
0.273300f,-0.166664f,-0.338330f, 0.034654f, 0.351851f, 0.102631f,-0.311806f,-0.224292f,
|
|
0.224292f, 0.311806f,-0.102631f,-0.351851f,-0.034654f, 0.338330f, 0.166664f,-0.273300f,
|
|
};
|
|
|
|
static const float analysis_window[240] = {
|
|
0.000043f, 0.000171f, 0.000385f, 0.000685f, 0.001071f, 0.001541f, 0.002098f, 0.002739f,
|
|
0.003466f, 0.004278f, 0.005174f, 0.006156f, 0.007222f, 0.008373f, 0.009607f, 0.010926f,
|
|
0.012329f, 0.013815f, 0.015385f, 0.017037f, 0.018772f, 0.020590f, 0.022490f, 0.024472f,
|
|
0.026535f, 0.028679f, 0.030904f, 0.033210f, 0.035595f, 0.038060f, 0.040604f, 0.043227f,
|
|
0.045928f, 0.048707f, 0.051564f, 0.054497f, 0.057506f, 0.060591f, 0.063752f, 0.066987f,
|
|
0.070297f, 0.073680f, 0.077136f, 0.080665f, 0.084265f, 0.087937f, 0.091679f, 0.095492f,
|
|
0.099373f, 0.103323f, 0.107342f, 0.111427f, 0.115579f, 0.119797f, 0.124080f, 0.128428f,
|
|
0.132839f, 0.137313f, 0.141849f, 0.146447f, 0.151105f, 0.155823f, 0.160600f, 0.165435f,
|
|
0.170327f, 0.175276f, 0.180280f, 0.185340f, 0.190453f, 0.195619f, 0.200838f, 0.206107f,
|
|
0.211427f, 0.216797f, 0.222215f, 0.227680f, 0.233193f, 0.238751f, 0.244353f, 0.250000f,
|
|
0.255689f, 0.261421f, 0.267193f, 0.273005f, 0.278856f, 0.284744f, 0.290670f, 0.296632f,
|
|
0.302628f, 0.308658f, 0.314721f, 0.320816f, 0.326941f, 0.333097f, 0.339280f, 0.345492f,
|
|
0.351729f, 0.357992f, 0.364280f, 0.370590f, 0.376923f, 0.383277f, 0.389651f, 0.396044f,
|
|
0.402455f, 0.408882f, 0.415325f, 0.421783f, 0.428254f, 0.434737f, 0.441231f, 0.447736f,
|
|
0.454249f, 0.460770f, 0.467298f, 0.473832f, 0.480370f, 0.486912f, 0.493455f, 0.500000f,
|
|
0.506545f, 0.513088f, 0.519630f, 0.526168f, 0.532702f, 0.539230f, 0.545751f, 0.552264f,
|
|
0.558769f, 0.565263f, 0.571746f, 0.578217f, 0.584675f, 0.591118f, 0.597545f, 0.603956f,
|
|
0.610349f, 0.616723f, 0.623077f, 0.629410f, 0.635720f, 0.642008f, 0.648271f, 0.654508f,
|
|
0.660720f, 0.666903f, 0.673059f, 0.679184f, 0.685279f, 0.691342f, 0.697372f, 0.703368f,
|
|
0.709330f, 0.715256f, 0.721144f, 0.726995f, 0.732807f, 0.738579f, 0.744311f, 0.750000f,
|
|
0.755647f, 0.761249f, 0.766807f, 0.772320f, 0.777785f, 0.783203f, 0.788573f, 0.793893f,
|
|
0.799162f, 0.804381f, 0.809547f, 0.814660f, 0.819720f, 0.824724f, 0.829673f, 0.834565f,
|
|
0.839400f, 0.844177f, 0.848895f, 0.853553f, 0.858151f, 0.862687f, 0.867161f, 0.871572f,
|
|
0.875920f, 0.880203f, 0.884421f, 0.888573f, 0.892658f, 0.896677f, 0.900627f, 0.904508f,
|
|
0.908321f, 0.912063f, 0.915735f, 0.919335f, 0.922864f, 0.926320f, 0.929703f, 0.933013f,
|
|
0.936248f, 0.939409f, 0.942494f, 0.945503f, 0.948436f, 0.951293f, 0.954072f, 0.956773f,
|
|
0.959396f, 0.961940f, 0.964405f, 0.966790f, 0.969096f, 0.971321f, 0.973465f, 0.975528f,
|
|
0.977510f, 0.979410f, 0.981228f, 0.982963f, 0.984615f, 0.986185f, 0.987671f, 0.989074f,
|
|
0.990393f, 0.991627f, 0.992778f, 0.993844f, 0.994826f, 0.995722f, 0.996534f, 0.997261f,
|
|
0.997902f, 0.998459f, 0.998929f, 0.999315f, 0.999615f, 0.999829f, 0.999957f, 1.000000f,
|
|
};
|
|
|
|
static const int tbands[NB_TBANDS+1] = {
|
|
2, 4, 6, 8, 10, 12, 14, 16, 20, 24, 28, 32, 40, 48, 56, 68, 80, 96, 120
|
|
};
|
|
|
|
static const int extra_bands[NB_TOT_BANDS+1] = {
|
|
1, 2, 4, 6, 8, 10, 12, 14, 16, 20, 24, 28, 32, 40, 48, 56, 68, 80, 96, 120, 160, 200
|
|
};
|
|
|
|
/*static const float tweight[NB_TBANDS+1] = {
|
|
.3, .4, .5, .6, .7, .8, .9, 1., 1., 1., 1., 1., 1., 1., .8, .7, .6, .5
|
|
};*/
|
|
|
|
#define NB_TONAL_SKIP_BANDS 9
|
|
|
|
#define cA 0.43157974f
|
|
#define cB 0.67848403f
|
|
#define cC 0.08595542f
|
|
#define cE ((float)M_PI/2)
|
|
static OPUS_INLINE float fast_atan2f(float y, float x) {
|
|
float x2, y2;
|
|
/* Should avoid underflow on the values we'll get */
|
|
if (ABS16(x)+ABS16(y)<1e-9f)
|
|
{
|
|
x*=1e12f;
|
|
y*=1e12f;
|
|
}
|
|
x2 = x*x;
|
|
y2 = y*y;
|
|
if(x2<y2){
|
|
float den = (y2 + cB*x2) * (y2 + cC*x2);
|
|
if (den!=0)
|
|
return -x*y*(y2 + cA*x2) / den + (y<0 ? -cE : cE);
|
|
else
|
|
return (y<0 ? -cE : cE);
|
|
}else{
|
|
float den = (x2 + cB*y2) * (x2 + cC*y2);
|
|
if (den!=0)
|
|
return x*y*(x2 + cA*y2) / den + (y<0 ? -cE : cE) - (x*y<0 ? -cE : cE);
|
|
else
|
|
return (y<0 ? -cE : cE) - (x*y<0 ? -cE : cE);
|
|
}
|
|
}
|
|
|
|
void tonality_analysis_init(TonalityAnalysisState *tonal)
|
|
{
|
|
/* Initialize reusable fields. */
|
|
tonal->arch = opus_select_arch();
|
|
/* Clear remaining fields. */
|
|
tonality_analysis_reset(tonal);
|
|
}
|
|
|
|
void tonality_analysis_reset(TonalityAnalysisState *tonal)
|
|
{
|
|
/* Clear non-reusable fields. */
|
|
char *start = (char*)&tonal->TONALITY_ANALYSIS_RESET_START;
|
|
OPUS_CLEAR(start, sizeof(TonalityAnalysisState) - (start - (char*)tonal));
|
|
}
|
|
|
|
void tonality_get_info(TonalityAnalysisState *tonal, AnalysisInfo *info_out, int len)
|
|
{
|
|
int pos;
|
|
int curr_lookahead;
|
|
float psum;
|
|
int i;
|
|
|
|
pos = tonal->read_pos;
|
|
curr_lookahead = tonal->write_pos-tonal->read_pos;
|
|
if (curr_lookahead<0)
|
|
curr_lookahead += DETECT_SIZE;
|
|
|
|
if (len > 480 && pos != tonal->write_pos)
|
|
{
|
|
pos++;
|
|
if (pos==DETECT_SIZE)
|
|
pos=0;
|
|
}
|
|
if (pos == tonal->write_pos)
|
|
pos--;
|
|
if (pos<0)
|
|
pos = DETECT_SIZE-1;
|
|
OPUS_COPY(info_out, &tonal->info[pos], 1);
|
|
tonal->read_subframe += len/120;
|
|
while (tonal->read_subframe>=4)
|
|
{
|
|
tonal->read_subframe -= 4;
|
|
tonal->read_pos++;
|
|
}
|
|
if (tonal->read_pos>=DETECT_SIZE)
|
|
tonal->read_pos-=DETECT_SIZE;
|
|
|
|
/* Compensate for the delay in the features themselves.
|
|
FIXME: Need a better estimate the 10 I just made up */
|
|
curr_lookahead = IMAX(curr_lookahead-10, 0);
|
|
|
|
psum=0;
|
|
/* Summing the probability of transition patterns that involve music at
|
|
time (DETECT_SIZE-curr_lookahead-1) */
|
|
for (i=0;i<DETECT_SIZE-curr_lookahead;i++)
|
|
psum += tonal->pmusic[i];
|
|
for (;i<DETECT_SIZE;i++)
|
|
psum += tonal->pspeech[i];
|
|
psum = psum*tonal->music_confidence + (1-psum)*tonal->speech_confidence;
|
|
/*printf("%f %f %f\n", psum, info_out->music_prob, info_out->tonality);*/
|
|
|
|
info_out->music_prob = psum;
|
|
}
|
|
|
|
static void tonality_analysis(TonalityAnalysisState *tonal, const CELTMode *celt_mode, const void *x, int len, int offset, int c1, int c2, int C, int lsb_depth, downmix_func downmix)
|
|
{
|
|
int i, b;
|
|
const kiss_fft_state *kfft;
|
|
VARDECL(kiss_fft_cpx, in);
|
|
VARDECL(kiss_fft_cpx, out);
|
|
int N = 480, N2=240;
|
|
float * OPUS_RESTRICT A = tonal->angle;
|
|
float * OPUS_RESTRICT dA = tonal->d_angle;
|
|
float * OPUS_RESTRICT d2A = tonal->d2_angle;
|
|
VARDECL(float, tonality);
|
|
VARDECL(float, noisiness);
|
|
float band_tonality[NB_TBANDS];
|
|
float logE[NB_TBANDS];
|
|
float BFCC[8];
|
|
float features[25];
|
|
float frame_tonality;
|
|
float max_frame_tonality;
|
|
/*float tw_sum=0;*/
|
|
float frame_noisiness;
|
|
const float pi4 = (float)(M_PI*M_PI*M_PI*M_PI);
|
|
float slope=0;
|
|
float frame_stationarity;
|
|
float relativeE;
|
|
float frame_probs[2];
|
|
float alpha, alphaE, alphaE2;
|
|
float frame_loudness;
|
|
float bandwidth_mask;
|
|
int bandwidth=0;
|
|
float maxE = 0;
|
|
float noise_floor;
|
|
int remaining;
|
|
AnalysisInfo *info;
|
|
SAVE_STACK;
|
|
|
|
tonal->last_transition++;
|
|
alpha = 1.f/IMIN(20, 1+tonal->count);
|
|
alphaE = 1.f/IMIN(50, 1+tonal->count);
|
|
alphaE2 = 1.f/IMIN(1000, 1+tonal->count);
|
|
|
|
if (tonal->count<4)
|
|
tonal->music_prob = .5;
|
|
kfft = celt_mode->mdct.kfft[0];
|
|
if (tonal->count==0)
|
|
tonal->mem_fill = 240;
|
|
downmix(x, &tonal->inmem[tonal->mem_fill], IMIN(len, ANALYSIS_BUF_SIZE-tonal->mem_fill), offset, c1, c2, C);
|
|
if (tonal->mem_fill+len < ANALYSIS_BUF_SIZE)
|
|
{
|
|
tonal->mem_fill += len;
|
|
/* Don't have enough to update the analysis */
|
|
RESTORE_STACK;
|
|
return;
|
|
}
|
|
info = &tonal->info[tonal->write_pos++];
|
|
if (tonal->write_pos>=DETECT_SIZE)
|
|
tonal->write_pos-=DETECT_SIZE;
|
|
|
|
ALLOC(in, 480, kiss_fft_cpx);
|
|
ALLOC(out, 480, kiss_fft_cpx);
|
|
ALLOC(tonality, 240, float);
|
|
ALLOC(noisiness, 240, float);
|
|
for (i=0;i<N2;i++)
|
|
{
|
|
float w = analysis_window[i];
|
|
in[i].r = (kiss_fft_scalar)(w*tonal->inmem[i]);
|
|
in[i].i = (kiss_fft_scalar)(w*tonal->inmem[N2+i]);
|
|
in[N-i-1].r = (kiss_fft_scalar)(w*tonal->inmem[N-i-1]);
|
|
in[N-i-1].i = (kiss_fft_scalar)(w*tonal->inmem[N+N2-i-1]);
|
|
}
|
|
OPUS_MOVE(tonal->inmem, tonal->inmem+ANALYSIS_BUF_SIZE-240, 240);
|
|
remaining = len - (ANALYSIS_BUF_SIZE-tonal->mem_fill);
|
|
downmix(x, &tonal->inmem[240], remaining, offset+ANALYSIS_BUF_SIZE-tonal->mem_fill, c1, c2, C);
|
|
tonal->mem_fill = 240 + remaining;
|
|
opus_fft(kfft, in, out, tonal->arch);
|
|
#ifndef FIXED_POINT
|
|
/* If there's any NaN on the input, the entire output will be NaN, so we only need to check one value. */
|
|
if (celt_isnan(out[0].r))
|
|
{
|
|
info->valid = 0;
|
|
RESTORE_STACK;
|
|
return;
|
|
}
|
|
#endif
|
|
|
|
for (i=1;i<N2;i++)
|
|
{
|
|
float X1r, X2r, X1i, X2i;
|
|
float angle, d_angle, d2_angle;
|
|
float angle2, d_angle2, d2_angle2;
|
|
float mod1, mod2, avg_mod;
|
|
X1r = (float)out[i].r+out[N-i].r;
|
|
X1i = (float)out[i].i-out[N-i].i;
|
|
X2r = (float)out[i].i+out[N-i].i;
|
|
X2i = (float)out[N-i].r-out[i].r;
|
|
|
|
angle = (float)(.5f/M_PI)*fast_atan2f(X1i, X1r);
|
|
d_angle = angle - A[i];
|
|
d2_angle = d_angle - dA[i];
|
|
|
|
angle2 = (float)(.5f/M_PI)*fast_atan2f(X2i, X2r);
|
|
d_angle2 = angle2 - angle;
|
|
d2_angle2 = d_angle2 - d_angle;
|
|
|
|
mod1 = d2_angle - (float)floor(.5+d2_angle);
|
|
noisiness[i] = ABS16(mod1);
|
|
mod1 *= mod1;
|
|
mod1 *= mod1;
|
|
|
|
mod2 = d2_angle2 - (float)floor(.5+d2_angle2);
|
|
noisiness[i] += ABS16(mod2);
|
|
mod2 *= mod2;
|
|
mod2 *= mod2;
|
|
|
|
avg_mod = .25f*(d2A[i]+2.f*mod1+mod2);
|
|
tonality[i] = 1.f/(1.f+40.f*16.f*pi4*avg_mod)-.015f;
|
|
|
|
A[i] = angle2;
|
|
dA[i] = d_angle2;
|
|
d2A[i] = mod2;
|
|
}
|
|
|
|
frame_tonality = 0;
|
|
max_frame_tonality = 0;
|
|
/*tw_sum = 0;*/
|
|
info->activity = 0;
|
|
frame_noisiness = 0;
|
|
frame_stationarity = 0;
|
|
if (!tonal->count)
|
|
{
|
|
for (b=0;b<NB_TBANDS;b++)
|
|
{
|
|
tonal->lowE[b] = 1e10;
|
|
tonal->highE[b] = -1e10;
|
|
}
|
|
}
|
|
relativeE = 0;
|
|
frame_loudness = 0;
|
|
for (b=0;b<NB_TBANDS;b++)
|
|
{
|
|
float E=0, tE=0, nE=0;
|
|
float L1, L2;
|
|
float stationarity;
|
|
for (i=tbands[b];i<tbands[b+1];i++)
|
|
{
|
|
float binE = out[i].r*(float)out[i].r + out[N-i].r*(float)out[N-i].r
|
|
+ out[i].i*(float)out[i].i + out[N-i].i*(float)out[N-i].i;
|
|
#ifdef FIXED_POINT
|
|
/* FIXME: It's probably best to change the BFCC filter initial state instead */
|
|
binE *= 5.55e-17f;
|
|
#endif
|
|
E += binE;
|
|
tE += binE*tonality[i];
|
|
nE += binE*2.f*(.5f-noisiness[i]);
|
|
}
|
|
#ifndef FIXED_POINT
|
|
/* Check for extreme band energies that could cause NaNs later. */
|
|
if (!(E<1e9f) || celt_isnan(E))
|
|
{
|
|
info->valid = 0;
|
|
RESTORE_STACK;
|
|
return;
|
|
}
|
|
#endif
|
|
|
|
tonal->E[tonal->E_count][b] = E;
|
|
frame_noisiness += nE/(1e-15f+E);
|
|
|
|
frame_loudness += (float)sqrt(E+1e-10f);
|
|
logE[b] = (float)log(E+1e-10f);
|
|
tonal->lowE[b] = MIN32(logE[b], tonal->lowE[b]+.01f);
|
|
tonal->highE[b] = MAX32(logE[b], tonal->highE[b]-.1f);
|
|
if (tonal->highE[b] < tonal->lowE[b]+1.f)
|
|
{
|
|
tonal->highE[b]+=.5f;
|
|
tonal->lowE[b]-=.5f;
|
|
}
|
|
relativeE += (logE[b]-tonal->lowE[b])/(1e-15f+tonal->highE[b]-tonal->lowE[b]);
|
|
|
|
L1=L2=0;
|
|
for (i=0;i<NB_FRAMES;i++)
|
|
{
|
|
L1 += (float)sqrt(tonal->E[i][b]);
|
|
L2 += tonal->E[i][b];
|
|
}
|
|
|
|
stationarity = MIN16(0.99f,L1/(float)sqrt(1e-15+NB_FRAMES*L2));
|
|
stationarity *= stationarity;
|
|
stationarity *= stationarity;
|
|
frame_stationarity += stationarity;
|
|
/*band_tonality[b] = tE/(1e-15+E)*/;
|
|
band_tonality[b] = MAX16(tE/(1e-15f+E), stationarity*tonal->prev_band_tonality[b]);
|
|
#if 0
|
|
if (b>=NB_TONAL_SKIP_BANDS)
|
|
{
|
|
frame_tonality += tweight[b]*band_tonality[b];
|
|
tw_sum += tweight[b];
|
|
}
|
|
#else
|
|
frame_tonality += band_tonality[b];
|
|
if (b>=NB_TBANDS-NB_TONAL_SKIP_BANDS)
|
|
frame_tonality -= band_tonality[b-NB_TBANDS+NB_TONAL_SKIP_BANDS];
|
|
#endif
|
|
max_frame_tonality = MAX16(max_frame_tonality, (1.f+.03f*(b-NB_TBANDS))*frame_tonality);
|
|
slope += band_tonality[b]*(b-8);
|
|
/*printf("%f %f ", band_tonality[b], stationarity);*/
|
|
tonal->prev_band_tonality[b] = band_tonality[b];
|
|
}
|
|
|
|
bandwidth_mask = 0;
|
|
bandwidth = 0;
|
|
maxE = 0;
|
|
noise_floor = 5.7e-4f/(1<<(IMAX(0,lsb_depth-8)));
|
|
#ifdef FIXED_POINT
|
|
noise_floor *= 1<<(15+SIG_SHIFT);
|
|
#endif
|
|
noise_floor *= noise_floor;
|
|
for (b=0;b<NB_TOT_BANDS;b++)
|
|
{
|
|
float E=0;
|
|
int band_start, band_end;
|
|
/* Keep a margin of 300 Hz for aliasing */
|
|
band_start = extra_bands[b];
|
|
band_end = extra_bands[b+1];
|
|
for (i=band_start;i<band_end;i++)
|
|
{
|
|
float binE = out[i].r*(float)out[i].r + out[N-i].r*(float)out[N-i].r
|
|
+ out[i].i*(float)out[i].i + out[N-i].i*(float)out[N-i].i;
|
|
E += binE;
|
|
}
|
|
maxE = MAX32(maxE, E);
|
|
tonal->meanE[b] = MAX32((1-alphaE2)*tonal->meanE[b], E);
|
|
E = MAX32(E, tonal->meanE[b]);
|
|
/* Use a simple follower with 13 dB/Bark slope for spreading function */
|
|
bandwidth_mask = MAX32(.05f*bandwidth_mask, E);
|
|
/* Consider the band "active" only if all these conditions are met:
|
|
1) less than 10 dB below the simple follower
|
|
2) less than 90 dB below the peak band (maximal masking possible considering
|
|
both the ATH and the loudness-dependent slope of the spreading function)
|
|
3) above the PCM quantization noise floor
|
|
*/
|
|
if (E>.1*bandwidth_mask && E*1e9f > maxE && E > noise_floor*(band_end-band_start))
|
|
bandwidth = b;
|
|
}
|
|
if (tonal->count<=2)
|
|
bandwidth = 20;
|
|
frame_loudness = 20*(float)log10(frame_loudness);
|
|
tonal->Etracker = MAX32(tonal->Etracker-.03f, frame_loudness);
|
|
tonal->lowECount *= (1-alphaE);
|
|
if (frame_loudness < tonal->Etracker-30)
|
|
tonal->lowECount += alphaE;
|
|
|
|
for (i=0;i<8;i++)
|
|
{
|
|
float sum=0;
|
|
for (b=0;b<16;b++)
|
|
sum += dct_table[i*16+b]*logE[b];
|
|
BFCC[i] = sum;
|
|
}
|
|
|
|
frame_stationarity /= NB_TBANDS;
|
|
relativeE /= NB_TBANDS;
|
|
if (tonal->count<10)
|
|
relativeE = .5;
|
|
frame_noisiness /= NB_TBANDS;
|
|
#if 1
|
|
info->activity = frame_noisiness + (1-frame_noisiness)*relativeE;
|
|
#else
|
|
info->activity = .5*(1+frame_noisiness-frame_stationarity);
|
|
#endif
|
|
frame_tonality = (max_frame_tonality/(NB_TBANDS-NB_TONAL_SKIP_BANDS));
|
|
frame_tonality = MAX16(frame_tonality, tonal->prev_tonality*.8f);
|
|
tonal->prev_tonality = frame_tonality;
|
|
|
|
slope /= 8*8;
|
|
info->tonality_slope = slope;
|
|
|
|
tonal->E_count = (tonal->E_count+1)%NB_FRAMES;
|
|
tonal->count++;
|
|
info->tonality = frame_tonality;
|
|
|
|
for (i=0;i<4;i++)
|
|
features[i] = -0.12299f*(BFCC[i]+tonal->mem[i+24]) + 0.49195f*(tonal->mem[i]+tonal->mem[i+16]) + 0.69693f*tonal->mem[i+8] - 1.4349f*tonal->cmean[i];
|
|
|
|
for (i=0;i<4;i++)
|
|
tonal->cmean[i] = (1-alpha)*tonal->cmean[i] + alpha*BFCC[i];
|
|
|
|
for (i=0;i<4;i++)
|
|
features[4+i] = 0.63246f*(BFCC[i]-tonal->mem[i+24]) + 0.31623f*(tonal->mem[i]-tonal->mem[i+16]);
|
|
for (i=0;i<3;i++)
|
|
features[8+i] = 0.53452f*(BFCC[i]+tonal->mem[i+24]) - 0.26726f*(tonal->mem[i]+tonal->mem[i+16]) -0.53452f*tonal->mem[i+8];
|
|
|
|
if (tonal->count > 5)
|
|
{
|
|
for (i=0;i<9;i++)
|
|
tonal->std[i] = (1-alpha)*tonal->std[i] + alpha*features[i]*features[i];
|
|
}
|
|
|
|
for (i=0;i<8;i++)
|
|
{
|
|
tonal->mem[i+24] = tonal->mem[i+16];
|
|
tonal->mem[i+16] = tonal->mem[i+8];
|
|
tonal->mem[i+8] = tonal->mem[i];
|
|
tonal->mem[i] = BFCC[i];
|
|
}
|
|
for (i=0;i<9;i++)
|
|
features[11+i] = (float)sqrt(tonal->std[i]);
|
|
features[20] = info->tonality;
|
|
features[21] = info->activity;
|
|
features[22] = frame_stationarity;
|
|
features[23] = info->tonality_slope;
|
|
features[24] = tonal->lowECount;
|
|
|
|
#ifndef DISABLE_FLOAT_API
|
|
mlp_process(&net, features, frame_probs);
|
|
frame_probs[0] = .5f*(frame_probs[0]+1);
|
|
/* Curve fitting between the MLP probability and the actual probability */
|
|
frame_probs[0] = .01f + 1.21f*frame_probs[0]*frame_probs[0] - .23f*(float)pow(frame_probs[0], 10);
|
|
/* Probability of active audio (as opposed to silence) */
|
|
frame_probs[1] = .5f*frame_probs[1]+.5f;
|
|
/* Consider that silence has a 50-50 probability. */
|
|
frame_probs[0] = frame_probs[1]*frame_probs[0] + (1-frame_probs[1])*.5f;
|
|
|
|
/*printf("%f %f ", frame_probs[0], frame_probs[1]);*/
|
|
{
|
|
/* Probability of state transition */
|
|
float tau;
|
|
/* Represents independence of the MLP probabilities, where
|
|
beta=1 means fully independent. */
|
|
float beta;
|
|
/* Denormalized probability of speech (p0) and music (p1) after update */
|
|
float p0, p1;
|
|
/* Probabilities for "all speech" and "all music" */
|
|
float s0, m0;
|
|
/* Probability sum for renormalisation */
|
|
float psum;
|
|
/* Instantaneous probability of speech and music, with beta pre-applied. */
|
|
float speech0;
|
|
float music0;
|
|
float p, q;
|
|
|
|
/* One transition every 3 minutes of active audio */
|
|
tau = .00005f*frame_probs[1];
|
|
/* Adapt beta based on how "unexpected" the new prob is */
|
|
p = MAX16(.05f,MIN16(.95f,frame_probs[0]));
|
|
q = MAX16(.05f,MIN16(.95f,tonal->music_prob));
|
|
beta = .01f+.05f*ABS16(p-q)/(p*(1-q)+q*(1-p));
|
|
/* p0 and p1 are the probabilities of speech and music at this frame
|
|
using only information from previous frame and applying the
|
|
state transition model */
|
|
p0 = (1-tonal->music_prob)*(1-tau) + tonal->music_prob *tau;
|
|
p1 = tonal->music_prob *(1-tau) + (1-tonal->music_prob)*tau;
|
|
/* We apply the current probability with exponent beta to work around
|
|
the fact that the probability estimates aren't independent. */
|
|
p0 *= (float)pow(1-frame_probs[0], beta);
|
|
p1 *= (float)pow(frame_probs[0], beta);
|
|
/* Normalise the probabilities to get the Marokv probability of music. */
|
|
tonal->music_prob = p1/(p0+p1);
|
|
info->music_prob = tonal->music_prob;
|
|
|
|
/* This chunk of code deals with delayed decision. */
|
|
psum=1e-20f;
|
|
/* Instantaneous probability of speech and music, with beta pre-applied. */
|
|
speech0 = (float)pow(1-frame_probs[0], beta);
|
|
music0 = (float)pow(frame_probs[0], beta);
|
|
if (tonal->count==1)
|
|
{
|
|
tonal->pspeech[0]=.5;
|
|
tonal->pmusic [0]=.5;
|
|
}
|
|
/* Updated probability of having only speech (s0) or only music (m0),
|
|
before considering the new observation. */
|
|
s0 = tonal->pspeech[0] + tonal->pspeech[1];
|
|
m0 = tonal->pmusic [0] + tonal->pmusic [1];
|
|
/* Updates s0 and m0 with instantaneous probability. */
|
|
tonal->pspeech[0] = s0*(1-tau)*speech0;
|
|
tonal->pmusic [0] = m0*(1-tau)*music0;
|
|
/* Propagate the transition probabilities */
|
|
for (i=1;i<DETECT_SIZE-1;i++)
|
|
{
|
|
tonal->pspeech[i] = tonal->pspeech[i+1]*speech0;
|
|
tonal->pmusic [i] = tonal->pmusic [i+1]*music0;
|
|
}
|
|
/* Probability that the latest frame is speech, when all the previous ones were music. */
|
|
tonal->pspeech[DETECT_SIZE-1] = m0*tau*speech0;
|
|
/* Probability that the latest frame is music, when all the previous ones were speech. */
|
|
tonal->pmusic [DETECT_SIZE-1] = s0*tau*music0;
|
|
|
|
/* Renormalise probabilities to 1 */
|
|
for (i=0;i<DETECT_SIZE;i++)
|
|
psum += tonal->pspeech[i] + tonal->pmusic[i];
|
|
psum = 1.f/psum;
|
|
for (i=0;i<DETECT_SIZE;i++)
|
|
{
|
|
tonal->pspeech[i] *= psum;
|
|
tonal->pmusic [i] *= psum;
|
|
}
|
|
psum = tonal->pmusic[0];
|
|
for (i=1;i<DETECT_SIZE;i++)
|
|
psum += tonal->pspeech[i];
|
|
|
|
/* Estimate our confidence in the speech/music decisions */
|
|
if (frame_probs[1]>.75)
|
|
{
|
|
if (tonal->music_prob>.9)
|
|
{
|
|
float adapt;
|
|
adapt = 1.f/(++tonal->music_confidence_count);
|
|
tonal->music_confidence_count = IMIN(tonal->music_confidence_count, 500);
|
|
tonal->music_confidence += adapt*MAX16(-.2f,frame_probs[0]-tonal->music_confidence);
|
|
}
|
|
if (tonal->music_prob<.1)
|
|
{
|
|
float adapt;
|
|
adapt = 1.f/(++tonal->speech_confidence_count);
|
|
tonal->speech_confidence_count = IMIN(tonal->speech_confidence_count, 500);
|
|
tonal->speech_confidence += adapt*MIN16(.2f,frame_probs[0]-tonal->speech_confidence);
|
|
}
|
|
} else {
|
|
if (tonal->music_confidence_count==0)
|
|
tonal->music_confidence = .9f;
|
|
if (tonal->speech_confidence_count==0)
|
|
tonal->speech_confidence = .1f;
|
|
}
|
|
}
|
|
if (tonal->last_music != (tonal->music_prob>.5f))
|
|
tonal->last_transition=0;
|
|
tonal->last_music = tonal->music_prob>.5f;
|
|
#else
|
|
info->music_prob = 0;
|
|
#endif
|
|
/*for (i=0;i<25;i++)
|
|
printf("%f ", features[i]);
|
|
printf("\n");*/
|
|
|
|
info->bandwidth = bandwidth;
|
|
/*printf("%d %d\n", info->bandwidth, info->opus_bandwidth);*/
|
|
info->noisiness = frame_noisiness;
|
|
info->valid = 1;
|
|
RESTORE_STACK;
|
|
}
|
|
|
|
void run_analysis(TonalityAnalysisState *analysis, const CELTMode *celt_mode, const void *analysis_pcm,
|
|
int analysis_frame_size, int frame_size, int c1, int c2, int C, opus_int32 Fs,
|
|
int lsb_depth, downmix_func downmix, AnalysisInfo *analysis_info)
|
|
{
|
|
int offset;
|
|
int pcm_len;
|
|
|
|
if (analysis_pcm != NULL)
|
|
{
|
|
/* Avoid overflow/wrap-around of the analysis buffer */
|
|
analysis_frame_size = IMIN((DETECT_SIZE-5)*Fs/100, analysis_frame_size);
|
|
|
|
pcm_len = analysis_frame_size - analysis->analysis_offset;
|
|
offset = analysis->analysis_offset;
|
|
do {
|
|
tonality_analysis(analysis, celt_mode, analysis_pcm, IMIN(480, pcm_len), offset, c1, c2, C, lsb_depth, downmix);
|
|
offset += 480;
|
|
pcm_len -= 480;
|
|
} while (pcm_len>0);
|
|
analysis->analysis_offset = analysis_frame_size;
|
|
|
|
analysis->analysis_offset -= frame_size;
|
|
}
|
|
|
|
analysis_info->valid = 0;
|
|
tonality_get_info(analysis, analysis_info, frame_size);
|
|
}
|