1.1 --- /dev/null Thu Jan 01 00:00:00 1970 +0000
1.2 +++ b/media/libopus/silk/fixed/find_pred_coefs_FIX.c Wed Dec 31 06:09:35 2014 +0100
1.3 @@ -0,0 +1,147 @@
1.4 +/***********************************************************************
1.5 +Copyright (c) 2006-2011, Skype Limited. All rights reserved.
1.6 +Redistribution and use in source and binary forms, with or without
1.7 +modification, are permitted provided that the following conditions
1.8 +are met:
1.9 +- Redistributions of source code must retain the above copyright notice,
1.10 +this list of conditions and the following disclaimer.
1.11 +- Redistributions in binary form must reproduce the above copyright
1.12 +notice, this list of conditions and the following disclaimer in the
1.13 +documentation and/or other materials provided with the distribution.
1.14 +- Neither the name of Internet Society, IETF or IETF Trust, nor the
1.15 +names of specific contributors, may be used to endorse or promote
1.16 +products derived from this software without specific prior written
1.17 +permission.
1.18 +THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
1.19 +AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1.20 +IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1.21 +ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
1.22 +LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
1.23 +CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
1.24 +SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
1.25 +INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
1.26 +CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
1.27 +ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
1.28 +POSSIBILITY OF SUCH DAMAGE.
1.29 +***********************************************************************/
1.30 +
1.31 +#ifdef HAVE_CONFIG_H
1.32 +#include "config.h"
1.33 +#endif
1.34 +
1.35 +#include "main_FIX.h"
1.36 +#include "stack_alloc.h"
1.37 +
1.38 +void silk_find_pred_coefs_FIX(
1.39 + silk_encoder_state_FIX *psEnc, /* I/O encoder state */
1.40 + silk_encoder_control_FIX *psEncCtrl, /* I/O encoder control */
1.41 + const opus_int16 res_pitch[], /* I Residual from pitch analysis */
1.42 + const opus_int16 x[], /* I Speech signal */
1.43 + opus_int condCoding /* I The type of conditional coding to use */
1.44 +)
1.45 +{
1.46 + opus_int i;
1.47 + opus_int32 invGains_Q16[ MAX_NB_SUBFR ], local_gains[ MAX_NB_SUBFR ], Wght_Q15[ MAX_NB_SUBFR ];
1.48 + opus_int16 NLSF_Q15[ MAX_LPC_ORDER ];
1.49 + const opus_int16 *x_ptr;
1.50 + opus_int16 *x_pre_ptr;
1.51 + VARDECL( opus_int16, LPC_in_pre );
1.52 + opus_int32 tmp, min_gain_Q16, minInvGain_Q30;
1.53 + opus_int LTP_corrs_rshift[ MAX_NB_SUBFR ];
1.54 + SAVE_STACK;
1.55 +
1.56 + /* weighting for weighted least squares */
1.57 + min_gain_Q16 = silk_int32_MAX >> 6;
1.58 + for( i = 0; i < psEnc->sCmn.nb_subfr; i++ ) {
1.59 + min_gain_Q16 = silk_min( min_gain_Q16, psEncCtrl->Gains_Q16[ i ] );
1.60 + }
1.61 + for( i = 0; i < psEnc->sCmn.nb_subfr; i++ ) {
1.62 + /* Divide to Q16 */
1.63 + silk_assert( psEncCtrl->Gains_Q16[ i ] > 0 );
1.64 + /* Invert and normalize gains, and ensure that maximum invGains_Q16 is within range of a 16 bit int */
1.65 + invGains_Q16[ i ] = silk_DIV32_varQ( min_gain_Q16, psEncCtrl->Gains_Q16[ i ], 16 - 2 );
1.66 +
1.67 + /* Ensure Wght_Q15 a minimum value 1 */
1.68 + invGains_Q16[ i ] = silk_max( invGains_Q16[ i ], 363 );
1.69 +
1.70 + /* Square the inverted gains */
1.71 + silk_assert( invGains_Q16[ i ] == silk_SAT16( invGains_Q16[ i ] ) );
1.72 + tmp = silk_SMULWB( invGains_Q16[ i ], invGains_Q16[ i ] );
1.73 + Wght_Q15[ i ] = silk_RSHIFT( tmp, 1 );
1.74 +
1.75 + /* Invert the inverted and normalized gains */
1.76 + local_gains[ i ] = silk_DIV32( ( (opus_int32)1 << 16 ), invGains_Q16[ i ] );
1.77 + }
1.78 +
1.79 + ALLOC( LPC_in_pre,
1.80 + psEnc->sCmn.nb_subfr * psEnc->sCmn.predictLPCOrder
1.81 + + psEnc->sCmn.frame_length, opus_int16 );
1.82 + if( psEnc->sCmn.indices.signalType == TYPE_VOICED ) {
1.83 + VARDECL( opus_int32, WLTP );
1.84 +
1.85 + /**********/
1.86 + /* VOICED */
1.87 + /**********/
1.88 + silk_assert( psEnc->sCmn.ltp_mem_length - psEnc->sCmn.predictLPCOrder >= psEncCtrl->pitchL[ 0 ] + LTP_ORDER / 2 );
1.89 +
1.90 + ALLOC( WLTP, psEnc->sCmn.nb_subfr * LTP_ORDER * LTP_ORDER, opus_int32 );
1.91 +
1.92 + /* LTP analysis */
1.93 + silk_find_LTP_FIX( psEncCtrl->LTPCoef_Q14, WLTP, &psEncCtrl->LTPredCodGain_Q7,
1.94 + res_pitch, psEncCtrl->pitchL, Wght_Q15, psEnc->sCmn.subfr_length,
1.95 + psEnc->sCmn.nb_subfr, psEnc->sCmn.ltp_mem_length, LTP_corrs_rshift );
1.96 +
1.97 + /* Quantize LTP gain parameters */
1.98 + silk_quant_LTP_gains( psEncCtrl->LTPCoef_Q14, psEnc->sCmn.indices.LTPIndex, &psEnc->sCmn.indices.PERIndex,
1.99 + &psEnc->sCmn.sum_log_gain_Q7, WLTP, psEnc->sCmn.mu_LTP_Q9, psEnc->sCmn.LTPQuantLowComplexity, psEnc->sCmn.nb_subfr);
1.100 +
1.101 + /* Control LTP scaling */
1.102 + silk_LTP_scale_ctrl_FIX( psEnc, psEncCtrl, condCoding );
1.103 +
1.104 + /* Create LTP residual */
1.105 + silk_LTP_analysis_filter_FIX( LPC_in_pre, x - psEnc->sCmn.predictLPCOrder, psEncCtrl->LTPCoef_Q14,
1.106 + psEncCtrl->pitchL, invGains_Q16, psEnc->sCmn.subfr_length, psEnc->sCmn.nb_subfr, psEnc->sCmn.predictLPCOrder );
1.107 +
1.108 + } else {
1.109 + /************/
1.110 + /* UNVOICED */
1.111 + /************/
1.112 + /* Create signal with prepended subframes, scaled by inverse gains */
1.113 + x_ptr = x - psEnc->sCmn.predictLPCOrder;
1.114 + x_pre_ptr = LPC_in_pre;
1.115 + for( i = 0; i < psEnc->sCmn.nb_subfr; i++ ) {
1.116 + silk_scale_copy_vector16( x_pre_ptr, x_ptr, invGains_Q16[ i ],
1.117 + psEnc->sCmn.subfr_length + psEnc->sCmn.predictLPCOrder );
1.118 + x_pre_ptr += psEnc->sCmn.subfr_length + psEnc->sCmn.predictLPCOrder;
1.119 + x_ptr += psEnc->sCmn.subfr_length;
1.120 + }
1.121 +
1.122 + silk_memset( psEncCtrl->LTPCoef_Q14, 0, psEnc->sCmn.nb_subfr * LTP_ORDER * sizeof( opus_int16 ) );
1.123 + psEncCtrl->LTPredCodGain_Q7 = 0;
1.124 + psEnc->sCmn.sum_log_gain_Q7 = 0;
1.125 + }
1.126 +
1.127 + /* Limit on total predictive coding gain */
1.128 + if( psEnc->sCmn.first_frame_after_reset ) {
1.129 + minInvGain_Q30 = SILK_FIX_CONST( 1.0f / MAX_PREDICTION_POWER_GAIN_AFTER_RESET, 30 );
1.130 + } else {
1.131 + minInvGain_Q30 = silk_log2lin( silk_SMLAWB( 16 << 7, (opus_int32)psEncCtrl->LTPredCodGain_Q7, SILK_FIX_CONST( 1.0 / 3, 16 ) ) ); /* Q16 */
1.132 + minInvGain_Q30 = silk_DIV32_varQ( minInvGain_Q30,
1.133 + silk_SMULWW( SILK_FIX_CONST( MAX_PREDICTION_POWER_GAIN, 0 ),
1.134 + silk_SMLAWB( SILK_FIX_CONST( 0.25, 18 ), SILK_FIX_CONST( 0.75, 18 ), psEncCtrl->coding_quality_Q14 ) ), 14 );
1.135 + }
1.136 +
1.137 + /* LPC_in_pre contains the LTP-filtered input for voiced, and the unfiltered input for unvoiced */
1.138 + silk_find_LPC_FIX( &psEnc->sCmn, NLSF_Q15, LPC_in_pre, minInvGain_Q30 );
1.139 +
1.140 + /* Quantize LSFs */
1.141 + silk_process_NLSFs( &psEnc->sCmn, psEncCtrl->PredCoef_Q12, NLSF_Q15, psEnc->sCmn.prev_NLSFq_Q15 );
1.142 +
1.143 + /* Calculate residual energy using quantized LPC coefficients */
1.144 + silk_residual_energy_FIX( psEncCtrl->ResNrg, psEncCtrl->ResNrgQ, LPC_in_pre, psEncCtrl->PredCoef_Q12, local_gains,
1.145 + psEnc->sCmn.subfr_length, psEnc->sCmn.nb_subfr, psEnc->sCmn.predictLPCOrder );
1.146 +
1.147 + /* Copy to prediction struct for use in next frame for interpolation */
1.148 + silk_memcpy( psEnc->sCmn.prev_NLSFq_Q15, NLSF_Q15, sizeof( psEnc->sCmn.prev_NLSFq_Q15 ) );
1.149 + RESTORE_STACK;
1.150 +}
