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" 34885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 35885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org/* Upsample by a factor 2, high quality */ 36885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org/* Uses 2nd order allpass filters for the 2x upsampling, followed by a */ 37885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org/* notch filter just above Nyquist. */ 38885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgvoid silk_resampler_private_up2_HQ( 39885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 *S, /* I/O Resampler state [ 6 ] */ 40885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int16 *out, /* O Output signal [ 2 * len ] */ 41885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org const opus_int16 *in, /* I Input signal [ len ] */ 42885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 len /* I Number of input samples */ 43885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org) 44885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org{ 45885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 k; 46885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 in32, out32_1, out32_2, Y, X; 47885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 48885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_assert( silk_resampler_up2_hq_0[ 0 ] > 0 ); 49885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_assert( silk_resampler_up2_hq_0[ 1 ] > 0 ); 50885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_assert( silk_resampler_up2_hq_0[ 2 ] < 0 ); 51885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_assert( silk_resampler_up2_hq_1[ 0 ] > 0 ); 52885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_assert( silk_resampler_up2_hq_1[ 1 ] > 0 ); 53885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_assert( silk_resampler_up2_hq_1[ 2 ] < 0 ); 54885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 55885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Internal variables and state are in Q10 format */ 56885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org for( k = 0; k < len; k++ ) { 57885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Convert to Q10 */ 58885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org in32 = silk_LSHIFT( (opus_int32)in[ k ], 10 ); 59885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 60885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* First all-pass section for even output sample */ 61885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org Y = silk_SUB32( in32, S[ 0 ] ); 62885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org X = silk_SMULWB( Y, silk_resampler_up2_hq_0[ 0 ] ); 63885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org out32_1 = silk_ADD32( S[ 0 ], X ); 64885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org S[ 0 ] = silk_ADD32( in32, X ); 65885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 66885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Second all-pass section for even output sample */ 67885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org Y = silk_SUB32( out32_1, S[ 1 ] ); 68885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org X = silk_SMULWB( Y, silk_resampler_up2_hq_0[ 1 ] ); 69885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org out32_2 = silk_ADD32( S[ 1 ], X ); 70885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org S[ 1 ] = silk_ADD32( out32_1, X ); 71885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 72885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Third all-pass section for even output sample */ 73885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org Y = silk_SUB32( out32_2, S[ 2 ] ); 74885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org X = silk_SMLAWB( Y, Y, silk_resampler_up2_hq_0[ 2 ] ); 75885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org out32_1 = silk_ADD32( S[ 2 ], X ); 76885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org S[ 2 ] = silk_ADD32( out32_2, X ); 77885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 78885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Apply gain in Q15, convert back to int16 and store to output */ 79885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org out[ 2 * k ] = (opus_int16)silk_SAT16( silk_RSHIFT_ROUND( out32_1, 10 ) ); 80885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 81885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* First all-pass section for odd output sample */ 82885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org Y = silk_SUB32( in32, S[ 3 ] ); 83885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org X = silk_SMULWB( Y, silk_resampler_up2_hq_1[ 0 ] ); 84885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org out32_1 = silk_ADD32( S[ 3 ], X ); 85885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org S[ 3 ] = silk_ADD32( in32, X ); 86885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 87885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Second all-pass section for odd output sample */ 88885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org Y = silk_SUB32( out32_1, S[ 4 ] ); 89885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org X = silk_SMULWB( Y, silk_resampler_up2_hq_1[ 1 ] ); 90885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org out32_2 = silk_ADD32( S[ 4 ], X ); 91885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org S[ 4 ] = silk_ADD32( out32_1, X ); 92885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 93885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Third all-pass section for odd output sample */ 94885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org Y = silk_SUB32( out32_2, S[ 5 ] ); 95885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org X = silk_SMLAWB( Y, Y, silk_resampler_up2_hq_1[ 2 ] ); 96885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org out32_1 = silk_ADD32( S[ 5 ], X ); 97885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org S[ 5 ] = silk_ADD32( out32_2, X ); 98885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 99885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Apply gain in Q15, convert back to int16 and store to output */ 100885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org out[ 2 * k + 1 ] = (opus_int16)silk_SAT16( silk_RSHIFT_ROUND( out32_1, 10 ) ); 101885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 102885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org} 103885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 104885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgvoid silk_resampler_private_up2_HQ_wrapper( 105885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org void *SS, /* I/O Resampler state (unused) */ 106885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int16 *out, /* O Output signal [ 2 * len ] */ 107885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org const opus_int16 *in, /* I Input signal [ len ] */ 108885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 len /* I Number of input samples */ 109885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org) 110885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org{ 111885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_resampler_state_struct *S = (silk_resampler_state_struct *)SS; 112885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_resampler_private_up2_HQ( S->sIIR, out, in, len ); 113885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org} 114