diff options
Diffstat (limited to 'fw/hid-dials/Drivers/CMSIS/DSP/DSP_Lib_TestSuite/RefLibs/src/FilteringFunctions/fir.c')
| -rw-r--r-- | fw/hid-dials/Drivers/CMSIS/DSP/DSP_Lib_TestSuite/RefLibs/src/FilteringFunctions/fir.c | 325 |
1 files changed, 0 insertions, 325 deletions
diff --git a/fw/hid-dials/Drivers/CMSIS/DSP/DSP_Lib_TestSuite/RefLibs/src/FilteringFunctions/fir.c b/fw/hid-dials/Drivers/CMSIS/DSP/DSP_Lib_TestSuite/RefLibs/src/FilteringFunctions/fir.c deleted file mode 100644 index 3e72b87..0000000 --- a/fw/hid-dials/Drivers/CMSIS/DSP/DSP_Lib_TestSuite/RefLibs/src/FilteringFunctions/fir.c +++ /dev/null @@ -1,325 +0,0 @@ -#include "ref.h"
-
-void ref_fir_f32(
- const arm_fir_instance_f32 * S,
- float32_t * pSrc,
- float32_t * pDst,
- uint32_t blockSize)
-{
- float32_t *pState = S->pState; /* State pointer */
- float32_t *pCoeffs = S->pCoeffs; /* Coefficient pointer */
- float32_t *pStateCurnt; /* Points to the current sample of the state */
- uint32_t numTaps = S->numTaps; /* Number of filter coefficients in the filter */
- uint32_t i; /* Loop counters */
- float32_t acc;
-
- /* S->pState points to state array which contains previous frame (numTaps - 1) samples */
- /* pStateCurnt points to the location where the new input data should be written */
- pStateCurnt = &(S->pState[(numTaps - 1U)]);
-
- while (blockSize > 0U)
- {
- /* Copy one sample at a time into state buffer */
- *pStateCurnt++ = *pSrc++;
-
- /* Set the accumulator to zero */
- acc = 0.0f;
-
- for(i=0;i<numTaps;i++)
- {
- /* Perform the multiply-accumulates */
- acc += pState[i] * pCoeffs[i];
- }
-
- /* The result is store in the destination buffer. */
- *pDst++ = acc;
-
- /* Advance state pointer by 1 for the next sample */
- pState++;
-
- blockSize--;
- }
-
- /* Processing is complete.
- ** Now copy the last numTaps - 1 samples to the starting of the state buffer.
- ** This prepares the state buffer for the next function call. */
-
- /* Points to the start of the state buffer */
- pStateCurnt = S->pState;
-
- /* Copy data */
- for(i=0;i<numTaps-1;i++)
- {
- pStateCurnt[i] = pState[i];
- }
-}
-
-void ref_fir_q31(
- const arm_fir_instance_q31 * S,
- q31_t * pSrc,
- q31_t * pDst,
- uint32_t blockSize)
-{
- q31_t *pState = S->pState; /* State pointer */
- q31_t *pCoeffs = S->pCoeffs; /* Coefficient pointer */
- q31_t *pStateCurnt; /* Points to the current sample of the state */
- uint32_t numTaps = S->numTaps; /* Number of filter coefficients in the filter */
- uint32_t i; /* Loop counters */
- q63_t acc;
-
- /* S->pState points to state array which contains previous frame (numTaps - 1) samples */
- /* pStateCurnt points to the location where the new input data should be written */
- pStateCurnt = &(S->pState[(numTaps - 1U)]);
-
- while (blockSize > 0U)
- {
- /* Copy one sample at a time into state buffer */
- *pStateCurnt++ = *pSrc++;
-
- /* Set the accumulator to zero */
- acc = 0.0f;
-
- for(i=0;i<numTaps;i++)
- {
- /* Perform the multiply-accumulates */
- acc += (q63_t)pState[i] * pCoeffs[i];
- }
-
- /* The result is store in the destination buffer. */
- *pDst++ = (q31_t)(acc >> 31);
-
- /* Advance state pointer by 1 for the next sample */
- pState++;
-
- blockSize--;
- }
-
- /* Processing is complete.
- ** Now copy the last numTaps - 1 samples to the starting of the state buffer.
- ** This prepares the state buffer for the next function call. */
-
- /* Points to the start of the state buffer */
- pStateCurnt = S->pState;
-
- /* Copy data */
- for(i=0;i<numTaps-1;i++)
- {
- pStateCurnt[i] = pState[i];
- }
-}
-
-void ref_fir_fast_q31(
- const arm_fir_instance_q31 * S,
- q31_t * pSrc,
- q31_t * pDst,
- uint32_t blockSize)
-{
- q31_t *pState = S->pState; /* State pointer */
- q31_t *pCoeffs = S->pCoeffs; /* Coefficient pointer */
- q31_t *pStateCurnt; /* Points to the current sample of the state */
- uint32_t numTaps = S->numTaps; /* Number of filter coefficients in the filter */
- uint32_t i; /* Loop counters */
- q31_t acc;
-
- /* S->pState points to state array which contains previous frame (numTaps - 1) samples */
- /* pStateCurnt points to the location where the new input data should be written */
- pStateCurnt = &(S->pState[(numTaps - 1U)]);
-
- while (blockSize > 0U)
- {
- /* Copy one sample at a time into state buffer */
- *pStateCurnt++ = *pSrc++;
-
- /* Set the accumulator to zero */
- acc = 0.0f;
-
- for(i=0;i<numTaps;i++)
- {
- /* Perform the multiply-accumulates */
- acc = (q31_t) (((((q63_t) acc) << 32) + ((q63_t) pState[i] * pCoeffs[i]) + 0x80000000LL ) >> 32);
- }
-
- /* The result is store in the destination buffer. */
- *pDst++ = (q31_t)(acc << 1);
-
- /* Advance state pointer by 1 for the next sample */
- pState++;
-
- blockSize--;
- }
-
- /* Processing is complete.
- ** Now copy the last numTaps - 1 samples to the starting of the state buffer.
- ** This prepares the state buffer for the next function call. */
-
- /* Points to the start of the state buffer */
- pStateCurnt = S->pState;
-
- /* Copy data */
- for(i=0;i<numTaps-1;i++)
- {
- pStateCurnt[i] = pState[i];
- }
-}
-
-void ref_fir_q15(
- const arm_fir_instance_q15 * S,
- q15_t * pSrc,
- q15_t * pDst,
- uint32_t blockSize)
-{
- q15_t *pState = S->pState; /* State pointer */
- q15_t *pCoeffs = S->pCoeffs; /* Coefficient pointer */
- q15_t *pStateCurnt; /* Points to the current sample of the state */
- uint32_t numTaps = S->numTaps; /* Number of filter coefficients in the filter */
- uint32_t i; /* Loop counters */
- q63_t acc;
-
- /* S->pState points to state array which contains previous frame (numTaps - 1) samples */
- /* pStateCurnt points to the location where the new input data should be written */
- pStateCurnt = &(S->pState[(numTaps - 1U)]);
-
- while (blockSize > 0U)
- {
- /* Copy one sample at a time into state buffer */
- *pStateCurnt++ = *pSrc++;
-
- /* Set the accumulator to zero */
- acc = 0.0f;
-
- for(i=0;i<numTaps;i++)
- {
- /* Perform the multiply-accumulates */
- acc += (q31_t)pState[i] * pCoeffs[i];
- }
-
- /* The result is store in the destination buffer. */
- *pDst++ = ref_sat_q15(acc >> 15);
-
- /* Advance state pointer by 1 for the next sample */
- pState++;
-
- blockSize--;
- }
-
- /* Processing is complete.
- ** Now copy the last numTaps - 1 samples to the starting of the state buffer.
- ** This prepares the state buffer for the next function call. */
-
- /* Points to the start of the state buffer */
- pStateCurnt = S->pState;
-
- /* Copy data */
- for(i=0;i<numTaps;i++)
- {
- pStateCurnt[i] = pState[i];
- }
-}
-
-void ref_fir_fast_q15(
- const arm_fir_instance_q15 * S,
- q15_t * pSrc,
- q15_t * pDst,
- uint32_t blockSize)
-{
- q15_t *pState = S->pState; /* State pointer */
- q15_t *pCoeffs = S->pCoeffs; /* Coefficient pointer */
- q15_t *pStateCurnt; /* Points to the current sample of the state */
- uint32_t numTaps = S->numTaps; /* Number of filter coefficients in the filter */
- uint32_t i; /* Loop counters */
- q31_t acc;
-
- /* S->pState points to state array which contains previous frame (numTaps - 1) samples */
- /* pStateCurnt points to the location where the new input data should be written */
- pStateCurnt = &(S->pState[(numTaps - 1U)]);
-
- while (blockSize > 0U)
- {
- /* Copy one sample at a time into state buffer */
- *pStateCurnt++ = *pSrc++;
-
- /* Set the accumulator to zero */
- acc = 0.0f;
-
- for(i=0;i<numTaps;i++)
- {
- /* Perform the multiply-accumulates */
- acc += (q31_t)pState[i] * pCoeffs[i];
- }
-
- /* The result is store in the destination buffer. */
- *pDst++ = ref_sat_q15(acc >> 15);
-
- /* Advance state pointer by 1 for the next sample */
- pState++;
-
- blockSize--;
- }
-
- /* Processing is complete.
- ** Now copy the last numTaps - 1 samples to the starting of the state buffer.
- ** This prepares the state buffer for the next function call. */
-
- /* Points to the start of the state buffer */
- pStateCurnt = S->pState;
-
- /* Copy data */
- for(i=0;i<numTaps-1;i++)
- {
- pStateCurnt[i] = pState[i];
- }
-}
-
-void ref_fir_q7(
- const arm_fir_instance_q7 * S,
- q7_t * pSrc,
- q7_t * pDst,
- uint32_t blockSize)
-{
- q7_t *pState = S->pState; /* State pointer */
- q7_t *pCoeffs = S->pCoeffs; /* Coefficient pointer */
- q7_t *pStateCurnt; /* Points to the current sample of the state */
- uint32_t numTaps = S->numTaps; /* Number of filter coefficients in the filter */
- uint32_t i; /* Loop counters */
- q31_t acc;
-
- /* S->pState points to state array which contains previous frame (numTaps - 1) samples */
- /* pStateCurnt points to the location where the new input data should be written */
- pStateCurnt = &(S->pState[(numTaps - 1U)]);
-
- while (blockSize > 0U)
- {
- /* Copy one sample at a time into state buffer */
- *pStateCurnt++ = *pSrc++;
-
- /* Set the accumulator to zero */
- acc = 0.0f;
-
- for(i=0;i<numTaps;i++)
- {
- /* Perform the multiply-accumulates */
- acc += (q31_t)pState[i] * pCoeffs[i];
- }
-
- /* The result is store in the destination buffer. */
- *pDst++ = ref_sat_q7(acc >> 7);
-
- /* Advance state pointer by 1 for the next sample */
- pState++;
-
- blockSize--;
- }
-
- /* Processing is complete.
- ** Now copy the last numTaps - 1 samples to the starting of the state buffer.
- ** This prepares the state buffer for the next function call. */
-
- /* Points to the start of the state buffer */
- pStateCurnt = S->pState;
-
- /* Copy data */
- for(i=0;i<numTaps-1;i++)
- {
- pStateCurnt[i] = pState[i];
- }
-}
|