Giúp em phần lập trình mạch PFC với!

[cuongthinh]

Em đang làm mạch này mà lập trình mãi nó vẫn không chạy cho. Một tuần nữa em phải bảo vệ tốt nghiệp về cái này rồi mà kô tìm ra lỗi ở đâu! Mong các cao thủ giúp em với?
Chân PWM ra của em đã có xung ra nhưng kô đúng theo ý muốn em cũng kô hiểu tại sao nữa, hic

Chương trình của em đây:

#include <p30f4011.h>
#include <dsp.h>
#include <math.h>

_FOSC(CSW_FSCM_OFF & FRC_PLL16);
_FWDT(WDT_OFF);
_FBORPOR(PBOR_OFF & MCLR_EN);
_FGS(CODE_PROT_OFF);

//------------------------------------------------------------------------------
//Cac hang so cua chuong trinh (gia tri tuc thoi dung trong chuong trinh)

#define Fcy 32000000 //Tan so thuc thi lenh
#define Fpwm 40000 //Tan so PWM = 40 kHz
#define vOutmax Q15(0.9)
#define vOutmin Q15(0.1)
#define iOutmax Q15(0.9)
#define iOutmin Q15(0.1)

//Cac prototype cho cac chuong trinh con
void Init_PORTS(void);
void Init_MCPWM(void);
void Init_ADC10(void);
void CalciPI( fractional iInRef, fractional iInMeas);
void CalcvPI( fractional vInRef, fractional vInMeas);
void InitiPI(void);
void InitvPI(void);

//Cac bien toan cuc
fractional Vo,Vac,Iac,Vcom,vPI,Iref,Vavg;
fractional iSum, iExc, iErr;
fractional vSum, vExc, vErr;
fractional iU, iOut, vU, vOut;
int n,m,k;
unsigned int duty;
//------------------------------------------------------------------------------
//Chuong trinh chinh
int main(void) {

void InitvPI();
void InitvPI();
Init_PORTS(); //Khoi tao cac cong I/O
Init_MCPWM(); //Khoi tao module PWM
Init_ADC10();
while(1) Nop();
}

//Chuong trinh con khoi tao cac cong I/O, de xuat cac tin hieu PWM, va doc tin
//hieu dieu chinh cua bien tro tai AN0
void Init_PORTS(void) {
LATE = 0; //Xoa thanh ghi chot cac tin hieu PWM
TRISE = 0; //Tin hieu PWM nam tai RE0
TRISB = 0x0007; //RB0 den RB2 la ngo vao, cac chan RB khac la ngo ra
}

//Chuong trinh con khoi tao module chuyen doi A/D
// AN0 phan hoi Vac, AN1 phan hoi Iac, AN2 phan hoi Vo
void Init_ADC10(void) {
ADPCFG = 0b1111111111111000; // RB0,RB1,RB2 = analog input
ADCON1 = 0b0000001001101100; // SIMSAM bit = 1 implies ...
// simultaneous sampling
// ASAM = 1 for auto sample after convert
// SSRC = 011 for PWM trigger
// integer output
ADCSSL=0x0007; // Lan luot quét ANO, AN1, AN2 kéet qua lan luot luu vao ADCBUF0->2
ADCON3 = 0x0302; // Auto Sampling 3 Tad, Tad = internal 2 Tcy
ADCON2 = 0b0000010000001000; // CHPS= 00 Convert CHO
// SMPI = 0010 for interrupt after 3 converts
// CSCNA=1 scan input
ADCHS=0;
_ADIF = 0; //Xoa co ngat ADC
_ADIE = 1; //Cho phep ngat ADC
_ASAM = 1; //Khoi dong che do tu dong lay mau
ADCON1bits.ADON = 1; // turn ADC ON
}

//Chuong trinh con khoi tao module PWM
void Init_MCPWM(void) {
PTPER = Fcy/Fpwm-1; //Dat thanh ghi chu ky voi tan so PWM = 40 kHz
SEVTCMP = PTPER;
PWMCON1 = 0x070F; //Chi dung cac chan PxL, mot cach doc lap
OVDCON = 0xFF00; //Khong dung overdrive
PDC1 = 200; //Khoi tao PWM1, 2, va 3 la 25%
PWMCON2 = 0x0F00; //Postscale = 1:10
PTCON = 0x8000; //Kich hoat module PWM
}

void CalciPI( fractional iInRef, fractional iInMeas)
{ iErr = iInRef - iInMeas;
iU = iSum + Q15(8.174) * iErr; //kpz = 8.174 = 0.00025 fraction
if( iU > iOutmax ) iOut = iOutmax;
else {
if( iU < iOutmin ) iOut = iOutmin;
else iOut = iU ;
}
iSum = iSum + Q15(4.266)*iErr; //kiz = 4.266 = 0.00013 fraction
}

void CalcvPI( fractional vInRef, fractional vInMeas)
{ vErr = vInRef - vInMeas;
vU = vSum + Q15(49.36) * vErr; //kpz = 49.36 = 0.0015 fraction
if( vU > vOutmax ) vOut = vOutmax;
else {
if( vU < vOutmin ) vOut = vOutmin;
else vOut = vU ;
}
vSum = vSum + Q15(48.0)*vErr; //kiz = 48 = 0.001465 fraction
}

void InitvPI(void)
{
vSum = 0;
vOut = 0;
}

void InitiPI(void)
{
iSum = 0;
iOut = 0;
n = 0;
k = 0;
}


//Trinh phuc vu ngat cho ADC

void __attribute__((__interrupt__ , auto_psv)) _ADCInterrupt(void)
{
Vac = ADCBUF0; //4kHz
Vavg = Vavg + Vac;
if (k=40) { Vcom = Q15(1)/(Vavg*Vavg); k = 0; }
else (k++);
if (n=40) Vo = ADCBUF2; // tao bien dem de duoc Vac voi tan so 100Hz (ADC trich mau voi tan so 4kHz)
else (n++) ;
CalcvPI(Q15(1),Vo); // V_refer = 1V , Tinh toan khau PI ap
vPI = vOut; // Tin hieu ra khau PI ap
Iref = vPI*Vcom*Vac*Q15(2.4); //Voi km=2.4
Iac = ADCBUF1; // Iac voi tan so 4kHz (ADC trich mau voi tan so 4kHz)
CalciPI(Iref,Iac); // Tinh toan Pi dong
// dai luon tham chieu la Iref
// Tin hieu phan hoi la Iac
PDC1 = (unsigned int)((iOut*32768)*2*PTPER); ;// Update thanh ghi chu ki nhiem vu
_ADIF = 0;

}