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 "main_FIX.h" 33e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org#include "stack_alloc.h" 34885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org#include "tuning_parameters.h" 35885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 36885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org/* Finds LPC vector from correlations, and converts to NLSF */ 37885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.orgvoid silk_find_LPC_FIX( 38885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_encoder_state *psEncC, /* I/O Encoder state */ 39885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int16 NLSF_Q15[], /* O NLSFs */ 40885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org const opus_int16 x[], /* I Input signal */ 41885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org const opus_int32 minInvGain_Q30 /* I Inverse of max prediction gain */ 42885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org) 43885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org{ 44885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int k, subfr_length; 45885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 a_Q16[ MAX_LPC_ORDER ]; 46885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int isInterpLower, shift; 47885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 res_nrg0, res_nrg1; 48885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int rshift0, rshift1; 49885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 50885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Used only for LSF interpolation */ 51885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int32 a_tmp_Q16[ MAX_LPC_ORDER ], res_nrg_interp, res_nrg, res_tmp_nrg; 52885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int res_nrg_interp_Q, res_nrg_Q, res_tmp_nrg_Q; 53885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int16 a_tmp_Q12[ MAX_LPC_ORDER ]; 54885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org opus_int16 NLSF0_Q15[ MAX_LPC_ORDER ]; 55e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org SAVE_STACK; 56885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 57885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org subfr_length = psEncC->subfr_length + psEncC->predictLPCOrder; 58885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 59885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Default: no interpolation */ 60885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org psEncC->indices.NLSFInterpCoef_Q2 = 4; 61885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 62885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Burg AR analysis for the full frame */ 633c3902f0ac13428394f14f78f0fab05ef3468d69tlegrand@google.com silk_burg_modified( &res_nrg, &res_nrg_Q, a_Q16, x, minInvGain_Q30, subfr_length, psEncC->nb_subfr, psEncC->predictLPCOrder, psEncC->arch ); 64885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 65885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( psEncC->useInterpolatedNLSFs && !psEncC->first_frame_after_reset && psEncC->nb_subfr == MAX_NB_SUBFR ) { 66e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org VARDECL( opus_int16, LPC_res ); 67e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org 68885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Optimal solution for last 10 ms */ 693c3902f0ac13428394f14f78f0fab05ef3468d69tlegrand@google.com silk_burg_modified( &res_tmp_nrg, &res_tmp_nrg_Q, a_tmp_Q16, x + 2 * subfr_length, minInvGain_Q30, subfr_length, 2, psEncC->predictLPCOrder, psEncC->arch ); 70885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 71885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* subtract residual energy here, as that's easier than adding it to the */ 72885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* residual energy of the first 10 ms in each iteration of the search below */ 73885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org shift = res_tmp_nrg_Q - res_nrg_Q; 74885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( shift >= 0 ) { 75885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( shift < 32 ) { 76885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_nrg = res_nrg - silk_RSHIFT( res_tmp_nrg, shift ); 77885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 78885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } else { 79885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_assert( shift > -32 ); 80885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_nrg = silk_RSHIFT( res_nrg, -shift ) - res_tmp_nrg; 81885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_nrg_Q = res_tmp_nrg_Q; 82885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 83885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 84885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Convert to NLSFs */ 85885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_A2NLSF( NLSF_Q15, a_tmp_Q16, psEncC->predictLPCOrder ); 86885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 87e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org ALLOC( LPC_res, 2 * subfr_length, opus_int16 ); 88e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org 89885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Search over interpolation indices to find the one with lowest residual energy */ 90885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org for( k = 3; k >= 0; k-- ) { 91885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Interpolate NLSFs for first half */ 92885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_interpolate( NLSF0_Q15, psEncC->prev_NLSFq_Q15, NLSF_Q15, k, psEncC->predictLPCOrder ); 93885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 94885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Convert to LPC for residual energy evaluation */ 95885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_NLSF2A( a_tmp_Q12, NLSF0_Q15, psEncC->predictLPCOrder ); 96885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 97885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Calculate residual energy with NLSF interpolation */ 98885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_LPC_analysis_filter( LPC_res, x, a_tmp_Q12, 2 * subfr_length, psEncC->predictLPCOrder ); 99885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 100885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_sum_sqr_shift( &res_nrg0, &rshift0, LPC_res + psEncC->predictLPCOrder, subfr_length - psEncC->predictLPCOrder ); 101885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_sum_sqr_shift( &res_nrg1, &rshift1, LPC_res + psEncC->predictLPCOrder + subfr_length, subfr_length - psEncC->predictLPCOrder ); 102885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 103885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Add subframe energies from first half frame */ 104885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org shift = rshift0 - rshift1; 105885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( shift >= 0 ) { 106885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_nrg1 = silk_RSHIFT( res_nrg1, shift ); 107885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_nrg_interp_Q = -rshift0; 108885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } else { 109885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_nrg0 = silk_RSHIFT( res_nrg0, -shift ); 110885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_nrg_interp_Q = -rshift1; 111885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 112885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_nrg_interp = silk_ADD32( res_nrg0, res_nrg1 ); 113885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 114885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Compare with first half energy without NLSF interpolation, or best interpolated value so far */ 115885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org shift = res_nrg_interp_Q - res_nrg_Q; 116885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( shift >= 0 ) { 117885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( silk_RSHIFT( res_nrg_interp, shift ) < res_nrg ) { 118885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org isInterpLower = silk_TRUE; 119885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } else { 120885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org isInterpLower = silk_FALSE; 121885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 122885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } else { 123885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( -shift < 32 ) { 124885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( res_nrg_interp < silk_RSHIFT( res_nrg, -shift ) ) { 125885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org isInterpLower = silk_TRUE; 126885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } else { 127885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org isInterpLower = silk_FALSE; 128885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 129885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } else { 130885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org isInterpLower = silk_FALSE; 131885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 132885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 133885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 134885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Determine whether current interpolated NLSFs are best so far */ 135885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( isInterpLower == silk_TRUE ) { 136885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* Interpolation has lower residual energy */ 137885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_nrg = res_nrg_interp; 138885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org res_nrg_Q = res_nrg_interp_Q; 139885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org psEncC->indices.NLSFInterpCoef_Q2 = (opus_int8)k; 140885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 141885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 142885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 143885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 144885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org if( psEncC->indices.NLSFInterpCoef_Q2 == 4 ) { 145885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org /* NLSF interpolation is currently inactive, calculate NLSFs from full frame AR coefficients */ 146885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_A2NLSF( NLSF_Q15, a_Q16, psEncC->predictLPCOrder ); 147885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org } 148885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org 149885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org silk_assert( psEncC->indices.NLSFInterpCoef_Q2 == 4 || ( psEncC->useInterpolatedNLSFs && !psEncC->first_frame_after_reset && psEncC->nb_subfr == MAX_NB_SUBFR ) ); 150e3ea049fcaee2247e45f0ce793d4313babb4ef69tlegrand@chromium.org RESTORE_STACK; 151885f2ff5a7a7d6a73432d26a6c0ae9147e6b452sergeyu@chromium.org} 152