15821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)/*********************************************************************** 25821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)Copyright (c) 2006-2011, Skype Limited. All rights reserved. 35821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)Redistribution and use in source and binary forms, with or without 45821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)modification, are permitted provided that the following conditions 55821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)are met: 65821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)- Redistributions of source code must retain the above copyright notice, 75821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)this list of conditions and the following disclaimer. 85821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)- Redistributions in binary form must reproduce the above copyright 95821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)notice, this list of conditions and the following disclaimer in the 105821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)documentation and/or other materials provided with the distribution. 115821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)- Neither the name of Internet Society, IETF or IETF Trust, nor the 125821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)names of specific contributors, may be used to endorse or promote 135821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)products derived from this software without specific prior written 145821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)permission. 155821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 165821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 175821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 185821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE 195821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 205821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 215821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 225821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 235821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 245821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 255821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)POSSIBILITY OF SUCH DAMAGE. 265821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)***********************************************************************/ 275821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 285821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#ifdef HAVE_CONFIG_H 295821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#include "config.h" 305821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#endif 315821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 325821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#include "SigProc_FIX.h" 335821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 345821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)/* Compute number of bits to right shift the sum of squares of a vector */ 355821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)/* of int16s to make it fit in an int32 */ 365821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)void silk_sum_sqr_shift( 375821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) opus_int32 *energy, /* O Energy of x, after shifting to the right */ 385821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) opus_int *shift, /* O Number of bits right shift applied to energy */ 395821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) const opus_int16 *x, /* I Input vector */ 405821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) opus_int len /* I Length of input vector */ 415821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)) 425821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 435821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) opus_int i, shft; 445821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) opus_int32 nrg_tmp, nrg; 455821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 465821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) nrg = 0; 475821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) shft = 0; 485821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) len--; 495821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) for( i = 0; i < len; i += 2 ) { 505821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) nrg = silk_SMLABB_ovflw( nrg, x[ i ], x[ i ] ); 515821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) nrg = silk_SMLABB_ovflw( nrg, x[ i + 1 ], x[ i + 1 ] ); 525821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if( nrg < 0 ) { 535821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) /* Scale down */ 545821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) nrg = (opus_int32)silk_RSHIFT_uint( (opus_uint32)nrg, 2 ); 555821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) shft = 2; 565821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) break; 575821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 585821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 595821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) for( ; i < len; i += 2 ) { 605821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) nrg_tmp = silk_SMULBB( x[ i ], x[ i ] ); 615821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) nrg_tmp = silk_SMLABB_ovflw( nrg_tmp, x[ i + 1 ], x[ i + 1 ] ); 625821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) nrg = (opus_int32)silk_ADD_RSHIFT_uint( nrg, (opus_uint32)nrg_tmp, shft ); 635821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if( nrg < 0 ) { 645821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) /* Scale down */ 655821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) nrg = (opus_int32)silk_RSHIFT_uint( (opus_uint32)nrg, 2 ); 665821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) shft += 2; 675821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 685821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 695821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if( i == len ) { 705821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) /* One sample left to process */ 715821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) nrg_tmp = silk_SMULBB( x[ i ], x[ i ] ); 725821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) nrg = (opus_int32)silk_ADD_RSHIFT_uint( nrg, nrg_tmp, shft ); 735821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 745821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 755821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) /* Make sure to have at least one extra leading zero (two leading zeros in total) */ 765821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if( nrg & 0xC0000000 ) { 775821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) nrg = silk_RSHIFT_uint( (opus_uint32)nrg, 2 ); 785821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) shft += 2; 795821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 805821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 815821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) /* Output arguments */ 825821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) *shift = shft; 835821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) *energy = nrg; 845821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 855821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 865821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)