Google Git
Sign in
fuchsia / third_party / android / platform / frameworks / av / 09e9c89978d636d48dee8bdad9c1444f035ebb4d / . / media / libstagefright / codecs / aacdec / synthesis_sub_band.cpp
blob: c1418e3b4ac3e222cf1b47cb88cce5125c1cb8b3 [file] [log] [blame]
/* ------------------------------------------------------------------
* Copyright (C) 1998-2009 PacketVideo
*
* 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.
* -------------------------------------------------------------------
*/
/*
Filename: synthesis_sub_band.c
------------------------------------------------------------------------------
REVISION HISTORY
Who: Date: MM/DD/YYYY
Description:
------------------------------------------------------------------------------
INPUT AND OUTPUT DEFINITIONS
Int32 vec[], Input vector, 32-bit
const Int32 *cosTerms, Cosine Terms
Int32 *scratch_mem Scratch memory
------------------------------------------------------------------------------
FUNCTION DESCRIPTION
Implement root squared of a number
------------------------------------------------------------------------------
REQUIREMENTS
------------------------------------------------------------------------------
REFERENCES
------------------------------------------------------------------------------
PSEUDO-CODE
------------------------------------------------------------------------------
*/
/*----------------------------------------------------------------------------
; INCLUDES
----------------------------------------------------------------------------*/
#ifdef AAC_PLUS
#include "pv_audio_type_defs.h"
#include "fxp_mul32.h"
#include "dct64.h"
#include "synthesis_sub_band.h"
#include "mdst.h"
#include "dct16.h"
/*----------------------------------------------------------------------------
; MACROS
; Define module specific macros here
----------------------------------------------------------------------------*/
/*----------------------------------------------------------------------------
; DEFINES
; Include all pre-processor statements here. Include conditional
; compile variables also.
----------------------------------------------------------------------------*/
#define Qfmt_30(x) (Int32)(x*((Int32)(1<<30)) + (x>=0?0.5F:-0.5F))
#define Qfmt_25(x) (Int32)(x*((Int32)(1<<25))*(1.5625F) + (x>=0?0.5F:-0.5F))
#define SCALE_DOWN_LP Qfmt_30(0.075000F) /* 3/40 */
#define SCALE_DOWN_HQ Qfmt_30(0.009375F*0.64F) /* 3/40 * 1/8 */
/*----------------------------------------------------------------------------
; LOCAL FUNCTION DEFINITIONS
; Function Prototype declaration
----------------------------------------------------------------------------*/
/*----------------------------------------------------------------------------
; LOCAL STORE/BUFFER/POINTER DEFINITIONS
; Variable declaration - defined here and used outside this module
----------------------------------------------------------------------------*/
const Int32 CosTable_64[64] =
{
Qfmt_25(0.50003765191555F), Qfmt_25(40.74468810335183F), Qfmt_25(0.50033903744282F), Qfmt_25(13.58429025728446F),
Qfmt_25(0.50094271763809F), Qfmt_25(8.15384860246681F), Qfmt_25(0.50185051748424F), Qfmt_25(5.82768837784465F),
Qfmt_25(0.50306519130137F), Qfmt_25(4.53629093696936F), Qfmt_25(0.50459044322165F), Qfmt_25(3.71524273832697F),
Qfmt_25(0.50643095492855F), Qfmt_25(3.14746219178191F), Qfmt_25(0.50859242104981F), Qfmt_25(2.73164502877394F),
Qfmt_25(0.51108159270668F), Qfmt_25(2.41416000025008F), Qfmt_25(0.51390632984754F), Qfmt_25(2.16395781875198F),
Qfmt_25(0.51707566313349F), Qfmt_25(1.96181784857117F), Qfmt_25(0.52059986630189F), Qfmt_25(1.79520521907789F),
Qfmt_25(0.52449054011472F), Qfmt_25(1.65559652426412F), Qfmt_25(0.52876070920749F), Qfmt_25(1.53699410085250F),
Qfmt_25(0.53342493339713F), Qfmt_25(1.43505508844143F), Qfmt_25(0.53849943529198F), Qfmt_25(1.34655762820629F),
Qfmt_25(0.54400224638178F), Qfmt_25(1.26906117169912F), Qfmt_25(0.54995337418324F), Qfmt_25(1.20068325572942F),
Qfmt_25(0.55637499348989F), Qfmt_25(1.13994867510150F), Qfmt_25(0.56329166534170F), Qfmt_25(1.08568506425801F),
Qfmt_25(0.57073058801215F), Qfmt_25(1.03694904091039F), Qfmt_25(0.57872188513482F), Qfmt_25(0.99297296126755F),
Qfmt_25(0.58729893709379F), Qfmt_25(0.95312587439212F), Qfmt_25(0.59649876302446F), Qfmt_25(0.91688444618465F),
Qfmt_25(0.60636246227215F), Qfmt_25(0.88381100455962F), Qfmt_25(0.61693572600507F), Qfmt_25(0.85353675100661F),
Qfmt_25(0.62826943197077F), Qfmt_25(0.82574877386279F), Qfmt_25(0.64042033824166F), Qfmt_25(0.80017989562169F),
Qfmt_25(0.65345189537513F), Qfmt_25(0.77660065823396F), Qfmt_25(0.66743520092634F), Qfmt_25(0.75481293911653F),
Qfmt_25(0.68245012597642F), Qfmt_25(0.73464482364786F), Qfmt_25(0.69858665064723F), Qfmt_25(0.71594645497057F),
};
/*----------------------------------------------------------------------------
; EXTERNAL FUNCTION REFERENCES
; Declare functions defined elsewhere and referenced in this module
----------------------------------------------------------------------------*/
/*----------------------------------------------------------------------------
; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES
; Declare variables used in this module but defined elsewhere
----------------------------------------------------------------------------*/
/*----------------------------------------------------------------------------
; FUNCTION CODE
----------------------------------------------------------------------------*/
void synthesis_sub_band_LC(Int32 Sr[], Int16 data[])
{
Int32 *temp_o1 = (Int32 *) & data[0];
Int i;
Int32 *pt_temp_e;
Int32 *pt_temp_o = temp_o1;
Int32 *pt_temp_x = &Sr[63];
Int32 temp1;
Int32 temp2;
Int32 temp3;
Int32 temp11;
Int16 *pt_data_1;
Int16 *pt_data_2;
Int32 *pt_Sr_1 = Sr;
Int16 tmp1;
Int16 tmp2;
Int16 tmp11;
Int16 tmp22;
const Int32 *pt_cosTerms = CosTable_48;
temp2 = *(pt_temp_x--);
for (i = 20; i != 0; i--)
{
temp1 = *(pt_Sr_1);
temp3 = *(pt_cosTerms++);
*(pt_Sr_1++) = temp1 + temp2;
*(pt_temp_o++) = fxp_mul32_Q31((temp1 - temp2), temp3) << 1;
temp2 = *(pt_temp_x--);
}
for (i = 12; i != 0; i--)
{
temp1 = *(pt_Sr_1);
temp3 = *(pt_cosTerms++);
*(pt_Sr_1++) = temp1 + temp2;
*(pt_temp_o++) = fxp_mul32_Q26((temp1 - temp2), temp3);
temp2 = *(pt_temp_x--);
}
pv_split_LC(temp_o1, &Sr[32]);
dct_16(temp_o1, 1); // Even terms
dct_16(&Sr[32], 1); // Odd terms
/* merge */
pt_Sr_1 = &temp_o1[31];
pt_temp_e = &temp_o1[15];
pt_temp_o = &Sr[47];
temp1 = *(pt_temp_o--);
*(pt_Sr_1--) = temp1;
for (i = 5; i != 0; i--)
{
temp2 = *(pt_temp_o--);
*(pt_Sr_1--) = *(pt_temp_e--);
*(pt_Sr_1--) = temp1 + temp2;
temp3 = *(pt_temp_o--);
*(pt_Sr_1--) = *(pt_temp_e--);
*(pt_Sr_1--) = temp2 + temp3;
temp1 = *(pt_temp_o--);
*(pt_Sr_1--) = *(pt_temp_e--);
*(pt_Sr_1--) = temp1 + temp3;
}
pv_split_LC(Sr, &Sr[32]);
dct_16(Sr, 1); // Even terms
dct_16(&Sr[32], 1); // Odd terms
pt_temp_x = &temp_o1[31];
pt_temp_e = &Sr[15];
pt_temp_o = &Sr[47];
pt_data_1 = &data[95];
temp2 = *(pt_temp_x--);
temp11 = *(pt_temp_x--);
temp1 = *(pt_temp_o--);
*(pt_data_1--) = (Int16) fxp_mul32_Q31(temp2, SCALE_DOWN_LP);
*(pt_data_1--) = (Int16) fxp_mul32_Q31(temp1, SCALE_DOWN_LP);
for (i = 5; i != 0; i--)
{
*(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp2), SCALE_DOWN_LP);
temp3 = *(pt_temp_x--);
*(pt_data_1--) = (Int16) fxp_mul32_Q31(*(pt_temp_e--), SCALE_DOWN_LP);
temp2 = *(pt_temp_o--);
*(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp3), SCALE_DOWN_LP);
temp11 = *(pt_temp_x--);
*(pt_data_1--) = (Int16) fxp_mul32_Q31((temp1 + temp2), SCALE_DOWN_LP);
*(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp3), SCALE_DOWN_LP);
temp1 = *(pt_temp_x--);
*(pt_data_1--) = (Int16) fxp_mul32_Q31(*(pt_temp_e--), SCALE_DOWN_LP);
temp3 = *(pt_temp_o--);
*(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp1), SCALE_DOWN_LP);
temp11 = *(pt_temp_x--);
*(pt_data_1--) = (Int16) fxp_mul32_Q31((temp2 + temp3), SCALE_DOWN_LP);
*(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp1), SCALE_DOWN_LP);
temp2 = *(pt_temp_x--);
*(pt_data_1--) = (Int16) fxp_mul32_Q31(*(pt_temp_e--), SCALE_DOWN_LP);
temp1 = *(pt_temp_o--);
*(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp2), SCALE_DOWN_LP);
temp11 = *(pt_temp_x--);
*(pt_data_1--) = (Int16) fxp_mul32_Q31((temp1 + temp3), SCALE_DOWN_LP);
}
*(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp2), SCALE_DOWN_LP);
*(pt_data_1--) = (Int16) fxp_mul32_Q31(*(pt_temp_e), SCALE_DOWN_LP);
/* ---- merge ends---- */
pt_data_1 = &data[95];
pt_data_2 = &data[96];
*(pt_data_2++) = 0;
tmp1 = *(pt_data_1--);
tmp2 = *(pt_data_1--);
tmp11 = *(pt_data_1--);
tmp22 = *(pt_data_1--);
for (i = 7; i != 0; i--)
{
*(pt_data_2++) = (-tmp1);
*(pt_data_2++) = (-tmp2);
*(pt_data_2++) = (-tmp11);
*(pt_data_2++) = (-tmp22);
tmp1 = *(pt_data_1--);
tmp2 = *(pt_data_1--);
tmp11 = *(pt_data_1--);
tmp22 = *(pt_data_1--);
}
*(pt_data_2++) = (-tmp1);
*(pt_data_2++) = (-tmp2);
*(pt_data_2++) = (-tmp11);
pt_data_2 = &data[0];
*(pt_data_2++) = tmp22;
tmp1 = *(pt_data_1--);
tmp2 = *(pt_data_1--);
tmp11 = *(pt_data_1--);
tmp22 = *(pt_data_1--);
for (i = 7; i != 0; i--)
{
*(pt_data_2++) = tmp1;
*(pt_data_2++) = tmp2;
*(pt_data_2++) = tmp11;
*(pt_data_2++) = tmp22;
tmp1 = *(pt_data_1--);
tmp2 = *(pt_data_1--);
tmp11 = *(pt_data_1--);
tmp22 = *(pt_data_1--);
}
*(pt_data_2++) = tmp1;
*(pt_data_2++) = tmp2;
*(pt_data_2++) = tmp11;
*(pt_data_2) = tmp22;
}
void synthesis_sub_band_LC_down_sampled(Int32 Sr[], Int16 data[])
{
Int i ;
Int16 *pt_data_1;
pt_data_1 = &data[0];
dct_32(Sr);
for (i = 0; i < 16; i++)
{
pt_data_1[ i] = (Int16)(Sr[16-i] >> 5);
pt_data_1[16+i] = (Int16)(Sr[i] >> 5);
pt_data_1[32+i] = (Int16)(Sr[16+i] >> 5);
}
for (i = 0; i < 15; i++)
{
pt_data_1[49+i] = (Int16)(-Sr[31-i] >> 5);
}
pt_data_1[48] = 0;
}
#ifdef HQ_SBR
void synthesis_sub_band(Int32 Sr[], Int32 Si[], Int16 data[])
{
Int32 i ;
Int16 *pt_data_1;
Int16 *pt_data_2;
Int32 *pt_Sr_1;
Int32 *pt_Sr_2;
Int32 *pt_Si_1;
Int32 *pt_Si_2;
Int32 tmp1;
Int32 tmp2;
Int32 tmp3;
Int32 tmp4;
Int32 cosx;
const Int32 *pt_CosTable = CosTable_64;
pt_Sr_1 = &Sr[0];
pt_Sr_2 = &Sr[63];
pt_Si_1 = &Si[0];
pt_Si_2 = &Si[63];
tmp3 = *pt_Sr_1;
for (i = 32; i != 0; i--)
{
tmp4 = *pt_Si_2;
cosx = *(pt_CosTable++);
*(pt_Sr_1++) = fxp_mul32_Q31(tmp3, cosx);
tmp3 = *pt_Si_1;
*(pt_Si_1++) = fxp_mul32_Q31(tmp4, cosx);
tmp4 = *pt_Sr_2;
cosx = *(pt_CosTable++);
*(pt_Si_2--) = fxp_mul32_Q31(tmp3, cosx);
*(pt_Sr_2--) = fxp_mul32_Q31(tmp4, cosx);
tmp3 = *pt_Sr_1;
}
dct_64(Sr, (Int32 *)data);
dct_64(Si, (Int32 *)data);
pt_data_1 = &data[0];
pt_data_2 = &data[127];
pt_Sr_1 = &Sr[0];
pt_Si_1 = &Si[0];
tmp1 = *(pt_Sr_1++);
tmp3 = *(pt_Sr_1++);
tmp2 = *(pt_Si_1++);
tmp4 = *(pt_Si_1++);
for (i = 32; i != 0; i--)
{
*(pt_data_1++) = (Int16) fxp_mul32_Q31((tmp2 - tmp1), SCALE_DOWN_HQ);
*(pt_data_1++) = (Int16) fxp_mul32_Q31(-(tmp3 + tmp4), SCALE_DOWN_HQ);
*(pt_data_2--) = (Int16) fxp_mul32_Q31((tmp1 + tmp2), SCALE_DOWN_HQ);
*(pt_data_2--) = (Int16) fxp_mul32_Q31((tmp3 - tmp4), SCALE_DOWN_HQ);
tmp1 = *(pt_Sr_1++);
tmp3 = *(pt_Sr_1++);
tmp2 = *(pt_Si_1++);
tmp4 = *(pt_Si_1++);
}
}
const Int32 exp_m0_25_phi[32] =
{
0x7FFEFE6E, 0x7FEAFB4A, 0x7FC2F827, 0x7F87F505,
0x7F38F1E4, 0x7ED6EEC6, 0x7E60EBAB, 0x7DD6E892,
0x7D3AE57D, 0x7C89E26D, 0x7BC6DF61, 0x7AEFDC59,
0x7A06D958, 0x790AD65C, 0x77FBD367, 0x76D9D079,
0x75A6CD92, 0x7460CAB2, 0x7308C7DB, 0x719EC50D,
0x7023C248, 0x6E97BF8C, 0x6CF9BCDA, 0x6B4BBA33,
0x698CB796, 0x67BDB505, 0x65DEB27F, 0x63EFB005,
0x61F1AD97, 0x5FE4AB36, 0x5DC8A8E2, 0x5B9DA69C
};
void synthesis_sub_band_down_sampled(Int32 Sr[], Int32 Si[], Int16 data[])
{
Int16 k;
Int16 *pt_data_1;
Int32 exp_m0_25;
const Int32 *pt_exp = exp_m0_25_phi;
Int32 *XX = Sr;
Int32 *YY = (Int32 *)data;
Int32 tmp1;
Int32 tmp2;
for (k = 0; k < 32; k++)
{
exp_m0_25 = *(pt_exp++);
tmp1 = Sr[k];
tmp2 = Si[k];
XX[k] = cmplx_mul32_by_16(-tmp1, tmp2, exp_m0_25);
YY[31-k] = cmplx_mul32_by_16(tmp2, tmp1, exp_m0_25);
}
mdct_32(XX);
mdct_32(YY);
for (k = 0; k < 32; k++)
{
Si[k] = YY[k];
}
pt_data_1 = data;
for (k = 0; k < 16; k++)
{
*(pt_data_1++) = (Int16)((XX[2*k ] + Si[2*k ]) >> 14);
*(pt_data_1++) = (Int16)((XX[2*k+1] - Si[2*k+1]) >> 14);
}
for (k = 15; k > -1; k--)
{
*(pt_data_1++) = (Int16)(-(XX[2*k+1] + Si[2*k+1]) >> 14);
*(pt_data_1++) = (Int16)(-(XX[2*k ] - Si[2*k ]) >> 14);
}
}
#endif /* HQ_SBR */
#endif /* AAC_PLUS */