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: #ifdef FIXED_POINT
cannam@154: #include "main_FIX.h"
cannam@154: #else
cannam@154: #include "main_FLP.h"
cannam@154: #endif
cannam@154: #include "tuning_parameters.h"
cannam@154: 
cannam@154: /* High-pass filter with cutoff frequency adaptation based on pitch lag statistics */
cannam@154: void silk_HP_variable_cutoff(
cannam@154:     silk_encoder_state_Fxx          state_Fxx[]                         /* I/O  Encoder states                              */
cannam@154: )
cannam@154: {
cannam@154:    opus_int   quality_Q15;
cannam@154:    opus_int32 pitch_freq_Hz_Q16, pitch_freq_log_Q7, delta_freq_Q7;
cannam@154:    silk_encoder_state *psEncC1 = &state_Fxx[ 0 ].sCmn;
cannam@154: 
cannam@154:    /* Adaptive cutoff frequency: estimate low end of pitch frequency range */
cannam@154:    if( psEncC1->prevSignalType == TYPE_VOICED ) {
cannam@154:       /* difference, in log domain */
cannam@154:       pitch_freq_Hz_Q16 = silk_DIV32_16( silk_LSHIFT( silk_MUL( psEncC1->fs_kHz, 1000 ), 16 ), psEncC1->prevLag );
cannam@154:       pitch_freq_log_Q7 = silk_lin2log( pitch_freq_Hz_Q16 ) - ( 16 << 7 );
cannam@154: 
cannam@154:       /* adjustment based on quality */
cannam@154:       quality_Q15 = psEncC1->input_quality_bands_Q15[ 0 ];
cannam@154:       pitch_freq_log_Q7 = silk_SMLAWB( pitch_freq_log_Q7, silk_SMULWB( silk_LSHIFT( -quality_Q15, 2 ), quality_Q15 ),
cannam@154:             pitch_freq_log_Q7 - ( silk_lin2log( SILK_FIX_CONST( VARIABLE_HP_MIN_CUTOFF_HZ, 16 ) ) - ( 16 << 7 ) ) );
cannam@154: 
cannam@154:       /* delta_freq = pitch_freq_log - psEnc->variable_HP_smth1; */
cannam@154:       delta_freq_Q7 = pitch_freq_log_Q7 - silk_RSHIFT( psEncC1->variable_HP_smth1_Q15, 8 );
cannam@154:       if( delta_freq_Q7 < 0 ) {
cannam@154:          /* less smoothing for decreasing pitch frequency, to track something close to the minimum */
cannam@154:          delta_freq_Q7 = silk_MUL( delta_freq_Q7, 3 );
cannam@154:       }
cannam@154: 
cannam@154:       /* limit delta, to reduce impact of outliers in pitch estimation */
cannam@154:       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 ) );
cannam@154: 
cannam@154:       /* update smoother */
cannam@154:       psEncC1->variable_HP_smth1_Q15 = silk_SMLAWB( psEncC1->variable_HP_smth1_Q15,
cannam@154:             silk_SMULBB( psEncC1->speech_activity_Q8, delta_freq_Q7 ), SILK_FIX_CONST( VARIABLE_HP_SMTH_COEF1, 16 ) );
cannam@154: 
cannam@154:       /* limit frequency range */
cannam@154:       psEncC1->variable_HP_smth1_Q15 = silk_LIMIT_32( psEncC1->variable_HP_smth1_Q15,
cannam@154:             silk_LSHIFT( silk_lin2log( VARIABLE_HP_MIN_CUTOFF_HZ ), 8 ),
cannam@154:             silk_LSHIFT( silk_lin2log( VARIABLE_HP_MAX_CUTOFF_HZ ), 8 ) );
cannam@154:    }
cannam@154: }