1885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org/*********************************************************************** 2885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgCopyright (c) 2006-2011, Skype Limited. All rights reserved. 3885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgRedistribution and use in source and binary forms, with or without 4885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgmodification, are permitted provided that the following conditions 5885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgare met: 6885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org- Redistributions of source code must retain the above copyright notice, 7885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgthis list of conditions and the following disclaimer. 8885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org- Redistributions in binary form must reproduce the above copyright 9885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgnotice, this list of conditions and the following disclaimer in the 10885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgdocumentation and/or other materials provided with the distribution. 11885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org- Neither the name of Internet Society, IETF or IETF Trust, nor the 12885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgnames of specific contributors, may be used to endorse or promote 13885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgproducts derived from this software without specific prior written 14885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgpermission. 15885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgTHIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS “AS IS” 16885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgAND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgIMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE 19885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgLIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 20885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgCONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 21885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgSUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 22885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgINTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 23885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgCONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 24885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 25885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgPOSSIBILITY OF SUCH DAMAGE. 26885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org***********************************************************************/ 27885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 28885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org#ifdef HAVE_CONFIG_H 29885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org#include "config.h" 30885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org#endif 31885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 32885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org#include "SigProc_FIX.h" 33885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 34885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org/* Compute number of bits to right shift the sum of squares of a vector */ 35885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org/* of int16s to make it fit in an int32 */ 36885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgvoid silk_sum_sqr_shift( 37885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 *energy, /* O Energy of x, after shifting to the right */ 38885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int *shift, /* O Number of bits right shift applied to energy */ 39885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org const opus_int16 *x, /* I Input vector */ 40885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int len /* I Length of input vector */ 41885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org) 42885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org{ 43885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int i, shft; 44885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 nrg_tmp, nrg; 45885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 46885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nrg = 0; 47885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org shft = 0; 48885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org len--; 49885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org for( i = 0; i < len; i += 2 ) { 50885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nrg = silk_SMLABB_ovflw( nrg, x[ i ], x[ i ] ); 51885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nrg = silk_SMLABB_ovflw( nrg, x[ i + 1 ], x[ i + 1 ] ); 52885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( nrg < 0 ) { 53885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Scale down */ 54885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nrg = (opus_int32)silk_RSHIFT_uint( (opus_uint32)nrg, 2 ); 55885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org shft = 2; 56885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org break; 57885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 58885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 59885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org for( ; i < len; i += 2 ) { 60885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nrg_tmp = silk_SMULBB( x[ i ], x[ i ] ); 61885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nrg_tmp = silk_SMLABB_ovflw( nrg_tmp, x[ i + 1 ], x[ i + 1 ] ); 62885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nrg = (opus_int32)silk_ADD_RSHIFT_uint( nrg, (opus_uint32)nrg_tmp, shft ); 63885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( nrg < 0 ) { 64885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Scale down */ 65885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nrg = (opus_int32)silk_RSHIFT_uint( (opus_uint32)nrg, 2 ); 66885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org shft += 2; 67885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 68885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 69885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( i == len ) { 70885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* One sample left to process */ 71885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nrg_tmp = silk_SMULBB( x[ i ], x[ i ] ); 72885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nrg = (opus_int32)silk_ADD_RSHIFT_uint( nrg, nrg_tmp, shft ); 73885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 74885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 75885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Make sure to have at least one extra leading zero (two leading zeros in total) */ 76885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( nrg & 0xC0000000 ) { 77885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nrg = silk_RSHIFT_uint( (opus_uint32)nrg, 2 ); 78885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org shft += 2; 79885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 80885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 81885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Output arguments */ 82885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org *shift = shft; 83885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org *energy = nrg; 84885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org} 85885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 86