Index: silk/fixed/mips/prefilter_FIX_mipsr1.h |
diff --git a/silk/fixed/prefilter_FIX.c b/silk/fixed/mips/prefilter_FIX_mipsr1.h |
similarity index 50% |
copy from silk/fixed/prefilter_FIX.c |
copy to silk/fixed/mips/prefilter_FIX_mipsr1.h |
index d381730c28fb96dace35897b6c570082f5dab6c7..faf9b48df0c8bfd9e7b67bbff78ceb52ef6f3eb7 100644 |
--- a/silk/fixed/prefilter_FIX.c |
+++ b/silk/fixed/mips/prefilter_FIX_mipsr1.h |
@@ -24,6 +24,8 @@ CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
POSSIBILITY OF SUCH DAMAGE. |
***********************************************************************/ |
+#ifndef __PREFILTER_FIX_MIPSR1_H__ |
+#define __PREFILTER_FIX_MIPSR1_H__ |
#ifdef HAVE_CONFIG_H |
#include "config.h" |
@@ -33,18 +35,7 @@ POSSIBILITY OF SUCH DAMAGE. |
#include "stack_alloc.h" |
#include "tuning_parameters.h" |
-/* Prefilter for finding Quantizer input signal */ |
-static OPUS_INLINE void silk_prefilt_FIX( |
- silk_prefilter_state_FIX *P, /* I/O state */ |
- opus_int32 st_res_Q12[], /* I short term residual signal */ |
- opus_int32 xw_Q3[], /* O prefiltered signal */ |
- opus_int32 HarmShapeFIRPacked_Q12, /* I Harmonic shaping coeficients */ |
- opus_int Tilt_Q14, /* I Tilt shaping coeficient */ |
- opus_int32 LF_shp_Q14, /* I Low-frequancy shaping coeficients */ |
- opus_int lag, /* I Lag for harmonic shaping */ |
- opus_int length /* I Length of signals */ |
-); |
- |
+#define OVERRIDE_silk_warped_LPC_analysis_filter_FIX |
void silk_warped_LPC_analysis_filter_FIX( |
opus_int32 state[], /* I/O State [order + 1] */ |
opus_int32 res_Q2[], /* O Residual signal [length] */ |
@@ -56,107 +47,70 @@ void silk_warped_LPC_analysis_filter_FIX( |
) |
{ |
opus_int n, i; |
- opus_int32 acc_Q11, tmp1, tmp2; |
+ opus_int32 acc_Q11, acc_Q22, tmp1, tmp2, tmp3, tmp4; |
+ opus_int32 state_cur, state_next; |
/* Order must be even */ |
+ /*Length must be even */ |
+ |
silk_assert( ( order & 1 ) == 0 ); |
+ silk_assert( ( length & 1 ) == 0 ); |
- for( n = 0; n < length; n++ ) { |
+ for( n = 0; n < length; n+=2 ) { |
/* Output of lowpass section */ |
tmp2 = silk_SMLAWB( state[ 0 ], state[ 1 ], lambda_Q16 ); |
- state[ 0 ] = silk_LSHIFT( input[ n ], 14 ); |
+ state_cur = silk_LSHIFT( input[ n ], 14 ); |
/* Output of allpass section */ |
tmp1 = silk_SMLAWB( state[ 1 ], state[ 2 ] - tmp2, lambda_Q16 ); |
- state[ 1 ] = tmp2; |
+ state_next = tmp2; |
acc_Q11 = silk_RSHIFT( order, 1 ); |
acc_Q11 = silk_SMLAWB( acc_Q11, tmp2, coef_Q13[ 0 ] ); |
+ |
+ |
+ /* Output of lowpass section */ |
+ tmp4 = silk_SMLAWB( state_cur, state_next, lambda_Q16 ); |
+ state[ 0 ] = silk_LSHIFT( input[ n+1 ], 14 ); |
+ /* Output of allpass section */ |
+ tmp3 = silk_SMLAWB( state_next, tmp1 - tmp4, lambda_Q16 ); |
+ state[ 1 ] = tmp4; |
+ acc_Q22 = silk_RSHIFT( order, 1 ); |
+ acc_Q22 = silk_SMLAWB( acc_Q22, tmp4, coef_Q13[ 0 ] ); |
+ |
/* Loop over allpass sections */ |
for( i = 2; i < order; i += 2 ) { |
/* Output of allpass section */ |
tmp2 = silk_SMLAWB( state[ i ], state[ i + 1 ] - tmp1, lambda_Q16 ); |
- state[ i ] = tmp1; |
+ state_cur = tmp1; |
acc_Q11 = silk_SMLAWB( acc_Q11, tmp1, coef_Q13[ i - 1 ] ); |
/* Output of allpass section */ |
tmp1 = silk_SMLAWB( state[ i + 1 ], state[ i + 2 ] - tmp2, lambda_Q16 ); |
- state[ i + 1 ] = tmp2; |
+ state_next = tmp2; |
acc_Q11 = silk_SMLAWB( acc_Q11, tmp2, coef_Q13[ i ] ); |
+ |
+ |
+ /* Output of allpass section */ |
+ tmp4 = silk_SMLAWB( state_cur, state_next - tmp3, lambda_Q16 ); |
+ state[ i ] = tmp3; |
+ acc_Q22 = silk_SMLAWB( acc_Q22, tmp3, coef_Q13[ i - 1 ] ); |
+ /* Output of allpass section */ |
+ tmp3 = silk_SMLAWB( state_next, tmp1 - tmp4, lambda_Q16 ); |
+ state[ i + 1 ] = tmp4; |
+ acc_Q22 = silk_SMLAWB( acc_Q22, tmp4, coef_Q13[ i ] ); |
} |
- state[ order ] = tmp1; |
acc_Q11 = silk_SMLAWB( acc_Q11, tmp1, coef_Q13[ order - 1 ] ); |
res_Q2[ n ] = silk_LSHIFT( (opus_int32)input[ n ], 2 ) - silk_RSHIFT_ROUND( acc_Q11, 9 ); |
+ |
+ state[ order ] = tmp3; |
+ acc_Q22 = silk_SMLAWB( acc_Q22, tmp3, coef_Q13[ order - 1 ] ); |
+ res_Q2[ n+1 ] = silk_LSHIFT( (opus_int32)input[ n+1 ], 2 ) - silk_RSHIFT_ROUND( acc_Q22, 9 ); |
} |
} |
-void silk_prefilter_FIX( |
- silk_encoder_state_FIX *psEnc, /* I/O Encoder state */ |
- const silk_encoder_control_FIX *psEncCtrl, /* I Encoder control */ |
- opus_int32 xw_Q3[], /* O Weighted signal */ |
- const opus_int16 x[] /* I Speech signal */ |
-) |
-{ |
- silk_prefilter_state_FIX *P = &psEnc->sPrefilt; |
- opus_int j, k, lag; |
- opus_int32 tmp_32; |
- const opus_int16 *AR1_shp_Q13; |
- const opus_int16 *px; |
- opus_int32 *pxw_Q3; |
- opus_int HarmShapeGain_Q12, Tilt_Q14; |
- opus_int32 HarmShapeFIRPacked_Q12, LF_shp_Q14; |
- VARDECL( opus_int32, x_filt_Q12 ); |
- VARDECL( opus_int32, st_res_Q2 ); |
- opus_int16 B_Q10[ 2 ]; |
- SAVE_STACK; |
- |
- /* Set up pointers */ |
- px = x; |
- pxw_Q3 = xw_Q3; |
- lag = P->lagPrev; |
- ALLOC( x_filt_Q12, psEnc->sCmn.subfr_length, opus_int32 ); |
- ALLOC( st_res_Q2, psEnc->sCmn.subfr_length, opus_int32 ); |
- for( k = 0; k < psEnc->sCmn.nb_subfr; k++ ) { |
- /* Update Variables that change per sub frame */ |
- if( psEnc->sCmn.indices.signalType == TYPE_VOICED ) { |
- lag = psEncCtrl->pitchL[ k ]; |
- } |
- |
- /* Noise shape parameters */ |
- HarmShapeGain_Q12 = silk_SMULWB( (opus_int32)psEncCtrl->HarmShapeGain_Q14[ k ], 16384 - psEncCtrl->HarmBoost_Q14[ k ] ); |
- silk_assert( HarmShapeGain_Q12 >= 0 ); |
- HarmShapeFIRPacked_Q12 = silk_RSHIFT( HarmShapeGain_Q12, 2 ); |
- HarmShapeFIRPacked_Q12 |= silk_LSHIFT( (opus_int32)silk_RSHIFT( HarmShapeGain_Q12, 1 ), 16 ); |
- Tilt_Q14 = psEncCtrl->Tilt_Q14[ k ]; |
- LF_shp_Q14 = psEncCtrl->LF_shp_Q14[ k ]; |
- AR1_shp_Q13 = &psEncCtrl->AR1_Q13[ k * MAX_SHAPE_LPC_ORDER ]; |
- |
- /* Short term FIR filtering*/ |
- silk_warped_LPC_analysis_filter_FIX( P->sAR_shp, st_res_Q2, AR1_shp_Q13, px, |
- psEnc->sCmn.warping_Q16, psEnc->sCmn.subfr_length, psEnc->sCmn.shapingLPCOrder ); |
- |
- /* Reduce (mainly) low frequencies during harmonic emphasis */ |
- B_Q10[ 0 ] = silk_RSHIFT_ROUND( psEncCtrl->GainsPre_Q14[ k ], 4 ); |
- tmp_32 = silk_SMLABB( SILK_FIX_CONST( INPUT_TILT, 26 ), psEncCtrl->HarmBoost_Q14[ k ], HarmShapeGain_Q12 ); /* Q26 */ |
- tmp_32 = silk_SMLABB( tmp_32, psEncCtrl->coding_quality_Q14, SILK_FIX_CONST( HIGH_RATE_INPUT_TILT, 12 ) ); /* Q26 */ |
- tmp_32 = silk_SMULWB( tmp_32, -psEncCtrl->GainsPre_Q14[ k ] ); /* Q24 */ |
- tmp_32 = silk_RSHIFT_ROUND( tmp_32, 14 ); /* Q10 */ |
- B_Q10[ 1 ]= silk_SAT16( tmp_32 ); |
- x_filt_Q12[ 0 ] = silk_MLA( silk_MUL( st_res_Q2[ 0 ], B_Q10[ 0 ] ), P->sHarmHP_Q2, B_Q10[ 1 ] ); |
- for( j = 1; j < psEnc->sCmn.subfr_length; j++ ) { |
- x_filt_Q12[ j ] = silk_MLA( silk_MUL( st_res_Q2[ j ], B_Q10[ 0 ] ), st_res_Q2[ j - 1 ], B_Q10[ 1 ] ); |
- } |
- P->sHarmHP_Q2 = st_res_Q2[ psEnc->sCmn.subfr_length - 1 ]; |
- |
- silk_prefilt_FIX( P, x_filt_Q12, pxw_Q3, HarmShapeFIRPacked_Q12, Tilt_Q14, LF_shp_Q14, lag, psEnc->sCmn.subfr_length ); |
- px += psEnc->sCmn.subfr_length; |
- pxw_Q3 += psEnc->sCmn.subfr_length; |
- } |
- |
- P->lagPrev = psEncCtrl->pitchL[ psEnc->sCmn.nb_subfr - 1 ]; |
- RESTORE_STACK; |
-} |
/* Prefilter for finding Quantizer input signal */ |
-static OPUS_INLINE void silk_prefilt_FIX( |
+#define OVERRIDE_silk_prefilt_FIX |
+static inline void silk_prefilt_FIX( |
silk_prefilter_state_FIX *P, /* I/O state */ |
opus_int32 st_res_Q12[], /* I short term residual signal */ |
opus_int32 xw_Q3[], /* O prefiltered signal */ |
@@ -178,28 +132,44 @@ static OPUS_INLINE void silk_prefilt_FIX( |
sLF_AR_shp_Q12 = P->sLF_AR_shp_Q12; |
sLF_MA_shp_Q12 = P->sLF_MA_shp_Q12; |
- for( i = 0; i < length; i++ ) { |
- if( lag > 0 ) { |
+ if( lag > 0 ) { |
+ for( i = 0; i < length; i++ ) { |
/* unrolled loop */ |
silk_assert( HARM_SHAPE_FIR_TAPS == 3 ); |
idx = lag + LTP_shp_buf_idx; |
n_LTP_Q12 = silk_SMULBB( LTP_shp_buf[ ( idx - HARM_SHAPE_FIR_TAPS / 2 - 1) & LTP_MASK ], HarmShapeFIRPacked_Q12 ); |
n_LTP_Q12 = silk_SMLABT( n_LTP_Q12, LTP_shp_buf[ ( idx - HARM_SHAPE_FIR_TAPS / 2 ) & LTP_MASK ], HarmShapeFIRPacked_Q12 ); |
n_LTP_Q12 = silk_SMLABB( n_LTP_Q12, LTP_shp_buf[ ( idx - HARM_SHAPE_FIR_TAPS / 2 + 1) & LTP_MASK ], HarmShapeFIRPacked_Q12 ); |
- } else { |
- n_LTP_Q12 = 0; |
+ |
+ n_Tilt_Q10 = silk_SMULWB( sLF_AR_shp_Q12, Tilt_Q14 ); |
+ n_LF_Q10 = silk_SMLAWB( silk_SMULWT( sLF_AR_shp_Q12, LF_shp_Q14 ), sLF_MA_shp_Q12, LF_shp_Q14 ); |
+ |
+ sLF_AR_shp_Q12 = silk_SUB32( st_res_Q12[ i ], silk_LSHIFT( n_Tilt_Q10, 2 ) ); |
+ sLF_MA_shp_Q12 = silk_SUB32( sLF_AR_shp_Q12, silk_LSHIFT( n_LF_Q10, 2 ) ); |
+ |
+ LTP_shp_buf_idx = ( LTP_shp_buf_idx - 1 ) & LTP_MASK; |
+ LTP_shp_buf[ LTP_shp_buf_idx ] = (opus_int16)silk_SAT16( silk_RSHIFT_ROUND( sLF_MA_shp_Q12, 12 ) ); |
+ |
+ xw_Q3[i] = silk_RSHIFT_ROUND( silk_SUB32( sLF_MA_shp_Q12, n_LTP_Q12 ), 9 ); |
} |
+ } |
+ else |
+ { |
+ for( i = 0; i < length; i++ ) { |
+ |
+ n_LTP_Q12 = 0; |
- n_Tilt_Q10 = silk_SMULWB( sLF_AR_shp_Q12, Tilt_Q14 ); |
- n_LF_Q10 = silk_SMLAWB( silk_SMULWT( sLF_AR_shp_Q12, LF_shp_Q14 ), sLF_MA_shp_Q12, LF_shp_Q14 ); |
+ n_Tilt_Q10 = silk_SMULWB( sLF_AR_shp_Q12, Tilt_Q14 ); |
+ n_LF_Q10 = silk_SMLAWB( silk_SMULWT( sLF_AR_shp_Q12, LF_shp_Q14 ), sLF_MA_shp_Q12, LF_shp_Q14 ); |
- sLF_AR_shp_Q12 = silk_SUB32( st_res_Q12[ i ], silk_LSHIFT( n_Tilt_Q10, 2 ) ); |
- sLF_MA_shp_Q12 = silk_SUB32( sLF_AR_shp_Q12, silk_LSHIFT( n_LF_Q10, 2 ) ); |
+ sLF_AR_shp_Q12 = silk_SUB32( st_res_Q12[ i ], silk_LSHIFT( n_Tilt_Q10, 2 ) ); |
+ sLF_MA_shp_Q12 = silk_SUB32( sLF_AR_shp_Q12, silk_LSHIFT( n_LF_Q10, 2 ) ); |
- LTP_shp_buf_idx = ( LTP_shp_buf_idx - 1 ) & LTP_MASK; |
- LTP_shp_buf[ LTP_shp_buf_idx ] = (opus_int16)silk_SAT16( silk_RSHIFT_ROUND( sLF_MA_shp_Q12, 12 ) ); |
+ LTP_shp_buf_idx = ( LTP_shp_buf_idx - 1 ) & LTP_MASK; |
+ LTP_shp_buf[ LTP_shp_buf_idx ] = (opus_int16)silk_SAT16( silk_RSHIFT_ROUND( sLF_MA_shp_Q12, 12 ) ); |
- xw_Q3[i] = silk_RSHIFT_ROUND( silk_SUB32( sLF_MA_shp_Q12, n_LTP_Q12 ), 9 ); |
+ xw_Q3[i] = silk_RSHIFT_ROUND( sLF_MA_shp_Q12, 9 ); |
+ } |
} |
/* Copy temp variable back to state */ |
@@ -207,3 +177,5 @@ static OPUS_INLINE void silk_prefilt_FIX( |
P->sLF_MA_shp_Q12 = sLF_MA_shp_Q12; |
P->sLTP_shp_buf_idx = LTP_shp_buf_idx; |
} |
+ |
+#endif /* __PREFILTER_FIX_MIPSR1_H__ */ |