RMUL2025/lib/cmsis_5/CMSIS/DSP/Testing/Source/Benchmarks/FIRQ31.cpp

93 lines
2.9 KiB
C++
Executable File

#include "FIRQ31.h"
#include "Error.h"
#if defined(ARM_MATH_MVEI) && !defined(ARM_MATH_AUTOVECTORIZE)
static __ALIGNED(8) q31_t coeffArray[64];
#endif
void FIRQ31::test_fir_q31()
{
arm_fir_q31(&instFir, pSrc, pDst, this->nbSamples);
}
void FIRQ31::test_lms_q31()
{
arm_lms_q31(&instLms, pSrc, (q31_t*)pRef, pDst, pErr,this->nbSamples);
}
void FIRQ31::test_lms_norm_q31()
{
arm_lms_norm_q31(&instLmsNorm, pSrc, (q31_t*)pRef, pDst, pErr,this->nbSamples);
}
void FIRQ31::setUp(Testing::testID_t id,std::vector<Testing::param_t>& params,Client::PatternMgr *mgr)
{
std::vector<Testing::param_t>::iterator it = params.begin();
this->nbTaps = *it++;
this->nbSamples = *it;
samples.reload(FIRQ31::SAMPLES1_Q31_ID,mgr,this->nbSamples);
coefs.reload(FIRQ31::COEFS1_Q31_ID,mgr,this->nbTaps);
state.create(2*ROUND_UP(this->nbSamples,4) + this->nbSamples + this->nbTaps - 1,FIRQ31::STATE_Q31_ID,mgr);
output.create(this->nbSamples,FIRQ31::OUT_SAMPLES_Q31_ID,mgr);
switch(id)
{
case TEST_FIR_Q31_1:
#if defined(ARM_MATH_MVEI) && !defined(ARM_MATH_AUTOVECTORIZE)
/* Copy coefficients and pad to zero
*/
memset(coeffArray,0,32*sizeof(q31_t));
q31_t *ptr;
ptr=coefs.ptr();
memcpy(coeffArray,ptr,this->nbTaps*sizeof(q31_t));
this->pCoefs = coeffArray;
#else
this->pCoefs=coefs.ptr();
#endif
arm_fir_init_q31(&instFir,this->nbTaps,coefs.ptr(),state.ptr(),this->nbSamples);
this->pSrc=samples.ptr();
this->pDst=output.ptr();
break;
case TEST_LMS_Q31_2:
refs.reload(FIRQ31::REFS1_Q31_ID,mgr,this->nbSamples);
error.create(this->nbSamples,FIRQ31::ERR_Q31_ID,mgr);
// Value of mu and postShift are arbitrary just for benchmark
arm_lms_init_q31(&instLms,this->nbTaps,coefs.ptr(),state.ptr(),100,this->nbSamples,1);
this->pSrc=samples.ptr();
this->pRef=refs.ptr();
this->pDst=output.ptr();
this->pErr=error.ptr();
break;
case TEST_LMS_NORM_Q31_3:
refs.reload(FIRQ31::REFS1_Q31_ID,mgr,this->nbSamples);
error.create(this->nbSamples,FIRQ31::ERR_Q31_ID,mgr);
// Value of mu and postShift are arbitrary just for benchmark
arm_lms_norm_init_q31(&instLmsNorm,this->nbTaps,coefs.ptr(),state.ptr(),100,this->nbSamples,1);
this->pSrc=samples.ptr();
this->pRef=refs.ptr();
this->pDst=output.ptr();
this->pErr=error.ptr();
break;
}
}
void FIRQ31::tearDown(Testing::testID_t id,Client::PatternMgr *mgr)
{
}