|
|
@ -26,14 +26,17 @@ namespace BAGuitar { |
|
|
|
////////////////////////////////////////////////////
|
|
|
|
////////////////////////////////////////////////////
|
|
|
|
// IirBiQuadFilter
|
|
|
|
// IirBiQuadFilter
|
|
|
|
////////////////////////////////////////////////////
|
|
|
|
////////////////////////////////////////////////////
|
|
|
|
IirBiQuadFilter::IirBiQuadFilter(unsigned numStages, const int32_t *coeffs, int coeffShift) |
|
|
|
constexpr int NUM_COEFFS_PER_STAGE = 5; |
|
|
|
: NUM_STAGES(numStages) |
|
|
|
constexpr int NUM_STATES_PER_STAGE = 4; |
|
|
|
|
|
|
|
IirBiQuadFilter::IirBiQuadFilter(unsigned maxNumStages, const int32_t *coeffs, int coeffShift) |
|
|
|
|
|
|
|
: NUM_STAGES(maxNumStages) |
|
|
|
{ |
|
|
|
{ |
|
|
|
m_coeffs = new int32_t[5*numStages]; |
|
|
|
m_coeffs = new int32_t[NUM_COEFFS_PER_STAGE*maxNumStages]; |
|
|
|
memcpy(m_coeffs, coeffs, 5*numStages * sizeof(int32_t)); |
|
|
|
//memcpy(m_coeffs, coeffs, 5*numStages * sizeof(int32_t));
|
|
|
|
|
|
|
|
|
|
|
|
m_state = new int32_t[4*numStages]; |
|
|
|
m_state = new int32_t[NUM_STATES_PER_STAGE*maxNumStages]; |
|
|
|
arm_biquad_cascade_df1_init_q31(&m_iirCfg, numStages, m_coeffs, m_state, coeffShift); |
|
|
|
//arm_biquad_cascade_df1_init_q31(&m_iirCfg, numStages, m_coeffs, m_state, coeffShift);
|
|
|
|
|
|
|
|
changeFilterCoeffs(maxNumStages, coeffs, coeffShift); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
IirBiQuadFilter::~IirBiQuadFilter() |
|
|
|
IirBiQuadFilter::~IirBiQuadFilter() |
|
|
@ -42,6 +45,15 @@ IirBiQuadFilter::~IirBiQuadFilter() |
|
|
|
if (m_state) delete [] m_state; |
|
|
|
if (m_state) delete [] m_state; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void IirBiQuadFilter::changeFilterCoeffs(unsigned numStages, const int32_t *coeffs, int coeffShift) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
// clear the state
|
|
|
|
|
|
|
|
memset(m_state, 0, sizeof(int32_t) * NUM_COEFFS_PER_STAGE * numStages); |
|
|
|
|
|
|
|
// copy the coeffs
|
|
|
|
|
|
|
|
memcpy(m_coeffs, coeffs, NUM_COEFFS_PER_STAGE*numStages * sizeof(int32_t)); |
|
|
|
|
|
|
|
arm_biquad_cascade_df1_init_q31(&m_iirCfg, numStages, m_coeffs, m_state, coeffShift); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
bool IirBiQuadFilter::process(int16_t *output, int16_t *input, size_t numSamples) |
|
|
|
bool IirBiQuadFilter::process(int16_t *output, int16_t *input, size_t numSamples) |
|
|
|
{ |
|
|
|
{ |
|
|
@ -67,15 +79,18 @@ bool IirBiQuadFilter::process(int16_t *output, int16_t *input, size_t numSamples |
|
|
|
return true; |
|
|
|
return true; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
///////////////////////////////////
|
|
|
|
// HIGH QUALITY
|
|
|
|
// HIGH QUALITY
|
|
|
|
IirBiQuadFilterHQ::IirBiQuadFilterHQ(unsigned numStages, const int32_t *coeffs, int coeffShift) |
|
|
|
///////////////////////////////////
|
|
|
|
: NUM_STAGES(numStages) |
|
|
|
IirBiQuadFilterHQ::IirBiQuadFilterHQ(unsigned maxNumStages, const int32_t *coeffs, int coeffShift) |
|
|
|
|
|
|
|
: NUM_STAGES(maxNumStages) |
|
|
|
{ |
|
|
|
{ |
|
|
|
m_coeffs = new int32_t[5*numStages]; |
|
|
|
m_coeffs = new int32_t[NUM_COEFFS_PER_STAGE*maxNumStages]; |
|
|
|
memcpy(m_coeffs, coeffs, 5*numStages * sizeof(int32_t)); |
|
|
|
//memcpy(m_coeffs, coeffs, 5*numStages * sizeof(int32_t));
|
|
|
|
|
|
|
|
|
|
|
|
m_state = new int64_t[4*numStages];; |
|
|
|
m_state = new int64_t[NUM_STATES_PER_STAGE*maxNumStages];; |
|
|
|
arm_biquad_cas_df1_32x64_init_q31(&m_iirCfg, numStages, m_coeffs, m_state, coeffShift); |
|
|
|
//arm_biquad_cas_df1_32x64_init_q31(&m_iirCfg, numStages, m_coeffs, m_state, coeffShift);
|
|
|
|
|
|
|
|
changeFilterCoeffs(maxNumStages, coeffs, coeffShift); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
IirBiQuadFilterHQ::~IirBiQuadFilterHQ() |
|
|
|
IirBiQuadFilterHQ::~IirBiQuadFilterHQ() |
|
|
@ -84,6 +99,15 @@ IirBiQuadFilterHQ::~IirBiQuadFilterHQ() |
|
|
|
if (m_state) delete [] m_state; |
|
|
|
if (m_state) delete [] m_state; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void IirBiQuadFilterHQ::changeFilterCoeffs(unsigned numStages, const int32_t *coeffs, int coeffShift) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
// clear the state
|
|
|
|
|
|
|
|
memset(m_state, 0, sizeof(int32_t) * NUM_COEFFS_PER_STAGE * numStages); |
|
|
|
|
|
|
|
// copy the coeffs
|
|
|
|
|
|
|
|
memcpy(m_coeffs, coeffs, NUM_COEFFS_PER_STAGE*numStages * sizeof(int32_t)); |
|
|
|
|
|
|
|
arm_biquad_cas_df1_32x64_init_q31(&m_iirCfg, numStages, m_coeffs, m_state, coeffShift); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
bool IirBiQuadFilterHQ::process(int16_t *output, int16_t *input, size_t numSamples) |
|
|
|
bool IirBiQuadFilterHQ::process(int16_t *output, int16_t *input, size_t numSamples) |
|
|
|
{ |
|
|
|
{ |
|
|
@ -109,15 +133,18 @@ bool IirBiQuadFilterHQ::process(int16_t *output, int16_t *input, size_t numSampl |
|
|
|
return true; |
|
|
|
return true; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
///////////////////////
|
|
|
|
// FLOAT
|
|
|
|
// FLOAT
|
|
|
|
IirBiQuadFilterFloat::IirBiQuadFilterFloat(unsigned numStages, const float *coeffs) |
|
|
|
///////////////////////
|
|
|
|
: NUM_STAGES(numStages) |
|
|
|
IirBiQuadFilterFloat::IirBiQuadFilterFloat(unsigned maxNumStages, const float *coeffs) |
|
|
|
|
|
|
|
: NUM_STAGES(maxNumStages) |
|
|
|
{ |
|
|
|
{ |
|
|
|
m_coeffs = new float[5*numStages]; |
|
|
|
m_coeffs = new float[NUM_COEFFS_PER_STAGE*maxNumStages]; |
|
|
|
memcpy(m_coeffs, coeffs, 5*numStages * sizeof(float)); |
|
|
|
//memcpy(m_coeffs, coeffs, NUM_COEFFS_PER_STAGE*maxNumStages * sizeof(float));
|
|
|
|
|
|
|
|
|
|
|
|
m_state = new float[4*numStages];; |
|
|
|
m_state = new float[NUM_STATES_PER_STAGE*maxNumStages];; |
|
|
|
arm_biquad_cascade_df2T_init_f32(&m_iirCfg, numStages, m_coeffs, m_state); |
|
|
|
//arm_biquad_cascade_df2T_init_f32(&m_iirCfg, maxNumStages, m_coeffs, m_state);
|
|
|
|
|
|
|
|
changeFilterCoeffs(maxNumStages, coeffs); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
IirBiQuadFilterFloat::~IirBiQuadFilterFloat() |
|
|
|
IirBiQuadFilterFloat::~IirBiQuadFilterFloat() |
|
|
@ -127,6 +154,16 @@ IirBiQuadFilterFloat::~IirBiQuadFilterFloat() |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void IirBiQuadFilterFloat::changeFilterCoeffs(unsigned numStages, const float *coeffs) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
// clear the state
|
|
|
|
|
|
|
|
memset(m_state, 0, sizeof(float) * NUM_COEFFS_PER_STAGE * numStages); |
|
|
|
|
|
|
|
// copy the coeffs
|
|
|
|
|
|
|
|
memcpy(m_coeffs, coeffs, NUM_COEFFS_PER_STAGE*numStages * sizeof(float)); |
|
|
|
|
|
|
|
arm_biquad_cascade_df2T_init_f32(&m_iirCfg, numStages, m_coeffs, m_state); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
bool IirBiQuadFilterFloat::process(float *output, float *input, size_t numSamples) |
|
|
|
bool IirBiQuadFilterFloat::process(float *output, float *input, size_t numSamples) |
|
|
|
{ |
|
|
|
{ |
|
|
|
if (!output) return false; |
|
|
|
if (!output) return false; |
|
|
|