cannam@154: /*********************************************************************** cannam@154: Copyright (c) 2006-2011, Skype Limited. All rights reserved. cannam@154: Redistribution and use in source and binary forms, with or without cannam@154: modification, are permitted provided that the following conditions cannam@154: are met: cannam@154: - Redistributions of source code must retain the above copyright notice, cannam@154: this list of conditions and the following disclaimer. cannam@154: - Redistributions in binary form must reproduce the above copyright cannam@154: notice, this list of conditions and the following disclaimer in the cannam@154: documentation and/or other materials provided with the distribution. cannam@154: - Neither the name of Internet Society, IETF or IETF Trust, nor the cannam@154: names of specific contributors, may be used to endorse or promote cannam@154: products derived from this software without specific prior written cannam@154: permission. cannam@154: THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" cannam@154: AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE cannam@154: IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE cannam@154: ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE cannam@154: LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR cannam@154: CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF cannam@154: SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS cannam@154: INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN cannam@154: CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) cannam@154: ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE cannam@154: POSSIBILITY OF SUCH DAMAGE. cannam@154: ***********************************************************************/ cannam@154: cannam@154: #ifdef HAVE_CONFIG_H cannam@154: #include "config.h" cannam@154: #endif cannam@154: cannam@154: #include "main_FIX.h" cannam@154: #include "stack_alloc.h" cannam@154: cannam@154: void silk_find_pred_coefs_FIX( cannam@154: silk_encoder_state_FIX *psEnc, /* I/O encoder state */ cannam@154: silk_encoder_control_FIX *psEncCtrl, /* I/O encoder control */ cannam@154: const opus_int16 res_pitch[], /* I Residual from pitch analysis */ cannam@154: const opus_int16 x[], /* I Speech signal */ cannam@154: opus_int condCoding /* I The type of conditional coding to use */ cannam@154: ) cannam@154: { cannam@154: opus_int i; cannam@154: opus_int32 invGains_Q16[ MAX_NB_SUBFR ], local_gains[ MAX_NB_SUBFR ]; cannam@154: opus_int16 NLSF_Q15[ MAX_LPC_ORDER ]; cannam@154: const opus_int16 *x_ptr; cannam@154: opus_int16 *x_pre_ptr; cannam@154: VARDECL( opus_int16, LPC_in_pre ); cannam@154: opus_int32 min_gain_Q16, minInvGain_Q30; cannam@154: SAVE_STACK; cannam@154: cannam@154: /* weighting for weighted least squares */ cannam@154: min_gain_Q16 = silk_int32_MAX >> 6; cannam@154: for( i = 0; i < psEnc->sCmn.nb_subfr; i++ ) { cannam@154: min_gain_Q16 = silk_min( min_gain_Q16, psEncCtrl->Gains_Q16[ i ] ); cannam@154: } cannam@154: for( i = 0; i < psEnc->sCmn.nb_subfr; i++ ) { cannam@154: /* Divide to Q16 */ cannam@154: silk_assert( psEncCtrl->Gains_Q16[ i ] > 0 ); cannam@154: /* Invert and normalize gains, and ensure that maximum invGains_Q16 is within range of a 16 bit int */ cannam@154: invGains_Q16[ i ] = silk_DIV32_varQ( min_gain_Q16, psEncCtrl->Gains_Q16[ i ], 16 - 2 ); cannam@154: cannam@154: /* Limit inverse */ cannam@154: invGains_Q16[ i ] = silk_max( invGains_Q16[ i ], 100 ); cannam@154: cannam@154: /* Square the inverted gains */ cannam@154: silk_assert( invGains_Q16[ i ] == silk_SAT16( invGains_Q16[ i ] ) ); cannam@154: cannam@154: /* Invert the inverted and normalized gains */ cannam@154: local_gains[ i ] = silk_DIV32( ( (opus_int32)1 << 16 ), invGains_Q16[ i ] ); cannam@154: } cannam@154: cannam@154: ALLOC( LPC_in_pre, cannam@154: psEnc->sCmn.nb_subfr * psEnc->sCmn.predictLPCOrder cannam@154: + psEnc->sCmn.frame_length, opus_int16 ); cannam@154: if( psEnc->sCmn.indices.signalType == TYPE_VOICED ) { cannam@154: VARDECL( opus_int32, xXLTP_Q17 ); cannam@154: VARDECL( opus_int32, XXLTP_Q17 ); cannam@154: cannam@154: /**********/ cannam@154: /* VOICED */ cannam@154: /**********/ cannam@154: celt_assert( psEnc->sCmn.ltp_mem_length - psEnc->sCmn.predictLPCOrder >= psEncCtrl->pitchL[ 0 ] + LTP_ORDER / 2 ); cannam@154: cannam@154: ALLOC( xXLTP_Q17, psEnc->sCmn.nb_subfr * LTP_ORDER, opus_int32 ); cannam@154: ALLOC( XXLTP_Q17, psEnc->sCmn.nb_subfr * LTP_ORDER * LTP_ORDER, opus_int32 ); cannam@154: cannam@154: /* LTP analysis */ cannam@154: silk_find_LTP_FIX( XXLTP_Q17, xXLTP_Q17, res_pitch, cannam@154: psEncCtrl->pitchL, psEnc->sCmn.subfr_length, psEnc->sCmn.nb_subfr, psEnc->sCmn.arch ); cannam@154: cannam@154: /* Quantize LTP gain parameters */ cannam@154: silk_quant_LTP_gains( psEncCtrl->LTPCoef_Q14, psEnc->sCmn.indices.LTPIndex, &psEnc->sCmn.indices.PERIndex, cannam@154: &psEnc->sCmn.sum_log_gain_Q7, &psEncCtrl->LTPredCodGain_Q7, XXLTP_Q17, xXLTP_Q17, psEnc->sCmn.subfr_length, psEnc->sCmn.nb_subfr, psEnc->sCmn.arch ); cannam@154: cannam@154: /* Control LTP scaling */ cannam@154: silk_LTP_scale_ctrl_FIX( psEnc, psEncCtrl, condCoding ); cannam@154: cannam@154: /* Create LTP residual */ cannam@154: silk_LTP_analysis_filter_FIX( LPC_in_pre, x - psEnc->sCmn.predictLPCOrder, psEncCtrl->LTPCoef_Q14, cannam@154: psEncCtrl->pitchL, invGains_Q16, psEnc->sCmn.subfr_length, psEnc->sCmn.nb_subfr, psEnc->sCmn.predictLPCOrder ); cannam@154: cannam@154: } else { cannam@154: /************/ cannam@154: /* UNVOICED */ cannam@154: /************/ cannam@154: /* Create signal with prepended subframes, scaled by inverse gains */ cannam@154: x_ptr = x - psEnc->sCmn.predictLPCOrder; cannam@154: x_pre_ptr = LPC_in_pre; cannam@154: for( i = 0; i < psEnc->sCmn.nb_subfr; i++ ) { cannam@154: silk_scale_copy_vector16( x_pre_ptr, x_ptr, invGains_Q16[ i ], cannam@154: psEnc->sCmn.subfr_length + psEnc->sCmn.predictLPCOrder ); cannam@154: x_pre_ptr += psEnc->sCmn.subfr_length + psEnc->sCmn.predictLPCOrder; cannam@154: x_ptr += psEnc->sCmn.subfr_length; cannam@154: } cannam@154: cannam@154: silk_memset( psEncCtrl->LTPCoef_Q14, 0, psEnc->sCmn.nb_subfr * LTP_ORDER * sizeof( opus_int16 ) ); cannam@154: psEncCtrl->LTPredCodGain_Q7 = 0; cannam@154: psEnc->sCmn.sum_log_gain_Q7 = 0; cannam@154: } cannam@154: cannam@154: /* Limit on total predictive coding gain */ cannam@154: if( psEnc->sCmn.first_frame_after_reset ) { cannam@154: minInvGain_Q30 = SILK_FIX_CONST( 1.0f / MAX_PREDICTION_POWER_GAIN_AFTER_RESET, 30 ); cannam@154: } else { cannam@154: minInvGain_Q30 = silk_log2lin( silk_SMLAWB( 16 << 7, (opus_int32)psEncCtrl->LTPredCodGain_Q7, SILK_FIX_CONST( 1.0 / 3, 16 ) ) ); /* Q16 */ cannam@154: minInvGain_Q30 = silk_DIV32_varQ( minInvGain_Q30, cannam@154: silk_SMULWW( SILK_FIX_CONST( MAX_PREDICTION_POWER_GAIN, 0 ), cannam@154: silk_SMLAWB( SILK_FIX_CONST( 0.25, 18 ), SILK_FIX_CONST( 0.75, 18 ), psEncCtrl->coding_quality_Q14 ) ), 14 ); cannam@154: } cannam@154: cannam@154: /* LPC_in_pre contains the LTP-filtered input for voiced, and the unfiltered input for unvoiced */ cannam@154: silk_find_LPC_FIX( &psEnc->sCmn, NLSF_Q15, LPC_in_pre, minInvGain_Q30 ); cannam@154: cannam@154: /* Quantize LSFs */ cannam@154: silk_process_NLSFs( &psEnc->sCmn, psEncCtrl->PredCoef_Q12, NLSF_Q15, psEnc->sCmn.prev_NLSFq_Q15 ); cannam@154: cannam@154: /* Calculate residual energy using quantized LPC coefficients */ cannam@154: silk_residual_energy_FIX( psEncCtrl->ResNrg, psEncCtrl->ResNrgQ, LPC_in_pre, psEncCtrl->PredCoef_Q12, local_gains, cannam@154: psEnc->sCmn.subfr_length, psEnc->sCmn.nb_subfr, psEnc->sCmn.predictLPCOrder, psEnc->sCmn.arch ); cannam@154: cannam@154: /* Copy to prediction struct for use in next frame for interpolation */ cannam@154: silk_memcpy( psEnc->sCmn.prev_NLSFq_Q15, NLSF_Q15, sizeof( psEnc->sCmn.prev_NLSFq_Q15 ) ); cannam@154: RESTORE_STACK; cannam@154: }