1.1 --- /dev/null Thu Jan 01 00:00:00 1970 +0000
1.2 +++ b/media/libopus/silk/float/residual_energy_FLP.c Wed Dec 31 06:09:35 2014 +0100
1.3 @@ -0,0 +1,117 @@
1.4 +/***********************************************************************
1.5 +Copyright (c) 2006-2011, Skype Limited. All rights reserved.
1.6 +Redistribution and use in source and binary forms, with or without
1.7 +modification, are permitted provided that the following conditions
1.8 +are met:
1.9 +- Redistributions of source code must retain the above copyright notice,
1.10 +this list of conditions and the following disclaimer.
1.11 +- Redistributions in binary form must reproduce the above copyright
1.12 +notice, this list of conditions and the following disclaimer in the
1.13 +documentation and/or other materials provided with the distribution.
1.14 +- Neither the name of Internet Society, IETF or IETF Trust, nor the
1.15 +names of specific contributors, may be used to endorse or promote
1.16 +products derived from this software without specific prior written
1.17 +permission.
1.18 +THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
1.19 +AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1.20 +IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1.21 +ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
1.22 +LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
1.23 +CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
1.24 +SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
1.25 +INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
1.26 +CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
1.27 +ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
1.28 +POSSIBILITY OF SUCH DAMAGE.
1.29 +***********************************************************************/
1.30 +
1.31 +#ifdef HAVE_CONFIG_H
1.32 +#include "config.h"
1.33 +#endif
1.34 +
1.35 +#include "main_FLP.h"
1.36 +
1.37 +#define MAX_ITERATIONS_RESIDUAL_NRG 10
1.38 +#define REGULARIZATION_FACTOR 1e-8f
1.39 +
1.40 +/* Residual energy: nrg = wxx - 2 * wXx * c + c' * wXX * c */
1.41 +silk_float silk_residual_energy_covar_FLP( /* O Weighted residual energy */
1.42 + const silk_float *c, /* I Filter coefficients */
1.43 + silk_float *wXX, /* I/O Weighted correlation matrix, reg. out */
1.44 + const silk_float *wXx, /* I Weighted correlation vector */
1.45 + const silk_float wxx, /* I Weighted correlation value */
1.46 + const opus_int D /* I Dimension */
1.47 +)
1.48 +{
1.49 + opus_int i, j, k;
1.50 + silk_float tmp, nrg = 0.0f, regularization;
1.51 +
1.52 + /* Safety checks */
1.53 + silk_assert( D >= 0 );
1.54 +
1.55 + regularization = REGULARIZATION_FACTOR * ( wXX[ 0 ] + wXX[ D * D - 1 ] );
1.56 + for( k = 0; k < MAX_ITERATIONS_RESIDUAL_NRG; k++ ) {
1.57 + nrg = wxx;
1.58 +
1.59 + tmp = 0.0f;
1.60 + for( i = 0; i < D; i++ ) {
1.61 + tmp += wXx[ i ] * c[ i ];
1.62 + }
1.63 + nrg -= 2.0f * tmp;
1.64 +
1.65 + /* compute c' * wXX * c, assuming wXX is symmetric */
1.66 + for( i = 0; i < D; i++ ) {
1.67 + tmp = 0.0f;
1.68 + for( j = i + 1; j < D; j++ ) {
1.69 + tmp += matrix_c_ptr( wXX, i, j, D ) * c[ j ];
1.70 + }
1.71 + nrg += c[ i ] * ( 2.0f * tmp + matrix_c_ptr( wXX, i, i, D ) * c[ i ] );
1.72 + }
1.73 + if( nrg > 0 ) {
1.74 + break;
1.75 + } else {
1.76 + /* Add white noise */
1.77 + for( i = 0; i < D; i++ ) {
1.78 + matrix_c_ptr( wXX, i, i, D ) += regularization;
1.79 + }
1.80 + /* Increase noise for next run */
1.81 + regularization *= 2.0f;
1.82 + }
1.83 + }
1.84 + if( k == MAX_ITERATIONS_RESIDUAL_NRG ) {
1.85 + silk_assert( nrg == 0 );
1.86 + nrg = 1.0f;
1.87 + }
1.88 +
1.89 + return nrg;
1.90 +}
1.91 +
1.92 +/* Calculates residual energies of input subframes where all subframes have LPC_order */
1.93 +/* of preceding samples */
1.94 +void silk_residual_energy_FLP(
1.95 + silk_float nrgs[ MAX_NB_SUBFR ], /* O Residual energy per subframe */
1.96 + const silk_float x[], /* I Input signal */
1.97 + silk_float a[ 2 ][ MAX_LPC_ORDER ], /* I AR coefs for each frame half */
1.98 + const silk_float gains[], /* I Quantization gains */
1.99 + const opus_int subfr_length, /* I Subframe length */
1.100 + const opus_int nb_subfr, /* I number of subframes */
1.101 + const opus_int LPC_order /* I LPC order */
1.102 +)
1.103 +{
1.104 + opus_int shift;
1.105 + silk_float *LPC_res_ptr, LPC_res[ ( MAX_FRAME_LENGTH + MAX_NB_SUBFR * MAX_LPC_ORDER ) / 2 ];
1.106 +
1.107 + LPC_res_ptr = LPC_res + LPC_order;
1.108 + shift = LPC_order + subfr_length;
1.109 +
1.110 + /* Filter input to create the LPC residual for each frame half, and measure subframe energies */
1.111 + silk_LPC_analysis_filter_FLP( LPC_res, a[ 0 ], x + 0 * shift, 2 * shift, LPC_order );
1.112 + nrgs[ 0 ] = ( silk_float )( gains[ 0 ] * gains[ 0 ] * silk_energy_FLP( LPC_res_ptr + 0 * shift, subfr_length ) );
1.113 + nrgs[ 1 ] = ( silk_float )( gains[ 1 ] * gains[ 1 ] * silk_energy_FLP( LPC_res_ptr + 1 * shift, subfr_length ) );
1.114 +
1.115 + if( nb_subfr == MAX_NB_SUBFR ) {
1.116 + silk_LPC_analysis_filter_FLP( LPC_res, a[ 1 ], x + 2 * shift, 2 * shift, LPC_order );
1.117 + nrgs[ 2 ] = ( silk_float )( gains[ 2 ] * gains[ 2 ] * silk_energy_FLP( LPC_res_ptr + 0 * shift, subfr_length ) );
1.118 + nrgs[ 3 ] = ( silk_float )( gains[ 3 ] * gains[ 3 ] * silk_energy_FLP( LPC_res_ptr + 1 * shift, subfr_length ) );
1.119 + }
1.120 +}
