121 lines
4.2 KiB
C
121 lines
4.2 KiB
C
/*=====================================================================================
|
|
File name: SVGEN_DQ.C (IQ version)
|
|
|
|
Originator: Digital Control Systems Group
|
|
Texas Instruments
|
|
|
|
Description: Space-vector PWM generation based on d-q components
|
|
|
|
=====================================================================================
|
|
History:
|
|
-------------------------------------------------------------------------------------
|
|
04-15-2005 Version 3.20
|
|
-------------------------------------------------------------------------------------*/
|
|
|
|
#include "IQmathLib.h" // Include header for IQmath library
|
|
// Don't forget to set a proper GLOBAL_Q in "IQmathLib.h" file
|
|
#include "dmctype.h"
|
|
#include "svgen_dq.h"
|
|
_iq iq_max = _IQ(1.0)-1;
|
|
|
|
|
|
// #pragma CODE_SECTION(svgendq_calc,".fast_run2");
|
|
void svgendq_calc(SVGENDQ *v)
|
|
{
|
|
_iq Va,Vb,Vc,t1,t2,temp_sv1,temp_sv2;
|
|
Uint16 Sector = 0; // Sector is treated as Q0 - independently with global Q
|
|
|
|
Sector = 0; \
|
|
temp_sv1=_IQdiv2(v->Ubeta); /*divide by 2*/ \
|
|
temp_sv2=_IQmpy(_IQ(0.8660254),v->Ualpha); /* 0.8660254 = sqrt(3)/2*/ \
|
|
|
|
// Inverse clarke transformation
|
|
Va = v->Ubeta; \
|
|
Vb = -temp_sv1 + temp_sv2; \
|
|
Vc = -temp_sv1 - temp_sv2; \
|
|
|
|
// 60 degree Sector determination
|
|
if (Va>0)
|
|
Sector = 1;
|
|
if (Vb>0)
|
|
Sector = Sector + 2;
|
|
if (Vc>0)
|
|
Sector = Sector + 4;
|
|
|
|
// X,Y,Z (Va,Vb,Vc) calculations X = Va, Y = Vb, Z = Vc \ Va = v.Ubeta;
|
|
Vb = temp_sv1 + temp_sv2;
|
|
Vc = temp_sv1 - temp_sv2;
|
|
// Sector 0: this is special case for (Ualpha,Ubeta) = (0,0)
|
|
|
|
if (Sector==0) // Sector 0: this is special case for (Ualpha,Ubeta) = (0,0)
|
|
{
|
|
v->Ta = _IQ(0.5);
|
|
v->Tb = _IQ(0.5);
|
|
v->Tc = _IQ(0.5);
|
|
}
|
|
if (Sector==1) // Sector 1: t1=Z and t2=Y (abc ---> Tb,Ta,Tc)
|
|
{
|
|
t1 = Vc;
|
|
t2 = Vb;
|
|
v->Tb = _IQdiv2((_IQ(1)-t1-t2)); // tbon = (1-t1-t2)/2
|
|
v->Ta = v->Tb+t1; // taon = tbon+t1
|
|
v->Tc = v->Ta+t2; // tcon = taon+t2
|
|
}
|
|
else if (Sector==2) // Sector 2: t1=Y and t2=-X (abc ---> Ta,Tc,Tb)
|
|
{
|
|
t1 = Vb;
|
|
t2 = -Va;
|
|
v->Ta = _IQdiv2((_IQ(1)-t1-t2)); // taon = (1-t1-t2)/2
|
|
v->Tc = v->Ta+t1; // tcon = taon+t1
|
|
v->Tb = v->Tc+t2; // tbon = tcon+t2
|
|
}
|
|
else if (Sector==3) // Sector 3: t1=-Z and t2=X (abc ---> Ta,Tb,Tc)
|
|
{
|
|
t1 = -Vc;
|
|
t2 = Va;
|
|
v->Ta = _IQdiv2((_IQ(1)-t1-t2)); // taon = (1-t1-t2)/2
|
|
v->Tb = v->Ta+t1; // tbon = taon+t1
|
|
v->Tc = v->Tb+t2; // tcon = tbon+t2
|
|
}
|
|
else if (Sector==4) // Sector 4: t1=-X and t2=Z (abc ---> Tc,Tb,Ta)
|
|
{
|
|
t1 = -Va;
|
|
t2 = Vc;
|
|
v->Tc = _IQdiv2((_IQ(1)-t1-t2)); // tcon = (1-t1-t2)/2
|
|
v->Tb = v->Tc+t1; // tbon = tcon+t1
|
|
v->Ta = v->Tb+t2; // taon = tbon+t2
|
|
}
|
|
else if (Sector==5) // Sector 5: t1=X and t2=-Y (abc ---> Tb,Tc,Ta)
|
|
{
|
|
t1 = Va;
|
|
t2 = -Vb;
|
|
v->Tb = _IQdiv2((_IQ(1)-t1-t2)); // tbon = (1-t1-t2)/2
|
|
v->Tc = v->Tb+t1; // tcon = tbon+t1
|
|
v->Ta = v->Tc+t2; // taon = tcon+t2
|
|
}
|
|
else if (Sector==6) // Sector 6: t1=-Y and t2=-Z (abc ---> Tc,Ta,Tb)
|
|
{
|
|
t1 = -Vb;
|
|
t2 = -Vc;
|
|
v->Tc = _IQdiv2((_IQ(1)-t1-t2)); // tcon = (1-t1-t2)/2
|
|
v->Ta = v->Tc+t1; // taon = tcon+t1
|
|
v->Tb = v->Ta+t2; // tbon = taon+t2
|
|
}
|
|
|
|
// Convert the unsigned GLOBAL_Q format (ranged (0,1)) -> signed GLOBAL_Q format (ranged (-1,1))
|
|
v->Ta = _IQmpy2(v->Ta - _IQ(0.5));
|
|
v->Tb = _IQmpy2(v->Tb - _IQ(0.5));
|
|
v->Tc = _IQmpy2(v->Tc - _IQ(0.5));
|
|
|
|
if (v->Ta > iq_max) v->Ta = iq_max;
|
|
if (v->Tb > iq_max) v->Tb = iq_max;
|
|
if (v->Tc > iq_max) v->Tc = iq_max;
|
|
|
|
if (v->Ta < -iq_max) v->Ta = -iq_max;
|
|
if (v->Tb < -iq_max) v->Tb = -iq_max;
|
|
if (v->Tc < -iq_max) v->Tc = -iq_max;
|
|
|
|
}
|
|
|
|
|