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.h" cannam@154: #include "tuning_parameters.h" cannam@154: cannam@154: void silk_quant_LTP_gains( cannam@154: opus_int16 B_Q14[ MAX_NB_SUBFR * LTP_ORDER ], /* O Quantized LTP gains */ cannam@154: opus_int8 cbk_index[ MAX_NB_SUBFR ], /* O Codebook Index */ cannam@154: opus_int8 *periodicity_index, /* O Periodicity Index */ cannam@154: opus_int32 *sum_log_gain_Q7, /* I/O Cumulative max prediction gain */ cannam@154: opus_int *pred_gain_dB_Q7, /* O LTP prediction gain */ cannam@154: const opus_int32 XX_Q17[ MAX_NB_SUBFR*LTP_ORDER*LTP_ORDER ], /* I Correlation matrix in Q18 */ cannam@154: const opus_int32 xX_Q17[ MAX_NB_SUBFR*LTP_ORDER ], /* I Correlation vector in Q18 */ cannam@154: const opus_int subfr_len, /* I Number of samples per subframe */ cannam@154: const opus_int nb_subfr, /* I Number of subframes */ cannam@154: int arch /* I Run-time architecture */ cannam@154: ) cannam@154: { cannam@154: opus_int j, k, cbk_size; cannam@154: opus_int8 temp_idx[ MAX_NB_SUBFR ]; cannam@154: const opus_uint8 *cl_ptr_Q5; cannam@154: const opus_int8 *cbk_ptr_Q7; cannam@154: const opus_uint8 *cbk_gain_ptr_Q7; cannam@154: const opus_int32 *XX_Q17_ptr, *xX_Q17_ptr; cannam@154: opus_int32 res_nrg_Q15_subfr, res_nrg_Q15, rate_dist_Q7_subfr, rate_dist_Q7, min_rate_dist_Q7; cannam@154: opus_int32 sum_log_gain_tmp_Q7, best_sum_log_gain_Q7, max_gain_Q7; cannam@154: opus_int gain_Q7; cannam@154: cannam@154: /***************************************************/ cannam@154: /* iterate over different codebooks with different */ cannam@154: /* rates/distortions, and choose best */ cannam@154: /***************************************************/ cannam@154: min_rate_dist_Q7 = silk_int32_MAX; cannam@154: best_sum_log_gain_Q7 = 0; cannam@154: for( k = 0; k < 3; k++ ) { cannam@154: /* Safety margin for pitch gain control, to take into account factors cannam@154: such as state rescaling/rewhitening. */ cannam@154: opus_int32 gain_safety = SILK_FIX_CONST( 0.4, 7 ); cannam@154: cannam@154: cl_ptr_Q5 = silk_LTP_gain_BITS_Q5_ptrs[ k ]; cannam@154: cbk_ptr_Q7 = silk_LTP_vq_ptrs_Q7[ k ]; cannam@154: cbk_gain_ptr_Q7 = silk_LTP_vq_gain_ptrs_Q7[ k ]; cannam@154: cbk_size = silk_LTP_vq_sizes[ k ]; cannam@154: cannam@154: /* Set up pointers to first subframe */ cannam@154: XX_Q17_ptr = XX_Q17; cannam@154: xX_Q17_ptr = xX_Q17; cannam@154: cannam@154: res_nrg_Q15 = 0; cannam@154: rate_dist_Q7 = 0; cannam@154: sum_log_gain_tmp_Q7 = *sum_log_gain_Q7; cannam@154: for( j = 0; j < nb_subfr; j++ ) { cannam@154: max_gain_Q7 = silk_log2lin( ( SILK_FIX_CONST( MAX_SUM_LOG_GAIN_DB / 6.0, 7 ) - sum_log_gain_tmp_Q7 ) cannam@154: + SILK_FIX_CONST( 7, 7 ) ) - gain_safety; cannam@154: silk_VQ_WMat_EC( cannam@154: &temp_idx[ j ], /* O index of best codebook vector */ cannam@154: &res_nrg_Q15_subfr, /* O residual energy */ cannam@154: &rate_dist_Q7_subfr, /* O best weighted quantization error + mu * rate */ cannam@154: &gain_Q7, /* O sum of absolute LTP coefficients */ cannam@154: XX_Q17_ptr, /* I correlation matrix */ cannam@154: xX_Q17_ptr, /* I correlation vector */ cannam@154: cbk_ptr_Q7, /* I codebook */ cannam@154: cbk_gain_ptr_Q7, /* I codebook effective gains */ cannam@154: cl_ptr_Q5, /* I code length for each codebook vector */ cannam@154: subfr_len, /* I number of samples per subframe */ cannam@154: max_gain_Q7, /* I maximum sum of absolute LTP coefficients */ cannam@154: cbk_size, /* I number of vectors in codebook */ cannam@154: arch /* I Run-time architecture */ cannam@154: ); cannam@154: cannam@154: res_nrg_Q15 = silk_ADD_POS_SAT32( res_nrg_Q15, res_nrg_Q15_subfr ); cannam@154: rate_dist_Q7 = silk_ADD_POS_SAT32( rate_dist_Q7, rate_dist_Q7_subfr ); cannam@154: sum_log_gain_tmp_Q7 = silk_max(0, sum_log_gain_tmp_Q7 cannam@154: + silk_lin2log( gain_safety + gain_Q7 ) - SILK_FIX_CONST( 7, 7 )); cannam@154: cannam@154: XX_Q17_ptr += LTP_ORDER * LTP_ORDER; cannam@154: xX_Q17_ptr += LTP_ORDER; cannam@154: } cannam@154: cannam@154: if( rate_dist_Q7 <= min_rate_dist_Q7 ) { cannam@154: min_rate_dist_Q7 = rate_dist_Q7; cannam@154: *periodicity_index = (opus_int8)k; cannam@154: silk_memcpy( cbk_index, temp_idx, nb_subfr * sizeof( opus_int8 ) ); cannam@154: best_sum_log_gain_Q7 = sum_log_gain_tmp_Q7; cannam@154: } cannam@154: } cannam@154: cannam@154: cbk_ptr_Q7 = silk_LTP_vq_ptrs_Q7[ *periodicity_index ]; cannam@154: for( j = 0; j < nb_subfr; j++ ) { cannam@154: for( k = 0; k < LTP_ORDER; k++ ) { cannam@154: B_Q14[ j * LTP_ORDER + k ] = silk_LSHIFT( cbk_ptr_Q7[ cbk_index[ j ] * LTP_ORDER + k ], 7 ); cannam@154: } cannam@154: } cannam@154: cannam@154: if( nb_subfr == 2 ) { cannam@154: res_nrg_Q15 = silk_RSHIFT32( res_nrg_Q15, 1 ); cannam@154: } else { cannam@154: res_nrg_Q15 = silk_RSHIFT32( res_nrg_Q15, 2 ); cannam@154: } cannam@154: cannam@154: *sum_log_gain_Q7 = best_sum_log_gain_Q7; cannam@154: *pred_gain_dB_Q7 = (opus_int)silk_SMULBB( -3, silk_lin2log( res_nrg_Q15 ) - ( 15 << 7 ) ); cannam@154: }