1.1 --- /dev/null Thu Jan 01 00:00:00 1970 +0000
1.2 +++ b/media/libopus/silk/fixed/residual_energy16_FIX.c Wed Dec 31 06:09:35 2014 +0100
1.3 @@ -0,0 +1,103 @@
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_FIX.h"
1.36 +
1.37 +/* Residual energy: nrg = wxx - 2 * wXx * c + c' * wXX * c */
1.38 +opus_int32 silk_residual_energy16_covar_FIX(
1.39 + const opus_int16 *c, /* I Prediction vector */
1.40 + const opus_int32 *wXX, /* I Correlation matrix */
1.41 + const opus_int32 *wXx, /* I Correlation vector */
1.42 + opus_int32 wxx, /* I Signal energy */
1.43 + opus_int D, /* I Dimension */
1.44 + opus_int cQ /* I Q value for c vector 0 - 15 */
1.45 +)
1.46 +{
1.47 + opus_int i, j, lshifts, Qxtra;
1.48 + opus_int32 c_max, w_max, tmp, tmp2, nrg;
1.49 + opus_int cn[ MAX_MATRIX_SIZE ];
1.50 + const opus_int32 *pRow;
1.51 +
1.52 + /* Safety checks */
1.53 + silk_assert( D >= 0 );
1.54 + silk_assert( D <= 16 );
1.55 + silk_assert( cQ > 0 );
1.56 + silk_assert( cQ < 16 );
1.57 +
1.58 + lshifts = 16 - cQ;
1.59 + Qxtra = lshifts;
1.60 +
1.61 + c_max = 0;
1.62 + for( i = 0; i < D; i++ ) {
1.63 + c_max = silk_max_32( c_max, silk_abs( (opus_int32)c[ i ] ) );
1.64 + }
1.65 + Qxtra = silk_min_int( Qxtra, silk_CLZ32( c_max ) - 17 );
1.66 +
1.67 + w_max = silk_max_32( wXX[ 0 ], wXX[ D * D - 1 ] );
1.68 + Qxtra = silk_min_int( Qxtra, silk_CLZ32( silk_MUL( D, silk_RSHIFT( silk_SMULWB( w_max, c_max ), 4 ) ) ) - 5 );
1.69 + Qxtra = silk_max_int( Qxtra, 0 );
1.70 + for( i = 0; i < D; i++ ) {
1.71 + cn[ i ] = silk_LSHIFT( ( opus_int )c[ i ], Qxtra );
1.72 + silk_assert( silk_abs(cn[i]) <= ( silk_int16_MAX + 1 ) ); /* Check that silk_SMLAWB can be used */
1.73 + }
1.74 + lshifts -= Qxtra;
1.75 +
1.76 + /* Compute wxx - 2 * wXx * c */
1.77 + tmp = 0;
1.78 + for( i = 0; i < D; i++ ) {
1.79 + tmp = silk_SMLAWB( tmp, wXx[ i ], cn[ i ] );
1.80 + }
1.81 + nrg = silk_RSHIFT( wxx, 1 + lshifts ) - tmp; /* Q: -lshifts - 1 */
1.82 +
1.83 + /* Add c' * wXX * c, assuming wXX is symmetric */
1.84 + tmp2 = 0;
1.85 + for( i = 0; i < D; i++ ) {
1.86 + tmp = 0;
1.87 + pRow = &wXX[ i * D ];
1.88 + for( j = i + 1; j < D; j++ ) {
1.89 + tmp = silk_SMLAWB( tmp, pRow[ j ], cn[ j ] );
1.90 + }
1.91 + tmp = silk_SMLAWB( tmp, silk_RSHIFT( pRow[ i ], 1 ), cn[ i ] );
1.92 + tmp2 = silk_SMLAWB( tmp2, tmp, cn[ i ] );
1.93 + }
1.94 + nrg = silk_ADD_LSHIFT32( nrg, tmp2, lshifts ); /* Q: -lshifts - 1 */
1.95 +
1.96 + /* Keep one bit free always, because we add them for LSF interpolation */
1.97 + if( nrg < 1 ) {
1.98 + nrg = 1;
1.99 + } else if( nrg > silk_RSHIFT( silk_int32_MAX, lshifts + 2 ) ) {
1.100 + nrg = silk_int32_MAX >> 1;
1.101 + } else {
1.102 + nrg = silk_LSHIFT( nrg, lshifts + 1 ); /* Q0 */
1.103 + }
1.104 + return nrg;
1.105 +
1.106 +}
