Alexandre Lision | 744f742 | 2013-09-25 11:39:37 -0400 | [diff] [blame] | 1 | /*********************************************************************** |
| 2 | Copyright (c) 2006-2011, Skype Limited. All rights reserved. |
| 3 | Redistribution and use in source and binary forms, with or without |
| 4 | modification, are permitted provided that the following conditions |
| 5 | are met: |
| 6 | - Redistributions of source code must retain the above copyright notice, |
| 7 | this list of conditions and the following disclaimer. |
| 8 | - Redistributions in binary form must reproduce the above copyright |
| 9 | notice, this list of conditions and the following disclaimer in the |
| 10 | documentation and/or other materials provided with the distribution. |
| 11 | - Neither the name of Internet Society, IETF or IETF Trust, nor the |
| 12 | names of specific contributors, may be used to endorse or promote |
| 13 | products derived from this software without specific prior written |
| 14 | permission. |
| 15 | THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS “AS IS” |
| 16 | AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| 17 | IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| 18 | ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE |
| 19 | LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| 20 | CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| 21 | SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| 22 | INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| 23 | CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| 24 | ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| 25 | POSSIBILITY OF SUCH DAMAGE. |
| 26 | ***********************************************************************/ |
| 27 | |
| 28 | #ifdef HAVE_CONFIG_H |
| 29 | #include "config.h" |
| 30 | #endif |
| 31 | |
| 32 | #include "main_FIX.h" |
| 33 | |
| 34 | void silk_find_pred_coefs_FIX( |
| 35 | silk_encoder_state_FIX *psEnc, /* I/O encoder state */ |
| 36 | silk_encoder_control_FIX *psEncCtrl, /* I/O encoder control */ |
| 37 | const opus_int16 res_pitch[], /* I Residual from pitch analysis */ |
| 38 | const opus_int16 x[], /* I Speech signal */ |
| 39 | opus_int condCoding /* I The type of conditional coding to use */ |
| 40 | ) |
| 41 | { |
| 42 | opus_int i; |
| 43 | opus_int32 WLTP[ MAX_NB_SUBFR * LTP_ORDER * LTP_ORDER ]; |
| 44 | opus_int32 invGains_Q16[ MAX_NB_SUBFR ], local_gains[ MAX_NB_SUBFR ], Wght_Q15[ MAX_NB_SUBFR ]; |
| 45 | opus_int16 NLSF_Q15[ MAX_LPC_ORDER ]; |
| 46 | const opus_int16 *x_ptr; |
| 47 | opus_int16 *x_pre_ptr, LPC_in_pre[ MAX_NB_SUBFR * MAX_LPC_ORDER + MAX_FRAME_LENGTH ]; |
| 48 | opus_int32 tmp, min_gain_Q16, minInvGain_Q30; |
| 49 | opus_int LTP_corrs_rshift[ MAX_NB_SUBFR ]; |
| 50 | |
| 51 | /* weighting for weighted least squares */ |
| 52 | min_gain_Q16 = silk_int32_MAX >> 6; |
| 53 | for( i = 0; i < psEnc->sCmn.nb_subfr; i++ ) { |
| 54 | min_gain_Q16 = silk_min( min_gain_Q16, psEncCtrl->Gains_Q16[ i ] ); |
| 55 | } |
| 56 | for( i = 0; i < psEnc->sCmn.nb_subfr; i++ ) { |
| 57 | /* Divide to Q16 */ |
| 58 | silk_assert( psEncCtrl->Gains_Q16[ i ] > 0 ); |
| 59 | /* Invert and normalize gains, and ensure that maximum invGains_Q16 is within range of a 16 bit int */ |
| 60 | invGains_Q16[ i ] = silk_DIV32_varQ( min_gain_Q16, psEncCtrl->Gains_Q16[ i ], 16 - 2 ); |
| 61 | |
| 62 | /* Ensure Wght_Q15 a minimum value 1 */ |
| 63 | invGains_Q16[ i ] = silk_max( invGains_Q16[ i ], 363 ); |
| 64 | |
| 65 | /* Square the inverted gains */ |
| 66 | silk_assert( invGains_Q16[ i ] == silk_SAT16( invGains_Q16[ i ] ) ); |
| 67 | tmp = silk_SMULWB( invGains_Q16[ i ], invGains_Q16[ i ] ); |
| 68 | Wght_Q15[ i ] = silk_RSHIFT( tmp, 1 ); |
| 69 | |
| 70 | /* Invert the inverted and normalized gains */ |
| 71 | local_gains[ i ] = silk_DIV32( ( (opus_int32)1 << 16 ), invGains_Q16[ i ] ); |
| 72 | } |
| 73 | |
| 74 | if( psEnc->sCmn.indices.signalType == TYPE_VOICED ) { |
| 75 | /**********/ |
| 76 | /* VOICED */ |
| 77 | /**********/ |
| 78 | silk_assert( psEnc->sCmn.ltp_mem_length - psEnc->sCmn.predictLPCOrder >= psEncCtrl->pitchL[ 0 ] + LTP_ORDER / 2 ); |
| 79 | |
| 80 | /* LTP analysis */ |
| 81 | silk_find_LTP_FIX( psEncCtrl->LTPCoef_Q14, WLTP, &psEncCtrl->LTPredCodGain_Q7, |
| 82 | res_pitch, psEncCtrl->pitchL, Wght_Q15, psEnc->sCmn.subfr_length, |
| 83 | psEnc->sCmn.nb_subfr, psEnc->sCmn.ltp_mem_length, LTP_corrs_rshift ); |
| 84 | |
| 85 | /* Quantize LTP gain parameters */ |
| 86 | silk_quant_LTP_gains( psEncCtrl->LTPCoef_Q14, psEnc->sCmn.indices.LTPIndex, &psEnc->sCmn.indices.PERIndex, |
| 87 | WLTP, psEnc->sCmn.mu_LTP_Q9, psEnc->sCmn.LTPQuantLowComplexity, psEnc->sCmn.nb_subfr); |
| 88 | |
| 89 | /* Control LTP scaling */ |
| 90 | silk_LTP_scale_ctrl_FIX( psEnc, psEncCtrl, condCoding ); |
| 91 | |
| 92 | /* Create LTP residual */ |
| 93 | silk_LTP_analysis_filter_FIX( LPC_in_pre, x - psEnc->sCmn.predictLPCOrder, psEncCtrl->LTPCoef_Q14, |
| 94 | psEncCtrl->pitchL, invGains_Q16, psEnc->sCmn.subfr_length, psEnc->sCmn.nb_subfr, psEnc->sCmn.predictLPCOrder ); |
| 95 | |
| 96 | } else { |
| 97 | /************/ |
| 98 | /* UNVOICED */ |
| 99 | /************/ |
| 100 | /* Create signal with prepended subframes, scaled by inverse gains */ |
| 101 | x_ptr = x - psEnc->sCmn.predictLPCOrder; |
| 102 | x_pre_ptr = LPC_in_pre; |
| 103 | for( i = 0; i < psEnc->sCmn.nb_subfr; i++ ) { |
| 104 | silk_scale_copy_vector16( x_pre_ptr, x_ptr, invGains_Q16[ i ], |
| 105 | psEnc->sCmn.subfr_length + psEnc->sCmn.predictLPCOrder ); |
| 106 | x_pre_ptr += psEnc->sCmn.subfr_length + psEnc->sCmn.predictLPCOrder; |
| 107 | x_ptr += psEnc->sCmn.subfr_length; |
| 108 | } |
| 109 | |
| 110 | silk_memset( psEncCtrl->LTPCoef_Q14, 0, psEnc->sCmn.nb_subfr * LTP_ORDER * sizeof( opus_int16 ) ); |
| 111 | psEncCtrl->LTPredCodGain_Q7 = 0; |
| 112 | } |
| 113 | |
| 114 | /* Limit on total predictive coding gain */ |
| 115 | if( psEnc->sCmn.first_frame_after_reset ) { |
| 116 | minInvGain_Q30 = SILK_FIX_CONST( 1.0f / MAX_PREDICTION_POWER_GAIN_AFTER_RESET, 30 ); |
| 117 | } else { |
| 118 | minInvGain_Q30 = silk_log2lin( silk_SMLAWB( 16 << 7, (opus_int32)psEncCtrl->LTPredCodGain_Q7, SILK_FIX_CONST( 1.0 / 3, 16 ) ) ); /* Q16 */ |
| 119 | minInvGain_Q30 = silk_DIV32_varQ( minInvGain_Q30, |
| 120 | silk_SMULWW( SILK_FIX_CONST( MAX_PREDICTION_POWER_GAIN, 0 ), |
| 121 | silk_SMLAWB( SILK_FIX_CONST( 0.25, 18 ), SILK_FIX_CONST( 0.75, 18 ), psEncCtrl->coding_quality_Q14 ) ), 14 ); |
| 122 | } |
| 123 | |
| 124 | /* LPC_in_pre contains the LTP-filtered input for voiced, and the unfiltered input for unvoiced */ |
| 125 | silk_find_LPC_FIX( &psEnc->sCmn, NLSF_Q15, LPC_in_pre, minInvGain_Q30 ); |
| 126 | |
| 127 | /* Quantize LSFs */ |
| 128 | silk_process_NLSFs( &psEnc->sCmn, psEncCtrl->PredCoef_Q12, NLSF_Q15, psEnc->sCmn.prev_NLSFq_Q15 ); |
| 129 | |
| 130 | /* Calculate residual energy using quantized LPC coefficients */ |
| 131 | silk_residual_energy_FIX( psEncCtrl->ResNrg, psEncCtrl->ResNrgQ, LPC_in_pre, psEncCtrl->PredCoef_Q12, local_gains, |
| 132 | psEnc->sCmn.subfr_length, psEnc->sCmn.nb_subfr, psEnc->sCmn.predictLPCOrder ); |
| 133 | |
| 134 | /* Copy to prediction struct for use in next frame for interpolation */ |
| 135 | silk_memcpy( psEnc->sCmn.prev_NLSFq_Q15, NLSF_Q15, sizeof( psEnc->sCmn.prev_NLSFq_Q15 ) ); |
| 136 | } |