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 363c3902f0ac13428394f14f78f0fab05ef3468d69tlegrand@google.comstatic OPUS_INLINE opus_int16 *silk_resampler_private_IIR_FIR_INTERPOL( 37885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int16 *out, 38885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int16 *buf, 39885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 max_index_Q16, 40885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 index_increment_Q16 41885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org) 42885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org{ 43885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 index_Q16, res_Q15; 44885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int16 *buf_ptr; 45885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 table_index; 46885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 47885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Interpolate upsampled signal and store in output array */ 48885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org for( index_Q16 = 0; index_Q16 < max_index_Q16; index_Q16 += index_increment_Q16 ) { 49885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org table_index = silk_SMULWB( index_Q16 & 0xFFFF, 12 ); 50885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org buf_ptr = &buf[ index_Q16 >> 16 ]; 51885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 52885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q15 = silk_SMULBB( buf_ptr[ 0 ], silk_resampler_frac_FIR_12[ table_index ][ 0 ] ); 53885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 1 ], silk_resampler_frac_FIR_12[ table_index ][ 1 ] ); 54885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 2 ], silk_resampler_frac_FIR_12[ table_index ][ 2 ] ); 55885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 3 ], silk_resampler_frac_FIR_12[ table_index ][ 3 ] ); 56885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 4 ], silk_resampler_frac_FIR_12[ 11 - table_index ][ 3 ] ); 57885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 5 ], silk_resampler_frac_FIR_12[ 11 - table_index ][ 2 ] ); 58885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 6 ], silk_resampler_frac_FIR_12[ 11 - table_index ][ 1 ] ); 59885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_Q15 = silk_SMLABB( res_Q15, buf_ptr[ 7 ], silk_resampler_frac_FIR_12[ 11 - table_index ][ 0 ] ); 60885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org *out++ = (opus_int16)silk_SAT16( silk_RSHIFT_ROUND( res_Q15, 15 ) ); 61885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 62885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org return out; 63885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org} 64885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org/* Upsample using a combination of allpass-based 2x upsampling and FIR interpolation */ 65885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgvoid silk_resampler_private_IIR_FIR( 66885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org void *SS, /* I/O Resampler state */ 67885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int16 out[], /* O Output signal */ 68885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org const opus_int16 in[], /* I Input signal */ 69885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 inLen /* I Number of input samples */ 70885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org) 71885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org{ 72885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_resampler_state_struct *S = (silk_resampler_state_struct *)SS; 73885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 nSamplesIn; 74885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 max_index_Q16, index_increment_Q16; 75e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org VARDECL( opus_int16, buf ); 76e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org SAVE_STACK; 77e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org 78e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org ALLOC( buf, 2 * S->batchSize + RESAMPLER_ORDER_FIR_12, opus_int16 ); 79885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 80885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Copy buffered samples to start of buffer */ 81e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org silk_memcpy( buf, S->sFIR.i16, RESAMPLER_ORDER_FIR_12 * sizeof( opus_int16 ) ); 82885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 83885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Iterate over blocks of frameSizeIn input samples */ 84885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org index_increment_Q16 = S->invRatio_Q16; 85885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org while( 1 ) { 86885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org nSamplesIn = silk_min( inLen, S->batchSize ); 87885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 88885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Upsample 2x */ 89885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_resampler_private_up2_HQ( S->sIIR, &buf[ RESAMPLER_ORDER_FIR_12 ], in, nSamplesIn ); 90885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 91885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org max_index_Q16 = silk_LSHIFT32( nSamplesIn, 16 + 1 ); /* + 1 because 2x upsampling */ 92885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org out = silk_resampler_private_IIR_FIR_INTERPOL( out, buf, max_index_Q16, index_increment_Q16 ); 93885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org in += nSamplesIn; 94885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org inLen -= nSamplesIn; 95885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 96885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( inLen > 0 ) { 97885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* More iterations to do; copy last part of filtered signal to beginning of buffer */ 98e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org silk_memcpy( buf, &buf[ nSamplesIn << 1 ], RESAMPLER_ORDER_FIR_12 * sizeof( opus_int16 ) ); 99885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } else { 100885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org break; 101885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 102885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 103885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 104885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Copy last part of filtered signal to the state for the next call */ 105e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org silk_memcpy( S->sFIR.i16, &buf[ nSamplesIn << 1 ], RESAMPLER_ORDER_FIR_12 * sizeof( opus_int16 ) ); 106e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org RESTORE_STACK; 107885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org} 108