#include "attdet.h"
bool lc3_attdet_run(enum lc3_dt dt, enum lc3_srate sr,
int nbytes, struct lc3_attdet_analysis *attdet, const int16_t *x)
{
const int nbytes_ranges[][LC3_NUM_SRATE - LC3_SRATE_32K][2] = {
[LC3_DT_7M5 - LC3_DT_7M5] = { { 61, 149 }, { 75, 149 } },
[LC3_DT_10M - LC3_DT_7M5] = { { 81, INT_MAX }, { 100, INT_MAX } },
};
if (dt < LC3_DT_7M5 || sr < LC3_SRATE_32K || lc3_hr(sr) ||
nbytes < nbytes_ranges[dt - LC3_DT_7M5][sr - LC3_SRATE_32K][0] ||
nbytes > nbytes_ranges[dt - LC3_DT_7M5][sr - LC3_SRATE_32K][1] )
return 0;
int nblk = 4 - (dt == LC3_DT_7M5);
int32_t e[4];
for (int i = 0; i < nblk; i++) {
e[i] = 0;
if (sr == LC3_SRATE_32K) {
int16_t xn2 = (x[-4] + x[-3]) >> 1;
int16_t xn1 = (x[-2] + x[-1]) >> 1;
int16_t xn, xf;
for (int j = 0; j < 40; j++, x += 2, xn2 = xn1, xn1 = xn) {
xn = (x[0] + x[1]) >> 1;
xf = (3 * xn - 4 * xn1 + 1 * xn2) >> 3;
e[i] += (xf * xf) >> 5;
}
}
else {
int16_t xn2 = (x[-6] + x[-5] + x[-4]) >> 2;
int16_t xn1 = (x[-3] + x[-2] + x[-1]) >> 2;
int16_t xn, xf;
for (int j = 0; j < 40; j++, x += 3, xn2 = xn1, xn1 = xn) {
xn = (x[0] + x[1] + x[2]) >> 2;
xf = (3 * xn - 4 * xn1 + 1 * xn2) >> 3;
e[i] += (xf * xf) >> 5;
}
}
}
int p_att = 0;
int32_t a[4];
for (int i = 0; i < nblk; i++) {
a[i] = LC3_MAX(attdet->an1 >> 2, attdet->en1);
attdet->en1 = e[i], attdet->an1 = a[i];
if ((e[i] >> 3) > a[i] + (a[i] >> 4))
p_att = i + 1;
}
int att = attdet->p_att >= 1 + (nblk >> 1) || p_att > 0;
attdet->p_att = p_att;
return att;
}