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