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
High Precision Q31 Biquad Cascade Filter
[Filtering Functions]
This function implements a high precision Biquad cascade filter which operates on Q31 data values. More...
Functions | |
void | arm_biquad_cas_df1_32x64_init_q31 (arm_biquad_cas_df1_32x64_ins_q31 *S, uint8_t numStages, q31_t *pCoeffs, q63_t *pState, uint8_t postShift) |
void | arm_biquad_cas_df1_32x64_q31 (const arm_biquad_cas_df1_32x64_ins_q31 *S, q31_t *pSrc, q31_t *pDst, uint32_t blockSize) |
Detailed Description
This function implements a high precision Biquad cascade filter which operates on Q31 data values.
The filter coefficients are in 1.31 format and the state variables are in 1.63 format. The double precision state variables reduce quantization noise in the filter and provide a cleaner output. These filters are particularly useful when implementing filters in which the singularities are close to the unit circle. This is common for low pass or high pass filters with very low cutoff frequencies.
The function operates on blocks of input and output data and each call to the function processes blockSize
samples through the filter. pSrc
and pDst
points to input and output arrays containing blockSize
Q31 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]
and each state variable in 1.63 format to improve precision. The state variables are arranged in the 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 of data in 1.63 format. 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.
- Init Function
- There is also an associated initialization function which performs the 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. For example, to statically initialize the filter instance structure use
arm_biquad_cas_df1_32x64_ins_q31 S1 = {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 which is described in detail below.
- Fixed-Point Behavior
- Care must be taken while using Biquad Cascade 32x64 filter function. Following issues must be considered:
- Scaling of coefficients
- Filter gain
- Overflow and saturation
- Filter coefficients are represented as fractional values and restricted to lie in the range
[-1 +1)
. The processing function has an additional scaling parameterpostShift
which allows 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 Coefficient array to:{0.75, -0.4, 0.6, 0.8, -0.45}
and setpostShift=1
- The second thing to keep in mind is the gain through the filter. 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.
- The third item to consider is the overflow and saturation behavior of the fixed-point Q31 version. This is described in the function specific documentation below.
Function Documentation
void arm_biquad_cas_df1_32x64_init_q31 | ( | arm_biquad_cas_df1_32x64_ins_q31 * | S, |
uint8_t | numStages, | ||
q31_t * | pCoeffs, | ||
q63_t * | pState, | ||
uint8_t | postShift | ||
) |
- Parameters:
-
[in,out] *S points to an instance of the high precision Q31 Biquad cascade filter 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 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 and size of each state variable is 1.63 format. Each Biquad stage has 4 state variablesx[n-1], x[n-2], y[n-1],
andy[n-2]
. The state variables are arranged in the state 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 74 of file arm_biquad_cascade_df1_32x64_init_q31.c.
void arm_biquad_cas_df1_32x64_q31 | ( | const arm_biquad_cas_df1_32x64_ins_q31 * | S, |
q31_t * | pSrc, | ||
q31_t * | pDst, | ||
uint32_t | blockSize | ||
) |
- Parameters:
-
[in] *S points to an instance of the high precision Q31 Biquad cascade filter. [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.
- Returns:
- none.
- 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.
- Two related functions are provided in the CMSIS DSP library.
arm_biquad_cascade_df1_q31()
implements a Biquad cascade with 32-bit coefficients and state variables with a Q63 accumulator.arm_biquad_cascade_df1_fast_q31()
implements a Biquad cascade with 32-bit coefficients and state variables with a Q31 accumulator.
Definition at line 173 of file arm_biquad_cascade_df1_32x64_q31.c.
Generated on Tue Jul 12 2022 14:13:55 by
![doxygen](doxygen.png)