Chris@69: /***********************************************************************
Chris@69: Copyright (c) 2006-2011, Skype Limited. All rights reserved.
Chris@69: Redistribution and use in source and binary forms, with or without
Chris@69: modification, are permitted provided that the following conditions
Chris@69: are met:
Chris@69: - Redistributions of source code must retain the above copyright notice,
Chris@69: this list of conditions and the following disclaimer.
Chris@69: - Redistributions in binary form must reproduce the above copyright
Chris@69: notice, this list of conditions and the following disclaimer in the
Chris@69: documentation and/or other materials provided with the distribution.
Chris@69: - Neither the name of Internet Society, IETF or IETF Trust, nor the
Chris@69: names of specific contributors, may be used to endorse or promote
Chris@69: products derived from this software without specific prior written
Chris@69: permission.
Chris@69: THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
Chris@69: AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
Chris@69: IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
Chris@69: ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
Chris@69: LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
Chris@69: CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
Chris@69: SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
Chris@69: INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
Chris@69: CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
Chris@69: ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
Chris@69: POSSIBILITY OF SUCH DAMAGE.
Chris@69: ***********************************************************************/
Chris@69: 
Chris@69: #ifdef HAVE_CONFIG_H
Chris@69: #include "config.h"
Chris@69: #endif
Chris@69: #ifdef FIXED_POINT
Chris@69: #include "main_FIX.h"
Chris@69: #else
Chris@69: #include "main_FLP.h"
Chris@69: #endif
Chris@69: #include "tuning_parameters.h"
Chris@69: 
Chris@69: /* High-pass filter with cutoff frequency adaptation based on pitch lag statistics */
Chris@69: void silk_HP_variable_cutoff(
Chris@69:     silk_encoder_state_Fxx          state_Fxx[]                         /* I/O  Encoder states                              */
Chris@69: )
Chris@69: {
Chris@69:    opus_int   quality_Q15;
Chris@69:    opus_int32 pitch_freq_Hz_Q16, pitch_freq_log_Q7, delta_freq_Q7;
Chris@69:    silk_encoder_state *psEncC1 = &state_Fxx[ 0 ].sCmn;
Chris@69: 
Chris@69:    /* Adaptive cutoff frequency: estimate low end of pitch frequency range */
Chris@69:    if( psEncC1->prevSignalType == TYPE_VOICED ) {
Chris@69:       /* difference, in log domain */
Chris@69:       pitch_freq_Hz_Q16 = silk_DIV32_16( silk_LSHIFT( silk_MUL( psEncC1->fs_kHz, 1000 ), 16 ), psEncC1->prevLag );
Chris@69:       pitch_freq_log_Q7 = silk_lin2log( pitch_freq_Hz_Q16 ) - ( 16 << 7 );
Chris@69: 
Chris@69:       /* adjustment based on quality */
Chris@69:       quality_Q15 = psEncC1->input_quality_bands_Q15[ 0 ];
Chris@69:       pitch_freq_log_Q7 = silk_SMLAWB( pitch_freq_log_Q7, silk_SMULWB( silk_LSHIFT( -quality_Q15, 2 ), quality_Q15 ),
Chris@69:             pitch_freq_log_Q7 - ( silk_lin2log( SILK_FIX_CONST( VARIABLE_HP_MIN_CUTOFF_HZ, 16 ) ) - ( 16 << 7 ) ) );
Chris@69: 
Chris@69:       /* delta_freq = pitch_freq_log - psEnc->variable_HP_smth1; */
Chris@69:       delta_freq_Q7 = pitch_freq_log_Q7 - silk_RSHIFT( psEncC1->variable_HP_smth1_Q15, 8 );
Chris@69:       if( delta_freq_Q7 < 0 ) {
Chris@69:          /* less smoothing for decreasing pitch frequency, to track something close to the minimum */
Chris@69:          delta_freq_Q7 = silk_MUL( delta_freq_Q7, 3 );
Chris@69:       }
Chris@69: 
Chris@69:       /* limit delta, to reduce impact of outliers in pitch estimation */
Chris@69:       delta_freq_Q7 = silk_LIMIT_32( delta_freq_Q7, -SILK_FIX_CONST( VARIABLE_HP_MAX_DELTA_FREQ, 7 ), SILK_FIX_CONST( VARIABLE_HP_MAX_DELTA_FREQ, 7 ) );
Chris@69: 
Chris@69:       /* update smoother */
Chris@69:       psEncC1->variable_HP_smth1_Q15 = silk_SMLAWB( psEncC1->variable_HP_smth1_Q15,
Chris@69:             silk_SMULBB( psEncC1->speech_activity_Q8, delta_freq_Q7 ), SILK_FIX_CONST( VARIABLE_HP_SMTH_COEF1, 16 ) );
Chris@69: 
Chris@69:       /* limit frequency range */
Chris@69:       psEncC1->variable_HP_smth1_Q15 = silk_LIMIT_32( psEncC1->variable_HP_smth1_Q15,
Chris@69:             silk_LSHIFT( silk_lin2log( VARIABLE_HP_MIN_CUTOFF_HZ ), 8 ),
Chris@69:             silk_LSHIFT( silk_lin2log( VARIABLE_HP_MAX_CUTOFF_HZ ), 8 ) );
Chris@69:    }
Chris@69: }