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. 11e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@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. 15e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@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#include "resampler_private.h" 34e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org#include "stack_alloc.h" 35885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 36885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org#define ORDER_FIR 4 37885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 38885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org/* Downsample by a factor 2/3, low quality */ 39885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgvoid silk_resampler_down2_3( 40885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 *S, /* I/O State vector [ 6 ] */ 41885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int16 *out, /* O Output signal [ floor(2*inLen/3) ] */ 42885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org const opus_int16 *in, /* I Input signal [ inLen ] */ 43885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 inLen /* I Number of input samples */ 44885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org) 45885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org{ 46885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 nSamplesIn, counter, res_Q6; 47e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org VARDECL( opus_int32, buf ); 48885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 *buf_ptr; 49e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org SAVE_STACK; 50e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org 51e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org ALLOC( buf, RESAMPLER_MAX_BATCH_SIZE_IN + ORDER_FIR, opus_int32 ); 52885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 53885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Copy buffered samples to start of buffer */ 54885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_memcpy( buf, S, ORDER_FIR * sizeof( opus_int32 ) ); 55885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 56885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Iterate over blocks of frameSizeIn input samples */ 57885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org while( 1 ) { 58885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nSamplesIn = silk_min( inLen, RESAMPLER_MAX_BATCH_SIZE_IN ); 59885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 60885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Second-order AR filter (output in Q8) */ 61885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_resampler_private_AR2( &S[ ORDER_FIR ], &buf[ ORDER_FIR ], in, 62885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_Resampler_2_3_COEFS_LQ, nSamplesIn ); 63885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 64885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Interpolate filtered signal */ 65885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org buf_ptr = buf; 66885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org counter = nSamplesIn; 67885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org while( counter > 2 ) { 68885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Inner product */ 69885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q6 = silk_SMULWB( buf_ptr[ 0 ], silk_Resampler_2_3_COEFS_LQ[ 2 ] ); 70885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q6 = silk_SMLAWB( res_Q6, buf_ptr[ 1 ], silk_Resampler_2_3_COEFS_LQ[ 3 ] ); 71885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q6 = silk_SMLAWB( res_Q6, buf_ptr[ 2 ], silk_Resampler_2_3_COEFS_LQ[ 5 ] ); 72885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q6 = silk_SMLAWB( res_Q6, buf_ptr[ 3 ], silk_Resampler_2_3_COEFS_LQ[ 4 ] ); 73885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 74885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Scale down, saturate and store in output array */ 75885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org *out++ = (opus_int16)silk_SAT16( silk_RSHIFT_ROUND( res_Q6, 6 ) ); 76885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 77885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q6 = silk_SMULWB( buf_ptr[ 1 ], silk_Resampler_2_3_COEFS_LQ[ 4 ] ); 78885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q6 = silk_SMLAWB( res_Q6, buf_ptr[ 2 ], silk_Resampler_2_3_COEFS_LQ[ 5 ] ); 79885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q6 = silk_SMLAWB( res_Q6, buf_ptr[ 3 ], silk_Resampler_2_3_COEFS_LQ[ 3 ] ); 80885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q6 = silk_SMLAWB( res_Q6, buf_ptr[ 4 ], silk_Resampler_2_3_COEFS_LQ[ 2 ] ); 81885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 82885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Scale down, saturate and store in output array */ 83885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org *out++ = (opus_int16)silk_SAT16( silk_RSHIFT_ROUND( res_Q6, 6 ) ); 84885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 85885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org buf_ptr += 3; 86885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org counter -= 3; 87885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 88885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 89885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org in += nSamplesIn; 90885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org inLen -= nSamplesIn; 91885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 92885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( inLen > 0 ) { 93885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* More iterations to do; copy last part of filtered signal to beginning of buffer */ 94885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_memcpy( buf, &buf[ nSamplesIn ], ORDER_FIR * sizeof( opus_int32 ) ); 95885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } else { 96885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org break; 97885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 98885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 99885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 100885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Copy last part of filtered signal to the state for the next call */ 101885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_memcpy( S, &buf[ nSamplesIn ], ORDER_FIR * sizeof( opus_int32 ) ); 102e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org RESTORE_STACK; 103885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org} 104