int CLpd_FAC_Read(HANDLE_FDK_BITSTREAM hBs, FIXP_DBL *pFac, SCHAR *pFacScale,
int length, int use_gain, int frame) {
FIXP_DBL fac_gain;
int fac_gain_e = 0;
if (use_gain) {
CLpd_DecodeGain(&fac_gain, &fac_gain_e, FDKreadBits(hBs, 7));
}
if (CLpc_DecodeAVQ(hBs, pFac, 1, 1, length) != 0) {
return -1;
}
{
int scale;
scale = getScalefactor(pFac, length);
scaleValues(pFac, length, scale);
pFacScale[frame] = DFRACT_BITS - 1 - scale;
}
if (use_gain) {
int i;
pFacScale[frame] += fac_gain_e;
for (i = 0; i < length; i++) {
pFac[i] = fMult(pFac[i], fac_gain);
}
}
return 0;
}
void imdct_gain(FIXP_DBL *pGain_m, int *pGain_e, int tl)
{
FIXP_DBL gain_m = *pGain_m;
int gain_e = *pGain_e;
int log2_tl;
log2_tl = DFRACT_BITS-1-fNormz((FIXP_DBL)tl);
gain_e += -MDCT_OUTPUT_GAIN - log2_tl - MDCT_OUT_HEADROOM + 1;
/* Detect non-radix 2 transform length and add amplitude compensation factor
which cannot be included into the exponent above */
switch ( (tl) >> (log2_tl - 2) ) {
case 0x7: /* 10 ms, 1/tl = 1.0/(FDKpow(2.0, -log2_tl) * 0.53333333333333333333) */
if (gain_m == (FIXP_DBL)0) {
gain_m = FL2FXCONST_DBL(0.53333333333333333333f);
} else {
gain_m = fMult(gain_m, FL2FXCONST_DBL(0.53333333333333333333f));
}
break;
case 0x6: /* 3/4 of radix 2, 1/tl = 1.0/(FDKpow(2.0, -log2_tl) * 2.0/3.0) */
if (gain_m == (FIXP_DBL)0) {
gain_m = FL2FXCONST_DBL(2.0/3.0f);
} else {
gain_m = fMult(gain_m, FL2FXCONST_DBL(2.0/3.0f));
}
break;
case 0x4:
/* radix 2, nothing to do. */
break;
default:
/* unsupported */
FDK_ASSERT(0);
break;
}
*pGain_m = gain_m;
*pGain_e = gain_e;
}
void Pred_lt4_postfilter(FIXP_DBL exc[] /* in/out: excitation buffer */
) {
/*
exc[i] = A*exc[i-1] + B*exc[i] + A*exc[i+1]
exc[i+1] = A*exc[i] + B*exc[i+1] + A*exc[i+2] ; i = 0:2:62
*/
int i;
FIXP_DBL sum0, sum1, a_exc0, a_exc1;
a_exc0 = fMultDiv2(A2, exc[-1]);
a_exc1 = fMultDiv2(A2, exc[0]);
/* ARM926: 22 cycles/iteration */
for (i = 0; i < L_SUBFR; i += 2) {
sum0 = a_exc0 + fMult(B, exc[i]);
sum1 = a_exc1 + fMult(B, exc[i + 1]);
a_exc0 = fMultDiv2(A2, exc[i + 1]);
a_exc1 = fMultDiv2(A2, exc[i + 2]);
exc[i] = sum0 + a_exc0;
exc[i + 1] = sum1 + a_exc1;
}
return;
}
void CFac_ApplyGains(FIXP_DBL fac_data[LFAC], const INT fac_length,
const FIXP_DBL tcx_gain, const FIXP_DBL alfd_gains[],
const INT mod) {
FIXP_DBL facFactor;
int i;
FDK_ASSERT((fac_length == 128) || (fac_length == 96));
/* 2) Apply gain factor to FAC data */
facFactor = fMult(gainFac[mod], tcx_gain);
for (i = 0; i < fac_length; i++) {
fac_data[i] = fMult(fac_data[i], facFactor);
}
/* 3) Apply spectrum deshaping using alfd_gains */
for (i = 0; i < fac_length / 4; i++) {
int k;
k = i >> (3 - mod);
fac_data[i] = fMult(fac_data[i], alfd_gains[k])
<< 1; /* alfd_gains is scaled by one bit. */
}
}
/*!
\brief Convert from coupled channels to independent L/R data
*/
static void
sbr_envelope_unmapping (HANDLE_SBR_HEADER_DATA hHeaderData, /*!< Static control data */
HANDLE_SBR_FRAME_DATA h_data_left, /*!< pointer to left channel */
HANDLE_SBR_FRAME_DATA h_data_right) /*!< pointer to right channel */
{
int i;
FIXP_SGL tempL_m, tempR_m, tempRplus1_m, newL_m, newR_m;
SCHAR tempL_e, tempR_e, tempRplus1_e, newL_e, newR_e;
/* 1. Unmap (already dequantized) coupled envelope energies */
for (i = 0; i < h_data_left->nScaleFactors; i++) {
tempR_m = (FIXP_SGL)((LONG)h_data_right->iEnvelope[i] & MASK_M);
tempR_e = (SCHAR)((LONG)h_data_right->iEnvelope[i] & MASK_E);
tempR_e -= (18 + NRG_EXP_OFFSET); /* -18 = ld(UNMAPPING_SCALE / h_data_right->nChannels) */
tempL_m = (FIXP_SGL)((LONG)h_data_left->iEnvelope[i] & MASK_M);
tempL_e = (SCHAR)((LONG)h_data_left->iEnvelope[i] & MASK_E);
tempL_e -= NRG_EXP_OFFSET;
/* Calculate tempRight+1 */
FDK_add_MantExp( tempR_m, tempR_e,
FL2FXCONST_SGL(0.5f), 1, /* 1.0 */
&tempRplus1_m, &tempRplus1_e);
FDK_divide_MantExp( tempL_m, tempL_e+1, /* 2 * tempLeft */
tempRplus1_m, tempRplus1_e,
&newR_m, &newR_e );
if (newR_m >= ((FIXP_SGL)MAXVAL_SGL - ROUNDING)) {
newR_m >>= 1;
newR_e += 1;
}
newL_m = FX_DBL2FX_SGL(fMult(tempR_m,newR_m));
newL_e = tempR_e + newR_e;
h_data_right->iEnvelope[i] = ((FIXP_SGL)((SHORT)(FIXP_SGL)(newR_m + ROUNDING) & MASK_M)) +
(FIXP_SGL)((SHORT)(FIXP_SGL)(newR_e + NRG_EXP_OFFSET) & MASK_E);
h_data_left->iEnvelope[i] = ((FIXP_SGL)((SHORT)(FIXP_SGL)(newL_m + ROUNDING) & MASK_M)) +
(FIXP_SGL)((SHORT)(FIXP_SGL)(newL_e + NRG_EXP_OFFSET) & MASK_E);
}
static void CFac_CalcFacSignal(FIXP_DBL *pOut, FIXP_DBL *pFac,
const int fac_scale, const int fac_length,
const FIXP_LPC A[M_LP_FILTER_ORDER],
const INT A_exp, const int fAddZir,
const int isFdFac) {
FIXP_LPC wA[M_LP_FILTER_ORDER];
FIXP_DBL tf_gain = (FIXP_DBL)0;
int wlength;
int scale = fac_scale;
/* obtain tranform gain. */
imdct_gain(&tf_gain, &scale, isFdFac ? 0 : fac_length);
/* 4) Compute inverse DCT-IV of FAC data. Output scale of DCT IV is 16 bits.
*/
dct_IV(pFac, fac_length, &scale);
/* dct_IV scale = log2(fac_length). "- 7" is a factor of 2/128 */
if (tf_gain != (FIXP_DBL)0) { /* non-radix 2 transform gain */
int i;
for (i = 0; i < fac_length; i++) {
pFac[i] = fMult(tf_gain, pFac[i]);
}
}
scaleValuesSaturate(pOut, pFac, fac_length,
scale); /* Avoid overflow issues and saturate. */
E_LPC_a_weight(wA, A, M_LP_FILTER_ORDER);
/* We need the output of the IIR filter to be longer than "fac_length".
For this reason we run it with zero input appended to the end of the input
sequence, i.e. we generate its ZIR and extend the output signal.*/
FDKmemclear(pOut + fac_length, fac_length * sizeof(FIXP_DBL));
wlength = 2 * fac_length;
/* 5) Apply weighted synthesis filter to FAC data, including optional Zir (5.
* item 4). */
Syn_filt_zero(wA, A_exp, wlength, pOut);
}
void pvcDecodeTimeSlot(PVC_STATIC_DATA *pPvcStaticData,
PVC_DYNAMIC_DATA *pPvcDynamicData,
FIXP_DBL **qmfSlotReal, FIXP_DBL **qmfSlotImag,
const int qmfExponent, const int pvcBorder0,
const int timeSlotNumber, FIXP_DBL predictedEsgSlot[],
int *predictedEsg_exp) {
int i, band, ksg, ksg_start = 0;
int RATE = pPvcDynamicData->RATE;
int Esg_index = pPvcStaticData->Esg_slot_index;
const SCHAR *sg_borders = pPvcDynamicData->sg_offset_low;
FIXP_DBL *pEsg = pPvcStaticData->Esg[Esg_index];
FIXP_DBL E[PVC_NBLOW] = {0};
/* Subband grouping in QMF subbands below SBR range */
/* Within one timeslot ( i = [0...(RATE-1)] QMF subsamples) calculate energy
E(ib,t) and group them to Esg(ksg,t). Then transfer values to logarithmical
domain and store them for time domain smoothing. (7.5.6.3 Subband grouping
in QMF subbands below SBR range)
*/
for (ksg = 0; sg_borders[ksg] < 0; ksg++) {
pEsg[ksg] = FL2FXCONST_DBL(-10.0 / (1 << PVC_ESG_EXP)); /* 10*log10(0.1) */
ksg_start++;
}
for (i = 0; i < RATE; i++) {
FIXP_DBL *qmfR, *qmfI;
qmfR = qmfSlotReal[i];
qmfI = qmfSlotImag[i];
for (ksg = ksg_start; ksg < PVC_NBLOW; ksg++) {
for (band = sg_borders[ksg]; band < sg_borders[ksg + 1]; band++) {
/* The division by 8 == (RATE*lbw) is required algorithmically */
E[ksg] += (fPow2Div2(qmfR[band]) + fPow2Div2(qmfI[band])) >> 2;
}
}
}
for (ksg = ksg_start; ksg < PVC_NBLOW; ksg++) {
if (E[ksg] > (FIXP_DBL)0) {
/* 10/log2(10) = 0.752574989159953 * 2^2 */
int exp_log;
FIXP_DBL nrg = CalcLog2(E[ksg], 2 * qmfExponent, &exp_log);
nrg = fMult(nrg, FL2FXCONST_SGL(LOG10FAC));
nrg = scaleValue(nrg, exp_log - PVC_ESG_EXP + 2);
pEsg[ksg] = fMax(nrg, FL2FXCONST_DBL(-10.0 / (1 << PVC_ESG_EXP)));
} else {
pEsg[ksg] =
FL2FXCONST_DBL(-10.0 / (1 << PVC_ESG_EXP)); /* 10*log10(0.1) */
}
}
/* Time domain smoothing of subband-grouped energy */
{
int idx = pPvcStaticData->Esg_slot_index;
FIXP_DBL *pEsg_filt;
FIXP_SGL SCcoeff;
E[0] = E[1] = E[2] = (FIXP_DBL)0;
for (i = 0; i < pPvcDynamicData->ns; i++) {
SCcoeff = pPvcDynamicData->pSCcoeffs[i];
pEsg_filt = pPvcStaticData->Esg[idx];
/* Div2 is compensated by scaling of coeff table */
E[0] = fMultAddDiv2(E[0], pEsg_filt[0], SCcoeff);
E[1] = fMultAddDiv2(E[1], pEsg_filt[1], SCcoeff);
E[2] = fMultAddDiv2(E[2], pEsg_filt[2], SCcoeff);
if (i >= pPvcDynamicData->pastEsgSlotsAvail) {
/* if past Esg values are not available use the ones from the last valid
* slot */
continue;
}
if (idx > 0) {
idx--;
} else {
idx += PVC_NS_MAX - 1;
}
}
}
/* SBR envelope scalefactor prediction */
{
int E_high_exp[PVC_NBHIGH_MAX];
int E_high_exp_max = 0;
int pvcTab1ID;
int pvcTab2ID = (int)pPvcDynamicData->pPvcID[timeSlotNumber];
const UCHAR *pTab1, *pTab2;
if (pvcTab2ID < pPvcDynamicData->pPVCTab1_dp[0]) {
pvcTab1ID = 0;
} else if (pvcTab2ID < pPvcDynamicData->pPVCTab1_dp[1]) {
pvcTab1ID = 1;
} else {
pvcTab1ID = 2;
}
pTab1 = &(pPvcDynamicData
->pPVCTab1[pvcTab1ID * PVC_NBLOW * pPvcDynamicData->nbHigh]);
pTab2 = &(pPvcDynamicData->pPVCTab2[pvcTab2ID * pPvcDynamicData->nbHigh]);
for (ksg = 0; ksg < pPvcDynamicData->nbHigh; ksg++) {
FIXP_SGL predCoeff;
FIXP_DBL accu;
int predCoeff_exp, kb;
E_high_exp[ksg] = 0;
/* residual part */
accu = ((LONG)(SCHAR)*pTab2++) << (DFRACT_BITS - 8 - PVC_ESG_EXP +
pPvcDynamicData->pScalingCoef[3]);
/* linear combination of lower grouped energies part */
for (kb = 0; kb < PVC_NBLOW; kb++) {
predCoeff = (FIXP_SGL)(
(SHORT)(SCHAR)pTab1[kb * pPvcDynamicData->nbHigh + ksg] << 8);
predCoeff_exp = pPvcDynamicData->pScalingCoef[kb] +
1; /* +1 to compensate for Div2 */
accu += fMultDiv2(E[kb], predCoeff) << predCoeff_exp;
}
/* convert back to linear domain */
accu = fMult(accu, FL2FXCONST_SGL(LOG10FAC_INV));
accu = f2Pow(
accu, PVC_ESG_EXP - 1,
&predCoeff_exp); /* -1 compensates for exponent of LOG10FAC_INV */
predictedEsgSlot[ksg] = accu;
E_high_exp[ksg] = predCoeff_exp;
if (predCoeff_exp > E_high_exp_max) {
E_high_exp_max = predCoeff_exp;
}
}
/* rescale output vector according to largest exponent */
for (ksg = 0; ksg < pPvcDynamicData->nbHigh; ksg++) {
int scale = E_high_exp[ksg] - E_high_exp_max;
predictedEsgSlot[ksg] = scaleValue(predictedEsgSlot[ksg], scale);
}
*predictedEsg_exp = E_high_exp_max;
}
pPvcStaticData->Esg_slot_index =
(pPvcStaticData->Esg_slot_index + 1) & (PVC_NS_MAX - 1);
pPvcDynamicData->pastEsgSlotsAvail =
fMin(pPvcDynamicData->pastEsgSlotsAvail + 1, PVC_NS_MAX - 1);
return;
}
static INT GetBandwidthEntry(
const INT frameLength,
const INT sampleRate,
const INT chanBitRate,
const INT entryNo)
{
INT bandwidth = -1;
const BANDWIDTH_TAB *pBwTab = NULL;
INT bwTabSize = 0;
switch (frameLength) {
case 960:
case 1024:
pBwTab = bandWidthTable;
bwTabSize = sizeof(bandWidthTable)/sizeof(BANDWIDTH_TAB);
break;
case 480:
case 512:
switch (sampleRate) {
case 8000:
case 11025:
case 12000:
case 16000:
case 22050:
pBwTab = bandWidthTable_LD_22050;
bwTabSize = sizeof(bandWidthTable_LD_22050)/sizeof(BANDWIDTH_TAB);
break;
case 24000:
pBwTab = bandWidthTable_LD_24000;
bwTabSize = sizeof(bandWidthTable_LD_24000)/sizeof(BANDWIDTH_TAB);
break;
case 32000:
pBwTab = bandWidthTable_LD_32000;
bwTabSize = sizeof(bandWidthTable_LD_32000)/sizeof(BANDWIDTH_TAB);
break;
case (44100):
pBwTab = bandWidthTable_LD_44100;
bwTabSize = sizeof(bandWidthTable_LD_44100)/sizeof(BANDWIDTH_TAB);
break;
case 48000:
case 64000:
case 88200:
case 96000:
pBwTab = bandWidthTable_LD_48000;
bwTabSize = sizeof(bandWidthTable_LD_48000)/sizeof(BANDWIDTH_TAB);
break;
}
break;
default:
pBwTab = NULL;
bwTabSize = 0;
}
if (pBwTab!=NULL) {
int i;
for (i=0; i<bwTabSize-1; i++) {
if (chanBitRate >= pBwTab[i].chanBitRate &&
chanBitRate < pBwTab[i+1].chanBitRate)
{
switch (frameLength) {
case 960:
case 1024:
bandwidth = (entryNo==0)
? pBwTab[i].bandWidthMono
: pBwTab[i].bandWidth2AndMoreChan;
break;
case 480:
case 512:
{
INT q_res = 0;
INT startBw = (entryNo==0) ? pBwTab[i ].bandWidthMono : pBwTab[i ].bandWidth2AndMoreChan;
INT endBw = (entryNo==0) ? pBwTab[i+1].bandWidthMono : pBwTab[i+1].bandWidth2AndMoreChan;
INT startBr = pBwTab[i].chanBitRate;
INT endBr = pBwTab[i+1].chanBitRate;
FIXP_DBL bwFac_fix = fDivNorm(chanBitRate-startBr, endBr-startBr, &q_res);
bandwidth = (INT)scaleValue(fMult(bwFac_fix, (FIXP_DBL)(endBw-startBw)),q_res) + startBw;
}
break;
default:
bandwidth = -1;
}
break;
} /* within bitrate range */
}
} /* pBwTab!=NULL */
return bandwidth;
}
static void
calculateDetectorValues(FIXP_DBL **quotaMatrixOrig, /*!< Matrix holding the tonality values of the original. */
SCHAR *indexVector, /*!< Index vector to obtain the patched data. */
FIXP_DBL *nrgVector, /*!< Energy vector. */
DETECTOR_VALUES *detectorValues, /*!< pointer to DETECTOR_VALUES struct. */
INT startChannel, /*!< Start channel. */
INT stopChannel, /*!< Stop channel. */
INT startIndex, /*!< Start index. */
INT stopIndex, /*!< Stop index. */
INT numberOfStrongest /*!< The number of sorted tonal components to be considered. */
)
{
INT i,temp, j;
const FIXP_DBL* filter = *fir_table[INVF_SMOOTHING_LENGTH];
FIXP_DBL origQuotaMeanStrongest, sbrQuotaMeanStrongest;
FIXP_DBL origQuota, sbrQuota;
FIXP_DBL invIndex, invChannel, invTemp;
FIXP_DBL quotaVecOrig[64], quotaVecSbr[64];
FDKmemclear(quotaVecOrig,64*sizeof(FIXP_DBL));
FDKmemclear(quotaVecSbr,64*sizeof(FIXP_DBL));
invIndex = GetInvInt(stopIndex-startIndex);
invChannel = GetInvInt(stopChannel-startChannel);
/*
Calculate the mean value, over the current time segment, for the original, the HFR
and the difference, over all channels in the current frequency range.
NOTE: the averaging is done on the values quota/(1 - quota + RELAXATION).
*/
/* The original, the sbr signal and the total energy */
detectorValues->avgNrg = FL2FXCONST_DBL(0.0f);
for(j=startIndex; j<stopIndex; j++) {
for(i=startChannel; i<stopChannel; i++) {
quotaVecOrig[i] += fMult(quotaMatrixOrig[j][i], invIndex);
if(indexVector[i] != -1)
quotaVecSbr[i] += fMult(quotaMatrixOrig[j][indexVector[i]], invIndex);
}
detectorValues->avgNrg += fMult(nrgVector[j], invIndex);
}
/*
Calculate the mean value, over the current frequency range, for the original, the HFR
and the difference. Also calculate the same mean values for the three vectors, but only
includeing the x strongest copmponents.
*/
origQuota = FL2FXCONST_DBL(0.0f);
sbrQuota = FL2FXCONST_DBL(0.0f);
for(i=startChannel; i<stopChannel; i++) {
origQuota += fMultDiv2(quotaVecOrig[i], invChannel);
sbrQuota += fMultDiv2(quotaVecSbr[i], invChannel);
}
/*
Calculate the mean value for the x strongest components
*/
FDKsbrEnc_Shellsort_fract(quotaVecOrig+startChannel,stopChannel-startChannel);
FDKsbrEnc_Shellsort_fract(quotaVecSbr+startChannel,stopChannel-startChannel);
origQuotaMeanStrongest = FL2FXCONST_DBL(0.0f);
sbrQuotaMeanStrongest = FL2FXCONST_DBL(0.0f);
temp = min(stopChannel - startChannel, numberOfStrongest);
invTemp = GetInvInt(temp);
for(i=0; i<temp; i++) {
origQuotaMeanStrongest += fMultDiv2(quotaVecOrig[i + stopChannel - temp], invTemp);
sbrQuotaMeanStrongest += fMultDiv2(quotaVecSbr[i + stopChannel - temp], invTemp);
}
/*
The value for the strongest component
*/
detectorValues->origQuotaMax = quotaVecOrig[stopChannel - 1];
detectorValues->sbrQuotaMax = quotaVecSbr[stopChannel - 1];
/*
Buffer values
*/
FDKmemmove(detectorValues->origQuotaMean, detectorValues->origQuotaMean + 1, INVF_SMOOTHING_LENGTH*sizeof(FIXP_DBL));
FDKmemmove(detectorValues->sbrQuotaMean, detectorValues->sbrQuotaMean + 1, INVF_SMOOTHING_LENGTH*sizeof(FIXP_DBL));
FDKmemmove(detectorValues->origQuotaMeanStrongest, detectorValues->origQuotaMeanStrongest + 1, INVF_SMOOTHING_LENGTH*sizeof(FIXP_DBL));
FDKmemmove(detectorValues->sbrQuotaMeanStrongest, detectorValues->sbrQuotaMeanStrongest + 1, INVF_SMOOTHING_LENGTH*sizeof(FIXP_DBL));
detectorValues->origQuotaMean[INVF_SMOOTHING_LENGTH] = origQuota<<1;
detectorValues->sbrQuotaMean[INVF_SMOOTHING_LENGTH] = sbrQuota<<1;
detectorValues->origQuotaMeanStrongest[INVF_SMOOTHING_LENGTH] = origQuotaMeanStrongest<<1;
detectorValues->sbrQuotaMeanStrongest[INVF_SMOOTHING_LENGTH] = sbrQuotaMeanStrongest<<1;
/*
Filter values
*/
detectorValues->origQuotaMeanFilt = FL2FXCONST_DBL(0.0f);
detectorValues->sbrQuotaMeanFilt = FL2FXCONST_DBL(0.0f);
detectorValues->origQuotaMeanStrongestFilt = FL2FXCONST_DBL(0.0f);
detectorValues->sbrQuotaMeanStrongestFilt = FL2FXCONST_DBL(0.0f);
for(i=0;i<INVF_SMOOTHING_LENGTH+1;i++) {
detectorValues->origQuotaMeanFilt += fMult(detectorValues->origQuotaMean[i], filter[i]);
detectorValues->sbrQuotaMeanFilt += fMult(detectorValues->sbrQuotaMean[i], filter[i]);
detectorValues->origQuotaMeanStrongestFilt += fMult(detectorValues->origQuotaMeanStrongest[i], filter[i]);
detectorValues->sbrQuotaMeanStrongestFilt += fMult(detectorValues->sbrQuotaMeanStrongest[i], filter[i]);
}
}
static inline INT_PCM AdvanceFilter(LP_FILTER *downFilter, /*!< pointer to iir filter instance */
INT_PCM *pInput, /*!< input of filter */
int downRatio,
int inStride)
{
INT_PCM output;
int i, n;
#ifdef RS_BIQUAD_SCATTERGAIN
#define BIQUAD_SCALE 3
#else
#define BIQUAD_SCALE 12
#endif
FIXP_DBL y = FL2FXCONST_DBL(0.0f);
FIXP_DBL input;
for (n=0; n<downRatio; n++)
{
FIXP_BQS (*states)[2] = downFilter->states;
const FIXP_SGL *coeff = downFilter->coeffa;
int s1,s2;
s1 = downFilter->ptr;
s2 = s1 ^ 1;
#if (SAMPLE_BITS == 16)
input = ((FIXP_DBL)pInput[n*inStride]) << (DFRACT_BITS-SAMPLE_BITS-BIQUAD_SCALE);
#elif (SAMPLE_BITS == 32)
input = pInput[n*inStride] >> BIQUAD_SCALE;
#else
#error NOT IMPLEMENTED
#endif
#ifndef RS_BIQUAD_SCATTERGAIN /* Merged Direct form I */
FIXP_BQS state1, state2, state1b, state2b;
state1 = states[0][s1];
state2 = states[0][s2];
/* Loop over sections */
for (i=0; i<downFilter->noCoeffs; i++)
{
FIXP_DBL state0;
/* Load merged states (from next section) */
state1b = states[i+1][s1];
state2b = states[i+1][s2];
state0 = input + fMult(state1, coeff[B1]) + fMult(state2, coeff[B2]);
y = state0 - fMult(state1b, coeff[A1]) - fMult(state2b, coeff[A2]);
/* Store new feed forward merge state */
states[i+1][s2] = y<<1;
/* Store new feed backward state */
states[i][s2] = input<<1;
/* Feedback output to next section. */
input = y;
/* Transfer merged states */
state1 = state1b;
state2 = state2b;
/* Step to next coef set */
coeff += BIQUAD_COEFSTEP;
}
downFilter->ptr ^= 1;
}
/* Apply global gain */
y = fMult(y, downFilter->gain);
#else /* Direct form II */
/* Loop over sections */
for (i=0; i<downFilter->noCoeffs; i++)
{
FIXP_BQS state1, state2;
FIXP_DBL state0;
/* Load states */
state1 = states[i][s1];
state2 = states[i][s2];
state0 = input - fMult(state1, coeff[A1]) - fMult(state2, coeff[A2]);
y = state0 + fMult(state1, coeff[B1]) + fMult(state2, coeff[B2]);
/* Apply scattered gain */
y = fMult(y, downFilter->gain);
/* Store new state in normalized form */
#ifdef RS_BIQUAD_STATES16
/* Do not saturate any state value ! The result would be unacceptable. Rounding makes SNR around 10dB better. */
states[i][s2] = (FIXP_BQS)(LONG)((state0 + (FIXP_DBL)(1<<(DFRACT_BITS-FRACT_BITS-2))) >> (DFRACT_BITS-FRACT_BITS-1));
#else
states[i][s2] = state0<<1;
#endif
/* Feedback output to next section. */
input=y;
/* Step to next coef set */
coeff += BIQUAD_COEFSTEP;
}
downFilter->ptr ^= 1;
}
INT CLpd_FAC_Acelp2Mdct(H_MDCT hMdct, FIXP_DBL *output, FIXP_DBL *_pSpec,
const SHORT spec_scale[], const int nSpec,
FIXP_DBL *pFac, const int fac_scale,
const INT fac_length, INT noOutSamples, const INT tl,
const FIXP_WTP *wrs, const INT fr, FIXP_LPC A[16],
INT A_exp, CAcelpStaticMem *acelp_mem,
const FIXP_DBL gain, const int last_frame_lost,
const int isFdFac, const UCHAR last_lpd_mode,
const int k, int currAliasingSymmetry) {
FIXP_DBL *pCurr, *pOvl, *pSpec;
const FIXP_WTP *pWindow;
const FIXP_WTB *FacWindowZir_conceal;
UCHAR doFacZirConceal = 0;
int doDeemph = 1;
const FIXP_WTB *FacWindowZir, *FacWindowSynth;
FIXP_DBL *pOut0 = output, *pOut1;
int w, i, fl, nl, nr, f_len, nrSamples = 0, s = 0, scale, total_gain_e;
FIXP_DBL *pF, *pFAC_and_FAC_ZIR = NULL;
FIXP_DBL total_gain = gain;
FDK_ASSERT(fac_length <= 1024 / (4 * 2));
switch (fac_length) {
/* coreCoderFrameLength = 1024 */
case 128:
pWindow = SineWindow256;
FacWindowZir = FacWindowZir128;
FacWindowSynth = FacWindowSynth128;
break;
case 64:
pWindow = SineWindow128;
FacWindowZir = FacWindowZir64;
FacWindowSynth = FacWindowSynth64;
break;
case 32:
pWindow = SineWindow64;
FacWindowZir = FacWindowZir32;
FacWindowSynth = FacWindowSynth32;
break;
/* coreCoderFrameLength = 768 */
case 96:
pWindow = SineWindow192;
FacWindowZir = FacWindowZir96;
FacWindowSynth = FacWindowSynth96;
break;
case 48:
pWindow = SineWindow96;
FacWindowZir = FacWindowZir48;
FacWindowSynth = FacWindowSynth48;
break;
default:
FDK_ASSERT(0);
return 0;
}
FacWindowZir_conceal = FacWindowSynth;
/* Derive NR and NL */
fl = fac_length * 2;
nl = (tl - fl) >> 1;
nr = (tl - fr) >> 1;
if (noOutSamples > nrSamples) {
/* Purge buffered output. */
FDKmemcpy(pOut0, hMdct->overlap.time, hMdct->ov_offset * sizeof(pOut0[0]));
nrSamples = hMdct->ov_offset;
hMdct->ov_offset = 0;
}
if (nrSamples >= noOutSamples) {
pOut1 = hMdct->overlap.time + hMdct->ov_offset;
if (hMdct->ov_offset < fac_length) {
pOut0 = output + nrSamples;
} else {
pOut0 = pOut1;
}
hMdct->ov_offset += fac_length + nl;
} else {
pOut1 = output + nrSamples;
pOut0 = output + nrSamples;
}
{
pFAC_and_FAC_ZIR = CLpd_ACELP_GetFreeExcMem(acelp_mem, 2 * fac_length);
{
const FIXP_DBL *pTmp1, *pTmp2;
doFacZirConceal |= ((last_frame_lost != 0) && (k == 0));
doDeemph &= (last_lpd_mode != 4);
if (doFacZirConceal) {
/* ACELP contribution in concealment case:
Use ZIR with a modified ZIR window to preserve some more energy.
Dont use FAC, which contains wrong information for concealed frame
Dont use last ACELP samples, but double ZIR, instead (afterwards) */
FDKmemclear(pFAC_and_FAC_ZIR, 2 * fac_length * sizeof(FIXP_DBL));
FacWindowSynth = (FIXP_WTB *)pFAC_and_FAC_ZIR;
FacWindowZir = FacWindowZir_conceal;
} else {
CFac_CalcFacSignal(pFAC_and_FAC_ZIR, pFac, fac_scale + s, fac_length, A,
A_exp, 1, isFdFac);
}
/* 6) Get windowed past ACELP samples and ACELP ZIR signal */
/*
* Get ACELP ZIR (pFac[]) and ACELP past samples (pOut0[]) and add them
* to the FAC synth signal contribution on pOut1[].
*/
{
{
CLpd_Acelp_Zir(A, A_exp, acelp_mem, fac_length, pFac, doDeemph);
pTmp1 = pOut0;
pTmp2 = pFac;
}
for (i = 0, w = 0; i < fac_length; i++) {
FIXP_DBL x;
/* Div2 is compensated by table scaling */
x = fMultDiv2(pTmp2[i], FacWindowZir[w]);
x += fMultDiv2(pTmp1[-i - 1], FacWindowSynth[w]);
x += pFAC_and_FAC_ZIR[i];
pOut1[i] = x;
w++;
}
}
if (doFacZirConceal) {
/* ZIR is the only ACELP contribution, so double it */
scaleValues(pOut1, fac_length, 1);
}
}
}
if (nrSamples < noOutSamples) {
nrSamples += fac_length + nl;
}
/* Obtain transform gain */
total_gain = gain;
total_gain_e = 0;
imdct_gain(&total_gain, &total_gain_e, tl);
/* IMDCT overlap add */
scale = total_gain_e;
pSpec = _pSpec;
/* Note:when comming from an LPD frame (TCX/ACELP) the previous alisaing
* symmetry must always be 0 */
if (currAliasingSymmetry == 0) {
dct_IV(pSpec, tl, &scale);
} else {
FIXP_DBL _tmp[1024 + ALIGNMENT_DEFAULT / sizeof(FIXP_DBL)];
FIXP_DBL *tmp = (FIXP_DBL *)ALIGN_PTR(_tmp);
C_ALLOC_ALIGNED_REGISTER(tmp, sizeof(_tmp));
dst_III(pSpec, tmp, tl, &scale);
C_ALLOC_ALIGNED_UNREGISTER(tmp);
}
/* Optional scaling of time domain - no yet windowed - of current spectrum */
if (total_gain != (FIXP_DBL)0) {
for (i = 0; i < tl; i++) {
pSpec[i] = fMult(pSpec[i], total_gain);
}
}
int loc_scale = fixmin_I(spec_scale[0] + scale, (INT)DFRACT_BITS - 1);
scaleValuesSaturate(pSpec, tl, loc_scale);
pOut1 += fl / 2 - 1;
pCurr = pSpec + tl - fl / 2;
for (i = 0; i < fl / 2; i++) {
FIXP_DBL x1;
/* FAC signal is already on pOut1, because of that the += operator. */
x1 = fMult(*pCurr++, pWindow[i].v.re);
FDK_ASSERT((pOut1 >= hMdct->overlap.time &&
pOut1 < hMdct->overlap.time + hMdct->ov_size) ||
(pOut1 >= output && pOut1 < output + 1024));
*pOut1 += IMDCT_SCALE_DBL(-x1);
pOut1--;
}
/* NL output samples TL/2+FL/2..TL. - current[FL/2..0] */
pOut1 += (fl / 2) + 1;
pFAC_and_FAC_ZIR += fac_length; /* set pointer to beginning of FAC ZIR */
if (nl == 0) {
/* save pointer to write FAC ZIR data later */
hMdct->pFacZir = pFAC_and_FAC_ZIR;
} else {
FDK_ASSERT(nl >= fac_length);
/* FAC ZIR will be added now ... */
hMdct->pFacZir = NULL;
}
pF = pFAC_and_FAC_ZIR;
f_len = fac_length;
pCurr = pSpec + tl - fl / 2 - 1;
for (i = 0; i < nl; i++) {
FIXP_DBL x = -(*pCurr--);
/* 5) (item 4) Synthesis filter Zir component, FAC ZIR (another one). */
if (i < f_len) {
x += *pF++;
}
FDK_ASSERT((pOut1 >= hMdct->overlap.time &&
pOut1 < hMdct->overlap.time + hMdct->ov_size) ||
(pOut1 >= output && pOut1 < output + 1024));
*pOut1 = IMDCT_SCALE_DBL(x);
pOut1++;
}
hMdct->prev_nr = nr;
hMdct->prev_fr = fr;
hMdct->prev_wrs = wrs;
hMdct->prev_tl = tl;
hMdct->prevPrevAliasSymmetry = hMdct->prevAliasSymmetry;
hMdct->prevAliasSymmetry = currAliasingSymmetry;
fl = fr;
nl = nr;
pOvl = pSpec + tl / 2 - 1;
pOut0 = pOut1;
for (w = 1; w < nSpec; w++) /* for ACELP -> FD short */
{
const FIXP_WTP *pWindow_prev;
/* Setup window pointers */
pWindow_prev = hMdct->prev_wrs;
/* Current spectrum */
pSpec = _pSpec + w * tl;
scale = total_gain_e;
/* For the second, third, etc. short frames the alisaing symmetry is equal,
* either (0,0) or (1,1) */
if (currAliasingSymmetry == 0) {
/* DCT IV of current spectrum */
dct_IV(pSpec, tl, &scale);
} else {
dst_IV(pSpec, tl, &scale);
}
/* Optional scaling of time domain - no yet windowed - of current spectrum
*/
/* and de-scale current spectrum signal (time domain, no yet windowed) */
if (total_gain != (FIXP_DBL)0) {
for (i = 0; i < tl; i++) {
pSpec[i] = fMult(pSpec[i], total_gain);
}
}
loc_scale = fixmin_I(spec_scale[w] + scale, (INT)DFRACT_BITS - 1);
scaleValuesSaturate(pSpec, tl, loc_scale);
if (noOutSamples <= nrSamples) {
/* Divert output first half to overlap buffer if we already got enough
* output samples. */
pOut0 = hMdct->overlap.time + hMdct->ov_offset;
hMdct->ov_offset += hMdct->prev_nr + fl / 2;
} else {
/* Account output samples */
nrSamples += hMdct->prev_nr + fl / 2;
}
/* NR output samples 0 .. NR. -overlap[TL/2..TL/2-NR] */
for (i = 0; i < hMdct->prev_nr; i++) {
FIXP_DBL x = -(*pOvl--);
*pOut0 = IMDCT_SCALE_DBL(x);
pOut0++;
}
if (noOutSamples <= nrSamples) {
/* Divert output second half to overlap buffer if we already got enough
* output samples. */
pOut1 = hMdct->overlap.time + hMdct->ov_offset + fl / 2 - 1;
hMdct->ov_offset += fl / 2 + nl;
} else {
pOut1 = pOut0 + (fl - 1);
nrSamples += fl / 2 + nl;
}
/* output samples before window crossing point NR .. TL/2.
* -overlap[TL/2-NR..TL/2-NR-FL/2] + current[NR..TL/2] */
/* output samples after window crossing point TL/2 .. TL/2+FL/2.
* -overlap[0..FL/2] - current[TL/2..FL/2] */
pCurr = pSpec + tl - fl / 2;
if (currAliasingSymmetry == 0) {
for (i = 0; i < fl / 2; i++) {
FIXP_DBL x0, x1;
cplxMult(&x1, &x0, *pCurr++, -*pOvl--, pWindow_prev[i]);
*pOut0 = IMDCT_SCALE_DBL(x0);
*pOut1 = IMDCT_SCALE_DBL(-x1);
pOut0++;
pOut1--;
}
} else {
if (hMdct->prevPrevAliasSymmetry == 0) {
/* Jump DST II -> DST IV for the second window */
for (i = 0; i < fl / 2; i++) {
FIXP_DBL x0, x1;
cplxMult(&x1, &x0, *pCurr++, -*pOvl--, pWindow_prev[i]);
*pOut0 = IMDCT_SCALE_DBL(x0);
*pOut1 = IMDCT_SCALE_DBL(x1);
pOut0++;
pOut1--;
}
} else {
/* Jump DST IV -> DST IV from the second window on */
for (i = 0; i < fl / 2; i++) {
FIXP_DBL x0, x1;
cplxMult(&x1, &x0, *pCurr++, *pOvl--, pWindow_prev[i]);
*pOut0 = IMDCT_SCALE_DBL(x0);
*pOut1 = IMDCT_SCALE_DBL(x1);
pOut0++;
pOut1--;
}
}
}
if (hMdct->pFacZir != 0) {
/* add FAC ZIR of previous ACELP -> mdct transition */
FIXP_DBL *pOut = pOut0 - fl / 2;
FDK_ASSERT(fl / 2 <= 128);
for (i = 0; i < fl / 2; i++) {
pOut[i] += IMDCT_SCALE_DBL(hMdct->pFacZir[i]);
}
hMdct->pFacZir = NULL;
}
pOut0 += (fl / 2);
/* NL output samples TL/2+FL/2..TL. - current[FL/2..0] */
pOut1 += (fl / 2) + 1;
pCurr = pSpec + tl - fl / 2 - 1;
for (i = 0; i < nl; i++) {
FIXP_DBL x = -(*pCurr--);
*pOut1 = IMDCT_SCALE_DBL(x);
pOut1++;
}
/* Set overlap source pointer for next window pOvl = pSpec + tl/2 - 1; */
pOvl = pSpec + tl / 2 - 1;
/* Previous window values. */
hMdct->prev_nr = nr;
hMdct->prev_fr = fr;
hMdct->prev_tl = tl;
hMdct->prev_wrs = pWindow_prev;
hMdct->prevPrevAliasSymmetry = hMdct->prevAliasSymmetry;
hMdct->prevAliasSymmetry = currAliasingSymmetry;
}
/* Save overlap */
pOvl = hMdct->overlap.freq + hMdct->ov_size - tl / 2;
FDK_ASSERT(pOvl >= hMdct->overlap.time + hMdct->ov_offset);
FDK_ASSERT(tl / 2 <= hMdct->ov_size);
for (i = 0; i < tl / 2; i++) {
pOvl[i] = _pSpec[i + (w - 1) * tl];
}
return nrSamples;
}
INT CLpd_FAC_Mdct2Acelp(H_MDCT hMdct, FIXP_DBL *output, FIXP_DBL *pFac,
const int fac_scale, FIXP_LPC *A, INT A_exp,
INT nrOutSamples, const INT fac_length,
const INT isFdFac, UCHAR prevWindowShape) {
FIXP_DBL *pOvl;
FIXP_DBL *pOut0;
const FIXP_WTP *pWindow;
int i, fl, nrSamples = 0;
FDK_ASSERT(fac_length <= 1024 / (4 * 2));
fl = fac_length * 2;
pWindow = FDKgetWindowSlope(fl, prevWindowShape);
/* Adapt window slope length in case of frame loss. */
if (hMdct->prev_fr != fl) {
int nl = 0;
imdct_adapt_parameters(hMdct, &fl, &nl, fac_length, pWindow, nrOutSamples);
FDK_ASSERT(nl == 0);
}
if (nrSamples < nrOutSamples) {
pOut0 = output;
nrSamples += hMdct->ov_offset;
/* Purge buffered output. */
FDKmemcpy(pOut0, hMdct->overlap.time, hMdct->ov_offset * sizeof(pOut0[0]));
hMdct->ov_offset = 0;
}
pOvl = hMdct->overlap.freq + hMdct->ov_size - 1;
if (nrSamples >= nrOutSamples) {
pOut0 = hMdct->overlap.time + hMdct->ov_offset;
hMdct->ov_offset += hMdct->prev_nr + fl / 2;
} else {
pOut0 = output + nrSamples;
nrSamples += hMdct->prev_nr + fl / 2;
}
if (hMdct->prevPrevAliasSymmetry == 0) {
for (i = 0; i < hMdct->prev_nr; i++) {
FIXP_DBL x = -(*pOvl--);
*pOut0 = IMDCT_SCALE_DBL(x);
pOut0++;
}
} else {
for (i = 0; i < hMdct->prev_nr; i++) {
FIXP_DBL x = (*pOvl--);
*pOut0 = IMDCT_SCALE_DBL(x);
pOut0++;
}
}
hMdct->prev_nr = 0;
{
if (pFac != NULL) {
/* Note: The FAC gain might have been applied directly after bit stream
* parse in this case. */
CFac_CalcFacSignal(pOut0, pFac, fac_scale, fac_length, A, A_exp, 0,
isFdFac);
} else {
/* Clear buffer because of the overlap and ADD! */
FDKmemclear(pOut0, fac_length * sizeof(FIXP_DBL));
}
}
i = 0;
if (hMdct->prevPrevAliasSymmetry == 0) {
for (; i < fl / 2; i++) {
FIXP_DBL x0;
/* Overlap Add */
x0 = -fMult(*pOvl--, pWindow[i].v.re);
*pOut0 += IMDCT_SCALE_DBL(x0);
pOut0++;
}
} else {
for (; i < fl / 2; i++) {
FIXP_DBL x0;
/* Overlap Add */
x0 = fMult(*pOvl--, pWindow[i].v.re);
*pOut0 += IMDCT_SCALE_DBL(x0);
pOut0++;
}
}
if (hMdct->pFacZir !=
0) { /* this should only happen for ACELP -> TCX20 -> ACELP transition */
FIXP_DBL *pOut = pOut0 - fl / 2; /* fl/2 == fac_length */
for (i = 0; i < fl / 2; i++) {
pOut[i] += IMDCT_SCALE_DBL(hMdct->pFacZir[i]);
}
hMdct->pFacZir = NULL;
}
hMdct->prev_fr = 0;
hMdct->prev_nr = 0;
hMdct->prev_tl = 0;
hMdct->prevPrevAliasSymmetry = hMdct->prevAliasSymmetry;
return nrSamples;
}
/*******************************************************************************
Functionname: subbandTPApply
******************************************************************************/
SACDEC_ERROR subbandTPApply(spatialDec *self, const SPATIAL_BS_FRAME *frame) {
FIXP_DBL *qmfOutputRealDry[MAX_OUTPUT_CHANNELS];
FIXP_DBL *qmfOutputImagDry[MAX_OUTPUT_CHANNELS];
FIXP_DBL *qmfOutputRealWet[MAX_OUTPUT_CHANNELS];
FIXP_DBL *qmfOutputImagWet[MAX_OUTPUT_CHANNELS];
FIXP_DBL DryEner[MAX_INPUT_CHANNELS];
FIXP_DBL scale[MAX_OUTPUT_CHANNELS];
FIXP_DBL DryEnerLD64[MAX_INPUT_CHANNELS];
FIXP_DBL WetEnerLD64[MAX_OUTPUT_CHANNELS];
FIXP_DBL DryEner0 = FL2FXCONST_DBL(0.0f);
FIXP_DBL WetEnerX, damp, tmp;
FIXP_DBL dmxReal0, dmxImag0;
int skipChannels[MAX_OUTPUT_CHANNELS];
int n, ch, cplxBands, cplxHybBands;
int dry_scale_dmx, wet_scale_dmx;
int i_LF, i_RF;
HANDLE_STP_DEC hStpDec;
const FIXP_CFG *pBP;
int nrgScale = (2 * self->clipProtectGainSF__FDK);
hStpDec = self->hStpDec;
/* set scalefactor and loop counter */
FDK_ASSERT(SF_DRY >= 1);
{
cplxBands = BP_GF_SIZE;
cplxHybBands = self->hybridBands;
dry_scale_dmx = (2 * SF_DRY) - 2;
wet_scale_dmx = 2;
}
/* setup pointer for forming the direct downmix signal */
for (ch = 0; ch < self->numOutputChannels; ch++) {
qmfOutputRealDry[ch] = &self->hybOutputRealDry__FDK[ch][7];
qmfOutputRealWet[ch] = &self->hybOutputRealWet__FDK[ch][7];
qmfOutputImagDry[ch] = &self->hybOutputImagDry__FDK[ch][7];
qmfOutputImagWet[ch] = &self->hybOutputImagWet__FDK[ch][7];
}
/* clear skipping flag for all output channels */
FDKmemset(skipChannels, 0, self->numOutputChannels * sizeof(int));
/* set scale values to zero */
FDKmemset(scale, 0, self->numOutputChannels * sizeof(FIXP_DBL));
/* update normalisation energy with latest smoothed energy */
if (hStpDec->update_old_ener == STP_UPDATE_ENERGY_RATE) {
hStpDec->update_old_ener = 1;
for (ch = 0; ch < self->numInputChannels; ch++) {
hStpDec->oldDryEnerLD64[ch] =
CalcLdData(hStpDec->runDryEner[ch] + ABS_THR__FDK);
}
for (ch = 0; ch < self->numOutputChannels; ch++) {
hStpDec->oldWetEnerLD64[ch] =
CalcLdData(hStpDec->runWetEner[ch] + ABS_THR2__FDK);
}
} else {
hStpDec->update_old_ener++;
}
/* get channel configuration */
switch (self->treeConfig) {
case TREE_212:
i_LF = 0;
i_RF = 1;
break;
default:
return MPS_WRONG_TREECONFIG;
}
/* form the 'direct' downmix signal */
pBP = hStpDec->BP_GF - BP_GF_START;
switch (self->treeConfig) {
case TREE_212:
for (n = BP_GF_START; n < cplxBands; n++) {
dmxReal0 = qmfOutputRealDry[i_LF][n] + qmfOutputRealDry[i_RF][n];
dmxImag0 = qmfOutputImagDry[i_LF][n] + qmfOutputImagDry[i_RF][n];
DRY_ENER_SUM_CPLX(DryEner0, dmxReal0, dmxImag0, n);
}
DRY_ENER_WEIGHT(DryEner0);
break;
default:;
}
DryEner[0] = DryEner0;
/* normalise the 'direct' signals */
for (ch = 0; ch < self->numInputChannels; ch++) {
DryEner[ch] = DryEner[ch] << (nrgScale);
hStpDec->runDryEner[ch] =
fMult(STP_LPF_COEFF1__FDK, hStpDec->runDryEner[ch]) +
fMult(ONE_MINUS_STP_LPF_COEFF1__FDK, DryEner[ch]);
if (DryEner[ch] != FL2FXCONST_DBL(0.0f)) {
DryEnerLD64[ch] =
fixMax((CalcLdData(DryEner[ch]) - hStpDec->oldDryEnerLD64[ch]),
FL2FXCONST_DBL(-0.484375f));
} else {
DryEnerLD64[ch] = FL2FXCONST_DBL(-0.484375f);
}
}
if (self->treeConfig == TREE_212) {
for (; ch < MAX_INPUT_CHANNELS; ch++) {
DryEnerLD64[ch] = FL2FXCONST_DBL(-0.484375f);
}
}
/* normalise the 'diffuse' signals */
pBP = hStpDec->BP_GF - BP_GF_START;
for (ch = 0; ch < self->numOutputChannels; ch++) {
if (skipChannels[ch]) {
continue;
}
WetEnerX = FL2FXCONST_DBL(0.0f);
for (n = BP_GF_START; n < cplxBands; n++) {
tmp = fPow2Div2(qmfOutputRealWet[ch][n] << SF_WET);
tmp += fPow2Div2(qmfOutputImagWet[ch][n] << SF_WET);
WetEnerX += fMultDiv2(tmp, pBP[n]);
}
WET_ENER_WEIGHT(WetEnerX);
WetEnerX = WetEnerX << (nrgScale);
hStpDec->runWetEner[ch] =
fMult(STP_LPF_COEFF1__FDK, hStpDec->runWetEner[ch]) +
fMult(ONE_MINUS_STP_LPF_COEFF1__FDK, WetEnerX);
if (WetEnerX == FL2FXCONST_DBL(0.0f)) {
WetEnerLD64[ch] = FL2FXCONST_DBL(-0.484375f);
} else {
WetEnerLD64[ch] =
fixMax((CalcLdData(WetEnerX) - hStpDec->oldWetEnerLD64[ch]),
FL2FXCONST_DBL(-0.484375f));
}
}
/* compute scale factor for the 'diffuse' signals */
switch (self->treeConfig) {
case TREE_212:
if (DryEner[0] != FL2FXCONST_DBL(0.0f)) {
CALC_WET_SCALE(0, i_LF);
CALC_WET_SCALE(0, i_RF);
}
break;
default:;
}
damp = FL2FXCONST_DBL(0.1f / (1 << SF_SCALE));
for (ch = 0; ch < self->numOutputChannels; ch++) {
/* damp the scaling factor */
scale[ch] = damp + fMult(FL2FXCONST_DBL(0.9f), scale[ch]);
/* limiting the scale factor */
if (scale[ch] > STP_SCALE_LIMIT__FDK) {
scale[ch] = STP_SCALE_LIMIT__FDK;
}
if (scale[ch] < ONE_DIV_STP_SCALE_LIMIT__FDK) {
scale[ch] = ONE_DIV_STP_SCALE_LIMIT__FDK;
}
/* low pass filter the scaling factor */
scale[ch] =
fMult(STP_LPF_COEFF2__FDK, scale[ch]) +
fMult(ONE_MINUS_STP_LPF_COEFF2__FDK, hStpDec->prev_tp_scale[ch]);
hStpDec->prev_tp_scale[ch] = scale[ch];
}
/* combine 'direct' and scaled 'diffuse' signal */
FDK_ASSERT((HP_SIZE - 3 + 10 - 1) == PC_NUM_HYB_BANDS);
const SCHAR *channlIndex = row2channelSTP[self->treeConfig];
for (ch = 0; ch < self->numOutputChannels; ch++) {
int no_scaling;
no_scaling = !frame->tempShapeEnableChannelSTP[channlIndex[ch]];
if (no_scaling) {
combineSignalCplx(
&self->hybOutputRealDry__FDK[ch][self->tp_hybBandBorder],
&self->hybOutputImagDry__FDK[ch][self->tp_hybBandBorder],
&self->hybOutputRealWet__FDK[ch][self->tp_hybBandBorder],
&self->hybOutputImagWet__FDK[ch][self->tp_hybBandBorder],
cplxHybBands - self->tp_hybBandBorder);
} else {
FIXP_DBL scaleX;
scaleX = scale[ch];
pBP = hStpDec->BP - self->tp_hybBandBorder;
/* Band[HP_SIZE-3+10-1] needs not to be processed in
combineSignalCplxScale1(), because pB[HP_SIZE-3+10-1] would be 1.0 */
combineSignalCplxScale1(
&self->hybOutputRealDry__FDK[ch][self->tp_hybBandBorder],
&self->hybOutputImagDry__FDK[ch][self->tp_hybBandBorder],
&self->hybOutputRealWet__FDK[ch][self->tp_hybBandBorder],
&self->hybOutputImagWet__FDK[ch][self->tp_hybBandBorder],
&pBP[self->tp_hybBandBorder], scaleX,
(HP_SIZE - 3 + 10 - 1) - self->tp_hybBandBorder);
{
combineSignalCplxScale2(
&self->hybOutputRealDry__FDK[ch][HP_SIZE - 3 + 10 - 1],
&self->hybOutputImagDry__FDK[ch][HP_SIZE - 3 + 10 - 1],
&self->hybOutputRealWet__FDK[ch][HP_SIZE - 3 + 10 - 1],
&self->hybOutputImagWet__FDK[ch][HP_SIZE - 3 + 10 - 1], scaleX,
cplxHybBands - (HP_SIZE - 3 + 10 - 1));
}
}
}
return (SACDEC_ERROR)MPS_OK;
;
}
