CMSIS DSP Library from CMSIS 2.0. See http://www.onarm.com/cmsis/ for full details
Dependents: K22F_DSP_Matrix_least_square BNO055-ELEC3810 1BNO055 ECE4180Project--Slave2 ... more
Biquad Cascade IIR Filters Using Direct Form I Structure
[Filtering Functions]
This set of functions implements arbitrary order recursive (IIR) filters. More...
Functions | |
void | arm_biquad_cascade_df1_f32 (const arm_biquad_casd_df1_inst_f32 *S, float32_t *pSrc, float32_t *pDst, uint32_t blockSize) |
Processing function for the floating-point Biquad cascade filter. | |
void | arm_biquad_cascade_df1_fast_q15 (const arm_biquad_casd_df1_inst_q15 *S, q15_t *pSrc, q15_t *pDst, uint32_t blockSize) |
Fast but less precise processing function for the Q15 Biquad cascade filter. | |
void | arm_biquad_cascade_df1_fast_q31 (const arm_biquad_casd_df1_inst_q31 *S, q31_t *pSrc, q31_t *pDst, uint32_t blockSize) |
Fast but less precise processing function for the Q31 Biquad cascade filter. | |
void | arm_biquad_cascade_df1_init_f32 (arm_biquad_casd_df1_inst_f32 *S, uint8_t numStages, float32_t *pCoeffs, float32_t *pState) |
Initialization function for the floating-point Biquad cascade filter. | |
void | arm_biquad_cascade_df1_init_q15 (arm_biquad_casd_df1_inst_q15 *S, uint8_t numStages, q15_t *pCoeffs, q15_t *pState, int8_t postShift) |
Initialization function for the Q15 Biquad cascade filter. | |
void | arm_biquad_cascade_df1_init_q31 (arm_biquad_casd_df1_inst_q31 *S, uint8_t numStages, q31_t *pCoeffs, q31_t *pState, int8_t postShift) |
Initialization function for the Q31 Biquad cascade filter. | |
void | arm_biquad_cascade_df1_q15 (const arm_biquad_casd_df1_inst_q15 *S, q15_t *pSrc, q15_t *pDst, uint32_t blockSize) |
Processing function for the Q15 Biquad cascade filter. | |
void | arm_biquad_cascade_df1_q31 (const arm_biquad_casd_df1_inst_q31 *S, q31_t *pSrc, q31_t *pDst, uint32_t blockSize) |
Processing function for the Q31 Biquad cascade filter. |
Detailed Description
This set of functions implements arbitrary order recursive (IIR) filters.
The filters are implemented as a cascade of second order Biquad sections. The functions support Q15, Q31 and floating-point data types. Fast version of Q15 and Q31 also supported.
The functions operate on blocks of input and output data and each call to the function processes blockSize
samples through the filter. pSrc
points to the array of input data and pDst
points to the array of output data. Both arrays contain blockSize
values.
- Algorithm
- Each Biquad stage implements a second order filter using the difference equation:
y[n] = b0 * x[n] + b1 * x[n-1] + b2 * x[n-2] + a1 * y[n-1] + a2 * y[n-2]
A Direct Form I algorithm is used with 5 coefficients and 4 state variables per stage.Single Biquad filter stage
b0, b1 and b2
multiply the input signalx[n]
and are referred to as the feedforward coefficients. Coefficientsa1
anda2
multiply the output signaly[n]
and are referred to as the feedback coefficients. Pay careful attention to the sign of the feedback coefficients. Some design tools use the difference equationy[n] = b0 * x[n] + b1 * x[n-1] + b2 * x[n-2] - a1 * y[n-1] - a2 * y[n-2]
In this case the feedback coefficientsa1
anda2
must be negated when used with the CMSIS DSP Library.
- Higher order filters are realized as a cascade of second order sections.
numStages
refers to the number of second order stages used. For example, an 8th order filter would be realized withnumStages=4
second order stages.8th order filter using a cascade of Biquad stages
numStages=5
second order stages with the coefficients for one of the stages configured as a first order filter (b2=0
anda2=0
).
- The
pState
points to state variables array. Each Biquad stage has 4 state variablesx[n-1], x[n-2], y[n-1],
andy[n-2]
. The state variables are arranged in thepState
array as:{x[n-1], x[n-2], y[n-1], y[n-2]}
- The 4 state variables for stage 1 are first, then the 4 state variables for stage 2, and so on. The state array has a total length of
4*numStages
values. The state variables are updated after each block of data is processed, the coefficients are untouched.
- Instance Structure
- The coefficients and state variables for a filter are stored together in an instance data structure. A separate instance structure must be defined for each filter. Coefficient arrays may be shared among several instances while state variable arrays cannot be shared. There are separate instance structure declarations for each of the 3 supported data types.
- Init Functions
- There is also an associated initialization function for each data type. The initialization function performs following operations:
- Sets the values of the internal structure fields.
- Zeros out the values in the state buffer.
- Use of the initialization function is optional. However, if the initialization function is used, then the instance structure cannot be placed into a const data section. To place an instance structure into a const data section, the instance structure must be manually initialized. Set the values in the state buffer to zeros before static initialization. The code below statically initializes each of the 3 different data type filter instance structures
arm_biquad_casd_df1_inst_f32 S1 = {numStages, pState, pCoeffs}; arm_biquad_casd_df1_inst_q15 S2 = {numStages, pState, pCoeffs, postShift}; arm_biquad_casd_df1_inst_q31 S3 = {numStages, pState, pCoeffs, postShift};
wherenumStages
is the number of Biquad stages in the filter;pState
is the address of the state buffer;pCoeffs
is the address of the coefficient buffer;postShift
shift to be applied.
- Fixed-Point Behavior
- Care must be taken when using the Q15 and Q31 versions of the Biquad Cascade filter functions. Following issues must be considered:
- Scaling of coefficients
- Filter gain
- Overflow and saturation
- Scaling of coefficients: Filter coefficients are represented as fractional values and coefficients are restricted to lie in the range
[-1 +1)
. The fixed-point functions have an additional scaling parameterpostShift
which allow the filter coefficients to exceed the range[+1 -1)
. At the output of the filter's accumulator is a shift register which shifts the result bypostShift
bits.Fixed-point Biquad with shift by postShift bits after accumulator
2^postShift
. For example, to realize the coefficients{1.5, -0.8, 1.2, 1.6, -0.9}
set the pCoeffs array to:{0.75, -0.4, 0.6, 0.8, -0.45}
and setpostShift=1
- Filter gain: The frequency response of a Biquad filter is a function of its coefficients. It is possible for the gain through the filter to exceed 1.0 meaning that the filter increases the amplitude of certain frequencies. This means that an input signal with amplitude < 1.0 may result in an output > 1.0 and these are saturated or overflowed based on the implementation of the filter. To avoid this behavior the filter needs to be scaled down such that its peak gain < 1.0 or the input signal must be scaled down so that the combination of input and filter are never overflowed.
- Overflow and saturation: For Q15 and Q31 versions, it is described separately as part of the function specific documentation below.
Function Documentation
void arm_biquad_cascade_df1_f32 | ( | const arm_biquad_casd_df1_inst_f32 * | S, |
float32_t * | pSrc, | ||
float32_t * | pDst, | ||
uint32_t | blockSize | ||
) |
Processing function for the floating-point Biquad cascade filter.
- Parameters:
-
[in] *S points to an instance of the floating-point Biquad cascade structure. [in] *pSrc points to the block of input data. [out] *pDst points to the block of output data. [in] blockSize number of samples to process per call.
- Returns:
- none.
Definition at line 167 of file arm_biquad_cascade_df1_f32.c.
void arm_biquad_cascade_df1_fast_q15 | ( | const arm_biquad_casd_df1_inst_q15 * | S, |
q15_t * | pSrc, | ||
q15_t * | pDst, | ||
uint32_t | blockSize | ||
) |
Fast but less precise processing function for the Q15 Biquad cascade filter.
- Parameters:
-
[in] *S points to an instance of the Q15 Biquad cascade structure. [in] *pSrc points to the block of input data. [out] *pDst points to the block of output data. [in] blockSize number of samples to process per call.
- Returns:
- none.
Scaling and Overflow Behavior:
- This fast version uses a 32-bit accumulator with 2.30 format. The accumulator maintains full precision of the intermediate multiplication results but provides only a single guard bit. Thus, if the accumulator result overflows it wraps around and distorts the result. In order to avoid overflows completely the input signal must be scaled down by two bits and lie in the range [-0.25 +0.25). The 2.30 accumulator is then shifted by
postShift
bits and the result truncated to 1.15 format by discarding the low 16 bits.
- Refer to the function
arm_biquad_cascade_df1_q15()
for a slower implementation of this function which uses 64-bit accumulation to avoid wrap around distortion. Both the slow and the fast versions use the same instance structure. Use the functionarm_biquad_cascade_df1_init_q15()
to initialize the filter structure.
Definition at line 66 of file arm_biquad_cascade_df1_fast_q15.c.
void arm_biquad_cascade_df1_fast_q31 | ( | const arm_biquad_casd_df1_inst_q31 * | S, |
q31_t * | pSrc, | ||
q31_t * | pDst, | ||
uint32_t | blockSize | ||
) |
Fast but less precise processing function for the Q31 Biquad cascade filter.
- Parameters:
-
[in] *S points to an instance of the Q31 Biquad cascade structure. [in] *pSrc points to the block of input data. [out] *pDst points to the block of output data. [in] blockSize number of samples to process per call.
- Returns:
- none.
Scaling and Overflow Behavior:
- This function is optimized for speed at the expense of fixed-point precision and overflow protection. The result of each 1.31 x 1.31 multiplication is truncated to 2.30 format. These intermediate results are added to a 2.30 accumulator. Finally, the accumulator is saturated and converted to a 1.31 result. The fast version has the same overflow behavior as the standard version and provides less precision since it discards the low 32 bits of each multiplication result. In order to avoid overflows completely the input signal must be scaled down by two bits and lie in the range [-0.25 +0.25). Use the intialization function arm_biquad_cascade_df1_init_q31() to initialize filter structure.
- Refer to the function
arm_biquad_cascade_df1_q31()
for a slower implementation of this function which uses 64-bit accumulation to provide higher precision. Both the slow and the fast versions use the same instance structure. Use the functionarm_biquad_cascade_df1_init_q31()
to initialize the filter structure.
Definition at line 67 of file arm_biquad_cascade_df1_fast_q31.c.
void arm_biquad_cascade_df1_init_f32 | ( | arm_biquad_casd_df1_inst_f32 * | S, |
uint8_t | numStages, | ||
float32_t * | pCoeffs, | ||
float32_t * | pState | ||
) |
Initialization function for the floating-point Biquad cascade filter.
- Parameters:
-
[in,out] *S points to an instance of the floating-point Biquad cascade structure. [in] numStages number of 2nd order stages in the filter. [in] *pCoeffs points to the filter coefficients array. [in] *pState points to the state array.
- Returns:
- none
Coefficient and State Ordering:
- The coefficients are stored in the array
pCoeffs
in the following order:{b10, b11, b12, a11, a12, b20, b21, b22, a21, a22, ...}
- where
b1x
anda1x
are the coefficients for the first stage,b2x
anda2x
are the coefficients for the second stage, and so on. ThepCoeffs
array contains a total of5*numStages
values.
- The
pState
is a pointer to state array. Each Biquad stage has 4 state variablesx[n-1], x[n-2], y[n-1],
andy[n-2]
. The state variables are arranged in thepState
array as:{x[n-1], x[n-2], y[n-1], y[n-2]}
The 4 state variables for stage 1 are first, then the 4 state variables for stage 2, and so on. The state array has a total length of4*numStages
values. The state variables are updated after each block of data is processed; the coefficients are untouched.
Definition at line 80 of file arm_biquad_cascade_df1_init_f32.c.
void arm_biquad_cascade_df1_init_q15 | ( | arm_biquad_casd_df1_inst_q15 * | S, |
uint8_t | numStages, | ||
q15_t * | pCoeffs, | ||
q15_t * | pState, | ||
int8_t | postShift | ||
) |
Initialization function for the Q15 Biquad cascade filter.
- Parameters:
-
[in,out] *S points to an instance of the Q15 Biquad cascade structure. [in] numStages number of 2nd order stages in the filter. [in] *pCoeffs points to the filter coefficients. [in] *pState points to the state buffer. [in] postShift Shift to be applied to the accumulator result. Varies according to the coefficients format
- Returns:
- none
Coefficient and State Ordering:
- The coefficients are stored in the array
pCoeffs
in the following order:{b10, 0, b11, b12, a11, a12, b20, 0, b21, b22, a21, a22, ...}
whereb1x
anda1x
are the coefficients for the first stage,b2x
anda2x
are the coefficients for the second stage, and so on. ThepCoeffs
array contains a total of6*numStages
values. The zero coefficient betweenb1
andb2
facilities use of 16-bit SIMD instructions on the Cortex-M4.
- The state variables are stored in the array
pState
. Each Biquad stage has 4 state variablesx[n-1], x[n-2], y[n-1],
andy[n-2]
. The state variables are arranged in thepState
array as:{x[n-1], x[n-2], y[n-1], y[n-2]}
The 4 state variables for stage 1 are first, then the 4 state variables for stage 2, and so on. The state array has a total length of4*numStages
values. The state variables are updated after each block of data is processed; the coefficients are untouched.
Definition at line 78 of file arm_biquad_cascade_df1_init_q15.c.
void arm_biquad_cascade_df1_init_q31 | ( | arm_biquad_casd_df1_inst_q31 * | S, |
uint8_t | numStages, | ||
q31_t * | pCoeffs, | ||
q31_t * | pState, | ||
int8_t | postShift | ||
) |
Initialization function for the Q31 Biquad cascade filter.
- Parameters:
-
[in,out] *S points to an instance of the Q31 Biquad cascade structure. [in] numStages number of 2nd order stages in the filter. [in] *pCoeffs points to the filter coefficients buffer. [in] *pState points to the state buffer. [in] postShift Shift to be applied after the accumulator. Varies according to the coefficients format
- Returns:
- none
Coefficient and State Ordering:
- The coefficients are stored in the array
pCoeffs
in the following order:{b10, b11, b12, a11, a12, b20, b21, b22, a21, a22, ...}
whereb1x
anda1x
are the coefficients for the first stage,b2x
anda2x
are the coefficients for the second stage, and so on. ThepCoeffs
array contains a total of5*numStages
values.
- The
pState
points to state variables array. Each Biquad stage has 4 state variablesx[n-1], x[n-2], y[n-1],
andy[n-2]
. The state variables are arranged in thepState
array as:{x[n-1], x[n-2], y[n-1], y[n-2]}
The 4 state variables for stage 1 are first, then the 4 state variables for stage 2, and so on. The state array has a total length of4*numStages
values. The state variables are updated after each block of data is processed; the coefficients are untouched.
Definition at line 78 of file arm_biquad_cascade_df1_init_q31.c.
void arm_biquad_cascade_df1_q15 | ( | const arm_biquad_casd_df1_inst_q15 * | S, |
q15_t * | pSrc, | ||
q15_t * | pDst, | ||
uint32_t | blockSize | ||
) |
Processing function for the Q15 Biquad cascade filter.
- Parameters:
-
[in] *S points to an instance of the Q15 Biquad cascade structure. [in] *pSrc points to the block of input data. [out] *pDst points to the location where the output result is written. [in] blockSize number of samples to process per call.
- Returns:
- none.
Scaling and Overflow Behavior:
- The function is implemented using a 64-bit internal accumulator. Both coefficients and state variables are represented in 1.15 format and multiplications yield a 2.30 result. The 2.30 intermediate results are accumulated in a 64-bit accumulator in 34.30 format. There is no risk of internal overflow with this approach and the full precision of intermediate multiplications is preserved. The accumulator is then shifted by
postShift
bits to truncate the result to 1.15 format by discarding the low 16 bits. Finally, the result is saturated to 1.15 format.
- Refer to the function
arm_biquad_cascade_df1_fast_q15()
for a faster but less precise implementation of this filter.
Definition at line 67 of file arm_biquad_cascade_df1_q15.c.
void arm_biquad_cascade_df1_q31 | ( | const arm_biquad_casd_df1_inst_q31 * | S, |
q31_t * | pSrc, | ||
q31_t * | pDst, | ||
uint32_t | blockSize | ||
) |
Processing function for the Q31 Biquad cascade filter.
- Parameters:
-
[in] *S points to an instance of the Q31 Biquad cascade structure. [in] *pSrc points to the block of input data. [out] *pDst points to the block of output data. [in] blockSize number of samples to process per call.
- Returns:
- none.
Scaling and Overflow Behavior:
- The function is implemented using an internal 64-bit accumulator. The accumulator has a 2.62 format and maintains full precision of the intermediate multiplication results but provides only a single guard bit. Thus, if the accumulator result overflows it wraps around rather than clip. In order to avoid overflows completely the input signal must be scaled down by 2 bits and lie in the range [-0.25 +0.25). After all 5 multiply-accumulates are performed, the 2.62 accumulator is shifted by
postShift
bits and the result truncated to 1.31 format by discarding the low 32 bits.
- Refer to the function
arm_biquad_cascade_df1_fast_q31()
for a faster but less precise implementation of this filter.
Definition at line 66 of file arm_biquad_cascade_df1_q31.c.
Generated on Tue Jul 12 2022 14:13:55 by 1.7.2