/*
|
* Copyright (C) 2003 - 2016 Sony Corporation
|
*
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
* you may not use this file except in compliance with the License.
|
* You may obtain a copy of the License at
|
*
|
* http://www.apache.org/licenses/LICENSE-2.0
|
*
|
* Unless required by applicable law or agreed to in writing, software
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
* See the License for the specific language governing permissions and
|
* limitations under the License.
|
*/
|
|
#include "ldac.h"
|
|
|
#define LDAC_Q_LOWENERGY 11
|
#define LDAC_Q_ADD_LOWENERGY 4
|
|
#define LDAC_TH_LOWENERGY_L (0x070bc28f>>LDAC_Q_ADD_LOWENERGY) /* Q15, _scalar(225.47)(Q19)>>4 */
|
#define LDAC_TH_LOWENERGY_M (0x1c0ce148>>LDAC_Q_ADD_LOWENERGY) /* Q15, _scalar(897.61)(Q19)>>4 */
|
#define LDAC_TH_LOWENERGY_H (0x6fab851f>>LDAC_Q_ADD_LOWENERGY) /* Q15, _scalar(3573.44)(Q19)>>4 */
|
|
#define LDAC_TH_CENTROID 0x00168000 /* Q15, _scalar(45.0) */
|
|
/***************************************************************************************************
|
Lookup Table for Calculating Square Root Value
|
***************************************************************************************************/
|
static INT16 sa_sqrt_ldac[97] = { /* Q14 */
|
0x2d41, 0x2df4, 0x2ea5, 0x2f54, 0x3000, 0x30a9, 0x3150, 0x31f5,
|
0x3298, 0x3339, 0x33d8, 0x3475, 0x3510, 0x35aa, 0x3642, 0x36d8,
|
0x376c, 0x3800, 0x3891, 0x3921, 0x39b0, 0x3a3d, 0x3ac9, 0x3b54,
|
0x3bdd, 0x3c66, 0x3ced, 0x3d72, 0x3df7, 0x3e7b, 0x3efd, 0x3f7f,
|
0x4000, 0x407f, 0x40fe, 0x417b, 0x41f8, 0x4273, 0x42ee, 0x4368,
|
0x43e1, 0x445a, 0x44d1, 0x4548, 0x45be, 0x4633, 0x46a7, 0x471b,
|
0x478d, 0x4800, 0x4871, 0x48e2, 0x4952, 0x49c1, 0x4a30, 0x4a9e,
|
0x4b0b, 0x4b78, 0x4be5, 0x4c50, 0x4cbb, 0x4d26, 0x4d90, 0x4df9,
|
0x4e62, 0x4eca, 0x4f32, 0x4f99, 0x5000, 0x5066, 0x50cb, 0x5130,
|
0x5195, 0x51f9, 0x525d, 0x52c0, 0x5323, 0x5385, 0x53e7, 0x5449,
|
0x54a9, 0x550a, 0x556a, 0x55ca, 0x5629, 0x5688, 0x56e6, 0x5745,
|
0x57a2, 0x5800, 0x585c, 0x58b9, 0x5915, 0x5971, 0x59cc, 0x5a27,
|
0x5a82,
|
};
|
|
/***************************************************************************************************
|
Subfunction: Multiply
|
***************************************************************************************************/
|
__inline static INT32 mul_ldac(
|
INT32 in1,
|
INT32 in2)
|
{
|
INT32 out;
|
INT64 acc;
|
|
/* Q30 <- Q30 * Q30 */
|
acc = (INT64)in1 * in2;
|
acc >>= 30;
|
|
if (acc > LDAC_MAX_32BIT) {
|
out = LDAC_MAX_32BIT;
|
}
|
else if (acc < LDAC_MIN_32BIT) {
|
out = LDAC_MIN_32BIT;
|
}
|
else {
|
out = (INT32)acc;
|
}
|
|
return out;
|
}
|
|
/***************************************************************************************************
|
Subfunction: Subtract
|
***************************************************************************************************/
|
__inline static INT32 sub_ldac(
|
INT32 in1,
|
INT32 in2)
|
{
|
INT32 out;
|
|
out = in1 - in2;
|
|
return out;
|
}
|
|
/***************************************************************************************************
|
Subfunction: Add
|
***************************************************************************************************/
|
__inline static INT32 add_ldac(
|
INT32 in1,
|
INT32 in2)
|
{
|
INT32 out;
|
|
out = in1 + in2;
|
|
return out;
|
}
|
|
/***************************************************************************************************
|
Subfunction: Multiply and Add
|
***************************************************************************************************/
|
__inline static INT32 mad_ldac(
|
INT32 in1,
|
INT32 in2,
|
INT32 in3)
|
{
|
INT32 out;
|
|
out = mul_ldac(in2, in3);
|
out = add_ldac(in1, out);
|
|
return out;
|
}
|
|
/***************************************************************************************************
|
Subfunction: Normalize
|
***************************************************************************************************/
|
__inline static INT16 norm_ldac(
|
UINT32 val)
|
{
|
INT16 len;
|
|
len = 0;
|
while (val > 0) {
|
val >>= 1;
|
len++;
|
}
|
|
return len;
|
}
|
|
/***************************************************************************************************
|
Subfunction: Calculate Exponential
|
***************************************************************************************************/
|
__inline static INT16 calc_exp_ldac(
|
INT32 in_h,
|
UINT32 in_l)
|
{
|
INT16 e;
|
|
if (in_h) {
|
e = norm_ldac((UINT32)in_h) + 32;
|
}
|
else {
|
e = norm_ldac(in_l);
|
}
|
e = (63 - e) & 0xfffe;
|
|
return e;
|
}
|
|
/***************************************************************************************************
|
Subfunction: Calculate Square Root
|
***************************************************************************************************/
|
__inline static INT32 calc_sqrt_ldac(
|
INT32 in,
|
INT16 e)
|
{
|
INT16 i;
|
INT32 val, dif, a;
|
|
if (in <= 0) {
|
return 0;
|
}
|
|
i = (INT16)(in >> 24);
|
a = in & 0x00ffffffL;
|
|
i = i - 32;
|
val = sa_sqrt_ldac[i] << 16; /* Q30 <- Q14 << 16 */
|
dif = sub_ldac(sa_sqrt_ldac[i+1]<<16, val); /* Q30 */
|
a = (INT32)(((INT64)a << 30) >> 24); /* Q30 a = a / 0x1000000 */
|
val = mad_ldac(val, dif, a);
|
val = val >> (e >> 1);
|
|
return val;
|
}
|
|
/***************************************************************************************************
|
Calculate Pseudo Spectrum and Low Band Energy
|
***************************************************************************************************/
|
static INT32 calc_mdct_pseudo_spectrum_ldac(
|
INT32 *p_spec,
|
INT32 *p_psd,
|
UINT32 nsp)
|
{
|
UINT32 isp;
|
INT16 e;
|
INT32 y0, y1, y2;
|
INT32 tmp;
|
INT64 low_energy;
|
INT64 acc1, acc2;
|
|
{
|
y1 = p_spec[0];
|
y2 = p_spec[1];
|
acc1 = (INT64)y1 * (INT64)y1;
|
acc2 = (INT64)y2 * (INT64)y2;
|
acc1 = acc1 + acc2;
|
low_energy = acc1 >> LDAC_Q_ADD_LOWENERGY; /* Q26 <- (Q15 * Q15) >> 4 */
|
e = calc_exp_ldac((INT32)(acc1>>32), (UINT32)(acc1&0xffffffff));
|
tmp = (INT32)((acc1 << e) >> 32);
|
*p_psd++ = calc_sqrt_ldac(tmp, e);
|
}
|
|
for (isp = 1; isp < LDAC_NSP_LOWENERGY; isp++) {
|
y0 = y1;
|
y1 = y2;
|
y2 = p_spec[isp+1];
|
acc1 = (INT64)y1 * (INT64)y1;
|
acc2 = (INT64)(y0-y2) * (INT64)(y0-y2);
|
acc1 = acc1 + acc2;
|
low_energy += acc1 >> LDAC_Q_ADD_LOWENERGY; /* Q26 <- (Q15 * Q15) >> 4 */
|
e = calc_exp_ldac((INT32)(acc1>>32), (UINT32)(acc1&0xffffffff));
|
tmp = (INT32)((acc1 << e) >> 32);
|
*p_psd++ = calc_sqrt_ldac(tmp, e);
|
}
|
|
for (isp = LDAC_NSP_LOWENERGY; isp < nsp-1; isp++) {
|
y0 = y1;
|
y1 = y2;
|
y2 = p_spec[isp+1];
|
acc1 = (INT64)y1 * (INT64)y1;
|
acc2 = (INT64)(y0-y2) * (INT64)(y0-y2);
|
acc1 = acc1 + acc2;
|
e = calc_exp_ldac((INT32)(acc1 >> 32), (UINT32)(acc1&0xffffffff));
|
tmp = (INT32) ((acc1 << e) >> 32);
|
*p_psd++ = calc_sqrt_ldac(tmp, e);
|
}
|
|
{
|
acc1 = (INT64)y1 * (INT64)y1;
|
acc2 = (INT64)y2 * (INT64)y2;
|
acc1 = acc1 + acc2;
|
e = calc_exp_ldac((INT32)(acc1 >> 32), (UINT32)(acc1&0xffffffff));
|
tmp = (INT32)((acc1 << e) >> 32);
|
*p_psd++ = calc_sqrt_ldac(tmp, e);
|
}
|
|
low_energy >>= LDAC_Q_LOWENERGY; /* Q15 <- Q26 >> 11 */
|
if (low_energy > LDAC_MAX_32BIT) {
|
low_energy = LDAC_MAX_32BIT;
|
}
|
|
return (INT32)low_energy;
|
}
|
|
/***************************************************************************************************
|
Calculate Pseudo Spectrum Centroid
|
***************************************************************************************************/
|
static INT32 calc_spectral_centroid_ldac(
|
INT32 *p_spec,
|
UINT32 nsp)
|
{
|
UINT32 isp;
|
INT32 centroid = 0;
|
INT64 s1, s2;
|
|
s1 = s2 = 0;
|
for (isp = 0; isp < nsp; isp++) {
|
s1 += ((INT64)isp * (INT64)*p_spec); /* Q15 <- Q00 * Q15 */
|
s2 += (INT64)*p_spec++; /* Q15 */
|
}
|
|
if (s2 != 0) {
|
centroid = (INT32)((s1<<15) / s2); /* Q15 <- (Q15<<15) / Q15 */
|
}
|
|
return centroid;
|
}
|
|
/***************************************************************************************************
|
Calculate Number of Zero Cross
|
***************************************************************************************************/
|
static UINT32 calc_zero_cross_number_ldac(
|
INT32 *p_time,
|
UINT32 n)
|
{
|
UINT32 i;
|
UINT32 zero_cross = 0;
|
INT32 prev, tmp;
|
|
prev = 0;
|
for (i = 0; i < n; i++) {
|
if ((prev == 0) || (*p_time == 0)) {
|
tmp = 0;
|
}
|
else {
|
tmp = prev ^ (*p_time);
|
}
|
|
if (tmp < 0) {
|
zero_cross++;
|
}
|
prev = *p_time++;
|
}
|
|
return zero_cross;
|
}
|
|
/***************************************************************************************************
|
Analyze Frame Status
|
***************************************************************************************************/
|
DECLSPEC int ana_frame_status_ldac(
|
SFINFO *p_sfinfo,
|
int nlnn)
|
{
|
AC *p_ac;
|
int ich;
|
int nchs = p_sfinfo->cfg.ch;
|
int nsmpl = npow2_ldac(nlnn+1);
|
int cnt;
|
int a_status[LDAC_PRCNCH];
|
UINT32 zero_cross;
|
INT32 low_energy, centroid;
|
INT32 a_psd_spec[LDAC_NSP_PSEUDOANA];
|
|
|
for (ich = 0; ich < nchs; ich++) {
|
p_ac = p_sfinfo->ap_ac[ich];
|
|
low_energy = calc_mdct_pseudo_spectrum_ldac(p_ac->p_acsub->a_spec, a_psd_spec, LDAC_NSP_PSEUDOANA);
|
|
centroid = calc_spectral_centroid_ldac(a_psd_spec, LDAC_NSP_PSEUDOANA);
|
|
zero_cross = calc_zero_cross_number_ldac(p_ac->p_acsub->a_time, nsmpl);
|
|
a_status[ich] = LDAC_FRMSTAT_LEV_0;
|
if (low_energy < LDAC_TH_LOWENERGY_L) {
|
a_status[ich] = LDAC_FRMSTAT_LEV_3;
|
}
|
else {
|
if (low_energy < LDAC_TH_LOWENERGY_M) {
|
a_status[ich] = LDAC_FRMSTAT_LEV_2;
|
}
|
else if (low_energy < LDAC_TH_LOWENERGY_H) {
|
a_status[ich] = LDAC_FRMSTAT_LEV_1;
|
}
|
|
cnt = p_ac->frmana_cnt;
|
if ((centroid > LDAC_TH_CENTROID) && (zero_cross >= LDAC_TH_ZCROSNUM)) {
|
cnt++;
|
|
if (cnt >= LDAC_MAXCNT_FRMANA) {
|
cnt = LDAC_MAXCNT_FRMANA;
|
a_status[ich] = LDAC_FRMSTAT_LEV_2;
|
}
|
else if (a_status[ich] <= LDAC_FRMSTAT_LEV_1) {
|
a_status[ich]++;
|
}
|
}
|
else {
|
cnt = 0;
|
}
|
p_ac->frmana_cnt = cnt;
|
}
|
}
|
|
if (nchs == LDAC_CHANNEL_1CH) {
|
return a_status[0];
|
} else {
|
return min_ldac(a_status[0], a_status[1]);
|
}
|
}
|
