89 lines
2.0 KiB
C++
Executable File
89 lines
2.0 KiB
C++
Executable File
#include "ControllerQ31.h"
|
|
#include "Error.h"
|
|
|
|
|
|
void ControllerQ31::test_pid_q31()
|
|
{
|
|
for(int i=0; i < this->nbSamples; i++)
|
|
{
|
|
*this->pDst++ = arm_pid_q31(&instPid, *this->pSrc++);
|
|
}
|
|
}
|
|
|
|
void ControllerQ31::test_clarke_q31()
|
|
{
|
|
q31_t Ialpha;
|
|
q31_t Ibeta;
|
|
for(int i=0; i < this->nbSamples; i++)
|
|
{
|
|
arm_clarke_q31(0xccccccd,0x1999999a,&Ialpha,&Ibeta);
|
|
}
|
|
}
|
|
|
|
void ControllerQ31::test_inv_clarke_q31()
|
|
{
|
|
q31_t Ia;
|
|
q31_t Ib;
|
|
for(int i=0; i < this->nbSamples; i++)
|
|
{
|
|
arm_clarke_q31(0xccccccd,0x1999999a,&Ia,&Ib);
|
|
}
|
|
}
|
|
|
|
void ControllerQ31::test_park_q31()
|
|
{
|
|
q31_t Id,Iq;
|
|
|
|
for(int i=0; i < this->nbSamples; i++)
|
|
{
|
|
arm_park_q31(0xccccccd,0x1999999a,&Id,&Iq,0xccccccd,0x1999999a);
|
|
}
|
|
}
|
|
|
|
void ControllerQ31::test_inv_park_q31()
|
|
{
|
|
q31_t Ialpha,Ibeta;
|
|
|
|
for(int i=0; i < this->nbSamples; i++)
|
|
{
|
|
arm_inv_park_q31(0xccccccd,0x1999999a,&Ialpha,&Ibeta,0xccccccd,0x1999999a);
|
|
}
|
|
}
|
|
|
|
void ControllerQ31::test_sin_cos_q31()
|
|
{
|
|
q31_t sinVal,cosVal;
|
|
|
|
for(int i=0; i < this->nbSamples; i++)
|
|
{
|
|
arm_sin_cos_q31(0xccccccd,&sinVal,&cosVal);
|
|
}
|
|
}
|
|
|
|
void ControllerQ31::setUp(Testing::testID_t id,std::vector<Testing::param_t>& params,Client::PatternMgr *mgr)
|
|
{
|
|
|
|
|
|
std::vector<Testing::param_t>::iterator it = params.begin();
|
|
this->nbSamples = *it;
|
|
|
|
samples.reload(ControllerQ31::SAMPLES_Q31_ID,mgr,this->nbSamples);
|
|
output.create(this->nbSamples,ControllerQ31::OUT_SAMPLES_Q31_ID,mgr);
|
|
|
|
switch(id)
|
|
{
|
|
case TEST_PID_Q31_1:
|
|
arm_pid_init_q31(&instPid,1);
|
|
break;
|
|
|
|
}
|
|
|
|
this->pSrc=samples.ptr();
|
|
this->pDst=output.ptr();
|
|
|
|
}
|
|
|
|
void ControllerQ31::tearDown(Testing::testID_t id,Client::PatternMgr *mgr)
|
|
{
|
|
}
|