/* ------------------------------------------------------------------ * 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: ps_init_stereo_mixing.c ------------------------------------------------------------------------------ REVISION HISTORY Who: Date: MM/DD/YYYY Description: ------------------------------------------------------------------------------ INPUT AND OUTPUT DEFINITIONS ------------------------------------------------------------------------------ FUNCTION DESCRIPTION initialize mixing procedure type Ra, type Rb is not supported ------------------------------------------------------------------------------ REQUIREMENTS ------------------------------------------------------------------------------ REFERENCES SC 29 Software Copyright Licencing Disclaimer: This software module was originally developed by Coding Technologies and edited by - in the course of development of the ISO/IEC 13818-7 and ISO/IEC 14496-3 standards for reference purposes and its performance may not have been optimized. This software module is an implementation of one or more tools as specified by the ISO/IEC 13818-7 and ISO/IEC 14496-3 standards. ISO/IEC gives users free license to this software module or modifications thereof for use in products claiming conformance to audiovisual and image-coding related ITU Recommendations and/or ISO/IEC International Standards. ISO/IEC gives users the same free license to this software module or modifications thereof for research purposes and further ISO/IEC standardisation. Those intending to use this software module in products are advised that its use may infringe existing patents. ISO/IEC have no liability for use of this software module or modifications thereof. Copyright is not released for products that do not conform to audiovisual and image-coding related ITU Recommendations and/or ISO/IEC International Standards. The original developer retains full right to modify and use the code for its own purpose, assign or donate the code to a third party and to inhibit third parties from using the code for products that do not conform to audiovisual and image-coding related ITU Recommendations and/or ISO/IEC International Standards. This copyright notice must be included in all copies or derivative works. Copyright (c) ISO/IEC 2003. ------------------------------------------------------------------------------ PSEUDO-CODE ------------------------------------------------------------------------------ */ /*---------------------------------------------------------------------------- ; INCLUDES ----------------------------------------------------------------------------*/ #ifdef AAC_PLUS #ifdef PARAMETRICSTEREO #include "pv_audio_type_defs.h" #include "fxp_mul32.h" #include "aac_mem_funcs.h" #include "pv_sine.h" #include "s_ps_dec.h" #include "ps_all_pass_filter_coeff.h" #include "ps_init_stereo_mixing.h" /*---------------------------------------------------------------------------- ; MACROS ; Define module specific macros here ----------------------------------------------------------------------------*/ /*---------------------------------------------------------------------------- ; DEFINES ; Include all pre-processor statements here. Include conditional ; compile variables also. ----------------------------------------------------------------------------*/ /*---------------------------------------------------------------------------- ; LOCAL FUNCTION DEFINITIONS ; Function Prototype declaration ----------------------------------------------------------------------------*/ /*---------------------------------------------------------------------------- ; LOCAL STORE/BUFFER/POINTER DEFINITIONS ; Variable declaration - defined here and used outside this module ----------------------------------------------------------------------------*/ /* ; ; c(b) = 10^(iid(b)/20) ; ; Intensity differences ; ; sqrt(2) ; c_1(b) = ---------------- ; sqrt( 1 + c^2(b)) ; ; sqrt(2)*c(b) ; c_2(b) = ---------------- ; sqrt( 1 + c^2(b)) ; */ #define R_SHIFT 30 #define Q30_fmt(x) (Int32)(x*((Int32)1<=0?0.5F:-0.5F)) const Int32 scaleFactors[NO_IID_LEVELS] = { Q30_fmt(1.411983f), Q30_fmt(1.403138f), Q30_fmt(1.386877f), Q30_fmt(1.348400f), Q30_fmt(1.291249f), Q30_fmt(1.196037f), Q30_fmt(1.107372f), Q30_fmt(1.000000f), Q30_fmt(0.879617f), Q30_fmt(0.754649f), Q30_fmt(0.576780f), Q30_fmt(0.426401f), Q30_fmt(0.276718f), Q30_fmt(0.176645f), Q30_fmt(0.079402f) }; const Int32 scaleFactorsFine[NO_IID_LEVELS_FINE] = { Q30_fmt(1.414207f), Q30_fmt(1.414191f), Q30_fmt(1.414143f), Q30_fmt(1.413990f), Q30_fmt(1.413507f), Q30_fmt(1.411983f), Q30_fmt(1.409773f), Q30_fmt(1.405395f), Q30_fmt(1.396780f), Q30_fmt(1.380053f), Q30_fmt(1.348400f), Q30_fmt(1.313920f), Q30_fmt(1.264310f), Q30_fmt(1.196037f), Q30_fmt(1.107372f), Q30_fmt(1.000000f), Q30_fmt(0.879617f), Q30_fmt(0.754649f), Q30_fmt(0.633656f), Q30_fmt(0.523081f), Q30_fmt(0.426401f), Q30_fmt(0.308955f), Q30_fmt(0.221375f), Q30_fmt(0.157688f), Q30_fmt(0.111982f), Q30_fmt(0.079402f), Q30_fmt(0.044699f), Q30_fmt(0.025145f), Q30_fmt(0.014141f), Q30_fmt(0.007953f), Q30_fmt(0.004472f) }; /* * alphas ranged between 0 and pi/2 * alpha(b) = (1/2)*arccos( gamma(b)) * * b 0 1 2 3 4 5 6 7 * gamma 1 0.937 0.84118 0.60092 0.36764 0 -0.589 -1 * */ const Int32 scaled_alphas[NO_ICC_LEVELS] = { Q30_fmt(0.00000000000000f), Q30_fmt(0.12616764875355f), Q30_fmt(0.20199707286122f), Q30_fmt(0.32744135137762f), Q30_fmt(0.42225800677370f), Q30_fmt(0.55536025173035f), Q30_fmt(0.77803595530059f), Q30_fmt(1.11072050346071f) }; const Int32 cos_alphas[NO_ICC_LEVELS] = { Q30_fmt(1.00000000000000f), Q30_fmt(0.98412391153249f), Q30_fmt(0.95947390717984f), Q30_fmt(0.89468446298319f), Q30_fmt(0.82693418207478f), Q30_fmt(0.70710689672598f), Q30_fmt(0.45332071670080f), Q30_fmt(0.00000032679490f) }; const Int32 sin_alphas[NO_ICC_LEVELS] = { Q30_fmt(0.00000000000000f), Q30_fmt(0.17748275057029f), Q30_fmt(0.28179748302823f), Q30_fmt(0.44669868110000f), Q30_fmt(0.56229872711603f), Q30_fmt(0.70710666564709f), Q30_fmt(0.89134747871404f), Q30_fmt(1.00000000000000f) }; /*---------------------------------------------------------------------------- ; 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 ----------------------------------------------------------------------------*/ Int32 ps_init_stereo_mixing(STRUCT_PS_DEC *pms, Int32 env, Int32 usb) { Int32 group; Int32 bin; Int32 noIidSteps; Int32 tmp; Int32 invEnvLength; const Int32 *pScaleFactors; Int32 scaleR; Int32 scaleL; Int32 cos_alpha; Int32 sin_alpha; Int32 beta; Int32 cos_beta; Int32 sin_beta; Int32 temp1; Int32 temp2; Int32 *ptr_tmp; Int32 h11; Int32 h12; Int32 h21; Int32 h22; if (pms->bFineIidQ) { noIidSteps = NO_IID_STEPS_FINE; /* NO_IID_STEPS_FINE == 15 */ pScaleFactors = scaleFactorsFine; } else { noIidSteps = NO_IID_STEPS; /* NO_IID_STEPS == 7 */ pScaleFactors = scaleFactors; } if (env == 0) { pms->lastUsb = pms->usb; pms->usb = usb; if (usb != pms->lastUsb && pms->lastUsb != 0) { return(-1); } } invEnvLength = pms->aEnvStartStop[env + 1] - pms->aEnvStartStop[env]; if (invEnvLength == (Int32) pms->noSubSamples) { invEnvLength = pms->invNoSubSamples; } else { invEnvLength = Q30_fmt(1.0f) / invEnvLength; } if (invEnvLength == 32) /* more likely value */ { for (group = 0; group < NO_IID_GROUPS; group++) /* == 22 */ { bin = bins2groupMap[group]; /* * c(b) = 10^(iid(b)/20) */ tmp = pms->aaIidIndex[env][bin]; /* * Intensity differences * * sqrt(2) * c_1(b) = ---------------- * sqrt( 1 + c^2(b)) * */ scaleR = pScaleFactors[noIidSteps + tmp]; /* * sqrt(2)*c(b) * c_2(b) = ---------------- * sqrt( 1 + c^2(b)) * */ scaleL = pScaleFactors[noIidSteps - tmp]; /* * alpha(b) = (1/2)*arccos( gamma(b)) */ tmp = pms->aaIccIndex[env][bin]; cos_alpha = cos_alphas[ tmp]; sin_alpha = sin_alphas[ tmp]; /* * beta(b) = alpha(b)/sqrt(2)*( c_1(b) - c_2(b)) */ beta = fxp_mul32_Q30(scaled_alphas[ tmp], (scaleR - scaleL)); cos_beta = pv_cosine(beta); sin_beta = pv_sine(beta); temp1 = fxp_mul32_Q30(cos_beta, cos_alpha); temp2 = fxp_mul32_Q30(sin_beta, sin_alpha); /* * h11(b) = cos( alpha(b) + beta(b))* c_2(b) * h12(b) = cos( beta(b) - alpha(b))* c_1(b) */ h11 = fxp_mul32_Q30(scaleL, (temp1 - temp2)); h12 = fxp_mul32_Q30(scaleR, (temp1 + temp2)); temp1 = fxp_mul32_Q30(sin_beta, cos_alpha); temp2 = fxp_mul32_Q30(cos_beta, sin_alpha); /* * h21(b) = sin( alpha(b) + beta(b))* c_2(b) * h22(b) = sin( beta(b) - alpha(b))* c_1(b) */ h21 = fxp_mul32_Q30(scaleL, (temp1 + temp2)); h22 = fxp_mul32_Q30(scaleR, (temp1 - temp2)); /* * Linear interpolation * * Hij(k, n_e+1) - Hij(k, n_e) * Hij(k,n) = Hij(k, n_e) + (n - n_e)*--------------------------- * n_e+1 - n_e */ ptr_tmp = &pms->h11Prev[group]; pms->H11[group] = *ptr_tmp; pms->deltaH11[group] = (h11 - *ptr_tmp) >> 5; *ptr_tmp = h11; ptr_tmp = &pms->h12Prev[group]; pms->H12[group] = *ptr_tmp; pms->deltaH12[group] = (h12 - *ptr_tmp) >> 5; *ptr_tmp = h12; ptr_tmp = &pms->h21Prev[group]; pms->H21[group] = *ptr_tmp; pms->deltaH21[group] = (h21 - *ptr_tmp) >> 5; *ptr_tmp = h21; ptr_tmp = &pms->h22Prev[group]; pms->H22[group] = *ptr_tmp; pms->deltaH22[group] = (h22 - *ptr_tmp) >> 5; *ptr_tmp = h22; } /* groups loop */ } else { for (group = 0; group < NO_IID_GROUPS; group++) /* == 22 */ { bin = bins2groupMap[group]; /* * c(b) = 10^(iid(b)/20) */ tmp = pms->aaIidIndex[env][bin]; /* * Intensity differences * * sqrt(2) * c_1(b) = ---------------- * sqrt( 1 + c^2(b)) * */ scaleR = pScaleFactors[noIidSteps + tmp]; /* * sqrt(2)*c(b) * c_2(b) = ---------------- * sqrt( 1 + c^2(b)) * */ scaleL = pScaleFactors[noIidSteps - tmp]; /* * alpha(b) = (1/2)*arccos( gamma(b)) */ tmp = pms->aaIccIndex[env][bin]; cos_alpha = cos_alphas[ tmp]; sin_alpha = sin_alphas[ tmp]; /* * beta(b) = alpha(b)/sqrt(2)*( c_1(b) - c_2(b)) */ beta = fxp_mul32_Q30(scaled_alphas[ tmp], (scaleR - scaleL)); cos_beta = pv_cosine(beta); sin_beta = pv_sine(beta); temp1 = fxp_mul32_Q30(cos_beta, cos_alpha); temp2 = fxp_mul32_Q30(sin_beta, sin_alpha); /* * h11(b) = cos( alpha(b) + beta(b))* c_2(b) * h12(b) = cos( beta(b) - alpha(b))* c_1(b) */ h11 = fxp_mul32_Q30(scaleL, (temp1 - temp2)); h12 = fxp_mul32_Q30(scaleR, (temp1 + temp2)); temp1 = fxp_mul32_Q30(sin_beta, cos_alpha); temp2 = fxp_mul32_Q30(cos_beta, sin_alpha); /* * h21(b) = sin( alpha(b) + beta(b))* c_2(b) * h22(b) = sin( beta(b) - alpha(b))* c_1(b) */ h21 = fxp_mul32_Q30(scaleL, (temp1 + temp2)); h22 = fxp_mul32_Q30(scaleR, (temp1 - temp2)); /* * Linear interpolation * * Hij(k, n_e+1) - Hij(k, n_e) * Hij(k,n) = Hij(k, n_e) + (n - n_e)*--------------------------- * n_e+1 - n_e */ ptr_tmp = &pms->h11Prev[group]; pms->deltaH11[group] = fxp_mul32_Q30((h11 - *ptr_tmp), invEnvLength); pms->H11[group] = *ptr_tmp; *ptr_tmp = h11; ptr_tmp = &pms->h12Prev[group]; pms->deltaH12[group] = fxp_mul32_Q30((h12 - *ptr_tmp), invEnvLength); pms->H12[group] = *ptr_tmp; *ptr_tmp = h12; ptr_tmp = &pms->h21Prev[group]; pms->deltaH21[group] = fxp_mul32_Q30((h21 - *ptr_tmp), invEnvLength); pms->H21[group] = *ptr_tmp; *ptr_tmp = h21; ptr_tmp = &pms->h22Prev[group]; pms->deltaH22[group] = fxp_mul32_Q30((h22 - *ptr_tmp), invEnvLength); pms->H22[group] = *ptr_tmp; *ptr_tmp = h22; } /* groups loop */ } return (0); } /* END ps_init_stereo_mixing */ #endif #endif