DQ锁相

锁相锁的是每个采样点此刻电网电压的相位。这个相位是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;