锁相锁的是每个采样点此刻电网电压的相位。这个相位是0到360度变化的。锁上的话,VD是311,VQ是0。(VD在311上下浮动,VQ在0上下浮动)
DQ锁相片段程序:
wVacAngle90[uwAngle90Cnt] = GridVoltAdc/cGridVoltFactor;///GridVoltAdc;
table2[i]=GridVoltAdc/32;
table1[i] = GridVolt/32;
i++;
if(i>=360)i=0;
uwAngle90Cnt++;
if(uwAngle90Cnt >= uw1Over4SinNum) //
{
uwAngle90Cnt = 0;
}
wVacPhaPll = GridVoltAdc/cGridVoltFactor ;//GridVoltAdc;
wVacBetaPll = wVacAngle90[uwAngle90Cnt];
//dq transform
wVdPll = ((int32_t)wVacPhaPll*wCosTheta + (int32_t)wVacBetaPll * wPFCSinTheta)/32768; //>>15
wVqPll = ((int32_t)wVacBetaPll*wCosTheta - (int32_t)wVacPhaPll * wPFCSinTheta )/32768;
//PLL PI
dwOmg += (int32_t)wVqPll * cPllKi + (int32_t)(wVqPll-wVqPllOld) * cPllKp; //clhtest 加了old
wVqPllOld = wVqPll;
mApplyLimits(dwOmg, -40000000, 40000000);
dwtempTheta += (dwOmg/2048) + udwPLLbaseStep; //
while(dwtempTheta >= cPllThetaLimitQ13)
{
dwtempTheta = dwtempTheta - cPllThetaLimitQ13;
}
while(dwtempTheta < 0)
{
dwtempTheta = dwtempTheta + cPllThetaLimitQ13;
}
wTheta = dwtempTheta/8192; ///>> 13;
wVdSumPll = wVdPll + wVdSumPll - (wVdSumPll/2048); //Ud filter
wVdPll = wVdSumPll/2048;