dspic33fj12mc202

**truongtulong** · 03-11-2009, 06:12 AM

em đang dùng con dspic33fj12mc202 để điều khiển động cơ AC 1 pha dùng ngắt PWM. Nhưng khi mô phỏng trên proteus thì ko ra đc tín hiệu. Mong các bác chỉ giúp, dưới đây là code chương trình em viết bằng C30

Code:

#include <p33fj12mc202.h>
#include <pwm.h>
#include <pwm12.h>
#define Ts 830
_FOSCSEL(FNOSC_PRIPLL&IESO_OFF);//dung dao dong ngoai co bo PLL
_FOSC(FCKSM_CSDCMD&OSCIOFNC_OFF&POSCMD_XT);//chon che do XT
_FWDT(FWDTEN_OFF);//tat watchdog
_FPOR(PWMPIN_ON&HPOL_ON&LPOL_ON);//cac chan ra dieu khien boi PORT luc reset,deu co the cao
unsigned int i=0;
unsigned int k,j;
unsigned int Int_k;
unsigned int up=0.0008;
unsigned int down=0.0008;
unsigned int Voltage_Value1 = 0;
unsigned int Voltage_Value2 = 0;
float Float_k,temp,Voltage_Value;
float F_req=0;
float ADC_Value;
float const SinValue[720]={0,0.0087,0.0175,0.0262,0.0349,0.0436,0.0523,0.061,0.0698,0.0785,0.0872,0.0958,0.1045,0.1132,0.1219,0.1305,
0.1392,0.1478,0.1564,0.165,0.1736,0.1822,0.1908,0.1994,0.2079,0.2164,0.225,0.2334,0.2419,0.2504,0.2588,0.2672,0.2756,0.284,0.2924,
0.3007,0.309,0.3173,0.3256,0.3338,0.342,0.3502,0.3584,0.3665,0.3746,0.3827,0.3907,0.3987,0.4067,0.4147,0.4226,0.4305,0.4384,0.4462,
0.454,0.4617,0.4695,0.4772,0.4848,0.4924,0.5,0.5075,0.515,0.5225,0.5299,0.5373,0.5446,0.5519,0.5592,0.5664,0.5736,0.5807,0.5878,0.5948,
0.6018,0.6088,0.6157,0.6225,0.6293,0.6361,0.6428,0.6494,0.6561,0.6626,0.6691,0.6756,0.682,0.6884,0.6947,0.7009,0.7071,0.7133,0.7193,
0.7254,0.7314,0.7373,0.7431,0.749,0.7547,0.7604,0.766,0.7716,0.7771,0.7826,0.788,0.7934,0.7986,0.8039,0.809,0.8141,0.8192,0.8241,0.829,
0.8339,0.8387,0.8434,0.848,0.8526,0.8572,0.8616,0.866,0.8704,0.8746,0.8788,0.8829,0.887,0.891,0.8949,0.8988,0.9026,0.9063,0.91,0.9135,
0.9171,0.9205,0.9239,0.9272,0.9304,0.9336,0.9367,0.9397,0.9426,0.9455,0.9483,0.9511,0.9537,0.9563,0.9588,0.9613,0.9636,0.9659,0.9681,
0.9703,0.9724,0.9744,0.9763,0.9781,0.9799,0.9816,0.9833,0.9848,0.9863,0.9877,0.989,0.9903,0.9914,0.9925,0.9936,0.9945,0.9954,0.9962,
0.9969,0.9976,0.9981,0.9986,0.999,0.9994,0.9997,0.9998,1,1,1,0.9998,0.9997,0.9994,0.999,0.9986,0.9981,0.9976,0.9969,0.9962,0.9954,
0.9945,0.9936,0.9925,0.9914,0.9903,0.989,0.9877,0.9863,0.9848,0.9833,0.9816,0.9799,0.9781,0.9763,0.9744,0.9724,0.9703,0.9681,0.9659,
0.9636,0.9613,0.9588,0.9563,0.9537,0.9511,0.9483,0.9455,0.9426,0.9397,0.9367,0.9336,0.9304,0.9272,0.9239,0.9205,0.9171,0.9135,0.91,
0.9063,0.9026,0.8988,0.8949,0.891,0.887,0.8829,0.8788,0.8746,0.8704,0.866,0.8616,0.8572,0.8526,0.848,0.8434,0.8387,0.8339,0.829,0.8241,
0.8192,0.8141,0.809,0.8039,0.7986,0.7934,0.788,0.7826,0.7771,0.7716,0.766,0.7604,0.7547,0.749,0.7431,0.7373,0.7314,0.7254,0.7193,0.7133,
0.7071,0.7009,0.6947,0.6884,0.682,0.6756,0.6691,0.6626,0.6561,0.6494,0.6428,0.6361,0.6293,0.6225,0.6157,0.6088,0.6018,0.5948,0.5878,
0.5807,0.5736,0.5664,0.5592,0.5519,0.5446,0.5373,0.5299,0.5225,0.515,0.5075,0.5,0.4924,0.4848,0.4772,0.4695,0.4617,0.454,0.4462,0.4384,
0.4305,0.4226,0.4147,0.4067,0.3987,0.3907,0.3827,0.3746,0.3665,0.3584,0.3502,0.342,0.3338,0.3256,0.3173,0.309,0.3007,0.2924,0.284,
0.2756,0.2672,0.2588,0.2504,0.2419,0.2334,0.225,0.2164,0.2079,0.1994,0.1908,0.1822,0.1736,0.165,0.1564,0.1478,0.1392,0.1305,0.1219,
0.1132,0.1045,0.0958,0.0872,0.0785,0.0698,0.061,0.0523,0.0436,0.0349,0.0262,0.0175,0.0087,0,-0.0087,-0.0175,-0.0262,-0.0349,-0.0436,
-0.0523,-0.061,-0.0698,-0.0785,-0.0872,-0.0958,-0.1045,-0.1132,-0.1219,-0.1305,-0.1392,-0.1478,-0.1564,-0.165,-0.1736,-0.1822,-0.1908,
-0.1994,-0.2079,-0.2164,-0.225,-0.2334,-0.2419,-0.2504,-0.2588,-0.2672,-0.2756,-0.284,-0.2924,-0.3007,-0.309,-0.3173,-0.3256,-0.3338,
-0.342,-0.3502,-0.3584,-0.3665,-0.3746,-0.3827,-0.3907,-0.3987,-0.4067,-0.4147,-0.4226,-0.4305,-0.4384,-0.4462,-0.454,-0.4617,-0.4695,
-0.4772,-0.4848,-0.4924,-0.5,-0.5075,-0.515,-0.5225,-0.5299,-0.5373,-0.5446,-0.5519,-0.5592,-0.5664,-0.5736,-0.5807,-0.5878,-0.5948,
-0.6018,-0.6088,-0.6157,-0.6225,-0.6293,-0.6361,-0.6428,-0.6494,-0.6561,-0.6626,-0.6691,-0.6756,-0.682,-0.6884,-0.6947,-0.7009,-0.7071,
-0.7133,-0.7193,-0.7254,-0.7314,-0.7373,-0.7431,-0.749,-0.7547,-0.7604,-0.766,-0.7716,-0.7771,-0.7826,-0.788,-0.7934,-0.7986,-0.8039,
-0.809,-0.8141,-0.8192,-0.8241,-0.829,-0.8339,-0.8387,-0.8434,-0.848,-0.8526,-0.8572,-0.8616,-0.866,-0.8704,-0.8746,-0.8788,-0.8829,
-0.887,-0.891,-0.8949,-0.8988,-0.9026,-0.9063,-0.91,-0.9135,-0.9171,-0.9205,-0.9239,-0.9272,-0.9304,-0.9336,-0.9367,-0.9397,-0.9426,
-0.9455,-0.9483,-0.9511,-0.9537,-0.9563,-0.9588,-0.9613,-0.9636,-0.9659,-0.9681,-0.9703,-0.9724,-0.9744,-0.9763,-0.9781,-0.9799,-0.9816,
-0.9833,-0.9848,-0.9863,-0.9877,-0.989,-0.9903,-0.9914,-0.9925,-0.9936,-0.9945,-0.9954,-0.9962,-0.9969,-0.9976,-0.9981,-0.9986,-0.999,
-0.9994,-0.9997,-0.9998,-1,-1,-1,-0.9998,-0.9997,-0.9994,-0.999,-0.9986,-0.9981,-0.9976,-0.9969,-0.9962,-0.9954,-0.9945,-0.9936,-0.9925,
-0.9914,-0.9903,-0.989,-0.9877,-0.9863,-0.9848,-0.9833,-0.9816,-0.9799,-0.9781,-0.9763,-0.9744,-0.9724,-0.9703,-0.9681,-0.9659,-0.9636,
-0.9613,-0.9588,-0.9563,-0.9537,-0.9511,-0.9483,-0.9455,-0.9426,-0.9397,-0.9367,-0.9336,-0.9304,-0.9272,-0.9239,-0.9205,-0.9171,-0.9135,
-0.91,-0.9063,-0.9026,-0.8988,-0.8949,-0.891,-0.887,-0.8829,-0.8788,-0.8746,-0.8704,-0.866,-0.8616,-0.8572,-0.8526,-0.848,-0.8434,-0.8387,
-0.8339,-0.829,-0.8241,-0.8192,-0.8141,-0.809,-0.8039,-0.7986,-0.7934,-0.788,-0.7826,-0.7771,-0.7716,-0.766,-0.7604,-0.7547,-0.749,
-0.7431,-0.7373,-0.7314,-0.7254,-0.7193,-0.7133,-0.7071,-0.7009,-0.6947,-0.6884,-0.682,-0.6756,-0.6691,-0.6626,-0.6561,-0.6494,-0.6428,
-0.6361,-0.6293,-0.6225,-0.6157,-0.6088,-0.6018,-0.5948,-0.5878,-0.5807,-0.5736,-0.5664,-0.5592,-0.5519,-0.5446,-0.5373,-0.5299,-0.5225,
-0.515,-0.5075,-0.5,-0.4924,-0.4848,-0.4772,-0.4695,-0.4617,-0.454,-0.4462,-0.4384,-0.4305,-0.4226,-0.4147,-0.4067,-0.3987,-0.3907,
-0.3827,-0.3746,-0.3665,-0.3584,-0.3502,-0.342,-0.3338,-0.3256,-0.3173,-0.309,-0.3007,-0.2924,-0.284,-0.2756,-0.2672,-0.2588,-0.2504,
-0.2419,-0.2334,-0.225,-0.2164,-0.2079,-0.1994,-0.1908,-0.1822,-0.1736,-0.165,-0.1564,-0.1478,-0.1392,-0.1305,-0.1219,-0.1132,-0.1045,
-0.0958,-0.0872,-0.0785,-0.0698,-0.061,-0.0523,-0.0436,-0.0349,-0.0262,-0.0175,-0.0087};
void Init_PWM(void);
void Init_ADC10(void);
unsigned int Read_ADC(void);
void Step_Calculate(void);
void Voltage_Calculate(void);
void Update_PDC(void);
int main(void)
   { 
     PLLFBD = 41;
     _PLLPOST = 0;
     _PLLPRE = 0;
     while (_COSC !=0b011);//dung bo PLL tao Fosc=80MHz,cho cho dao dong on dinh
     while (_LOCK !=1);//cho PLL bat dau khoa pha
     TRISB=0X0000;
     LATB=0X0000;
     Init_ADC10();
     Init_PWM();
     while(1);
   }
void Init_PWM(void)
    {
     P1TCONbits.PTMOD = 0b10;//continuous up/down cout mode
     P1TCONbits.PTCKPS = 0b01;//prescale 4Tcy
     P1TCONbits.PTOPS = 0b0000;//postscale 1:1
     P1TPER = Ts;//Fpwn = 6kHz
     PWM1CON1bits.PMOD1=0;//complementary mode
     PWM1CON1bits.PMOD2=0;
     PWM1CON1bits.PEN2H=1;//enable for PWM output
     PWM1CON1bits.PEN1H=1;
     PWM1CON1bits.PEN2L=1;
     PWM1CON1bits.PEN1L=1;
     PWM1CON2bits.IUE=0;
     PWM2CON2bits.UDIS=0;//update from duty cycle and period buffer registers are enabled
     P1DTCON1bits.DTAPS=0b00;//Dead time prescale 1:1
     P1DTCON1bits.DTA = 40;//deadtime = 1um
     P1DTCON1bits.DTBPS=0b00;
     P1DTCON1bits.DTB = 0;
     P1DTCON2bits.DTS2A=0;//Unit A selected for PWM active transitions
     P1DTCON2bits.DTS1A=0;
     P1DTCON2bits.DTS1I=0;//Unit B selected for PWM inactive transitions
     P1DTCON2bits.DTS2I=0;
     P1OVDCONbits.POVD2H=1;//PWM I/O pin controlled by PWM generator
     P1OVDCONbits.POVD1H=1;
     P1OVDCONbits.POVD2L=1;
     P1OVDCONbits.POVD1L=1;
     P1DC1=0;
     P1DC2=0;
     _PWM1IF=0;
     _PWM1IE=1;
     P1TCONbits.PTEN=1;
    }
void Init_ADC10(void) 
    {
    AD1PCFGL = 0xFFF0;		//Cac chan khac la digital, chan AN0/RA0 la analog

    //Cau hinh thanh ghi AD1CON1
	AD1CON1bits.ADON=0;
	AD1CON1bits.ADSIDL=0; //Tiep tuc hoat dong o che do ko tai
    AD1CON1bits.AD12B=0; //Che do ADC-10bit
	AD1CON1bits.FORM=0b00; //Du lieu ra o che do unsigned integer (DOUT = 0000 00dd dddd dddd)
	AD1CON1bits.SSRC=0b011; //Chuyen doi ADC khi xay ra ngat PWM1
	AD1CON1bits.SIMSAM=0; //Mau nhieu kenh
	AD1CON1bits.ASAM=0;  //Bat dau lay mau khi bit Sam dc thiet lap
	AD1CON1bits.SAMP=0;  //Lay mau va giu roi khuyech dai
	AD1CON1bits.DONE=0;  //ADC chuy?n d?i không b?t d?u ho?c trong quá trình


	AD1CON2 = 0x0000;
	AD1CHS0 = 0x0000;		//Kenh 0 doc tin hieu giua AN0 va AVss
	AD1CSSL = 0x0000;		//Khong quet cac ngo vao
	AD1CON3 = 0x0103;		//Dung 1 TAD cho lay mau, dung clock he thong,
							//TAD = 4xTcy

	_ADON = 1;				//Bat module ADC
	_ASAM = 1;				//Khoi dong che do tu dong lay mau
    }
void Update_PDC(void)
    {             
     if(i>719)
              {
               i=i-720;
               Voltage_Value1 = Voltage_Value*SinValue[i];
              } 
     else                  
          {
           Voltage_Value1 = Voltage_Value*SinValue[i];
          } 
     j=h+359;
     if(j>719)
              { 
               j=j-720;
               Voltage_Value2 = Voltage_Value*SinValue[j];
              } 
     else
          {
           Voltage_Value2 = Voltage_Value*SinValue[j];
          }                       
     P1DC1 = 830 + Voltage_Value1;
     P1DC2 = 830 + Voltage_Value2;
     i=i+k;
    }	
//tinh gia tri buoc nhay
void Step_Calculate(void)
    {
     Float_k=0.12*F_req;
     Int_k=Float_k;
     temp=Float_k-Int_k;
     if(temp>=0.5)
                  {
                   k=Float_k+0.5;
                  }
     else
         {
          k=Int_k;
         }
    }  
//tinh dien ap khi f thay doi
void Voltage_Calculate(void)
    {
     Voltage_Value=F_req/0.0601;
     if(Voltage_Value>=800)
                          {
                           Voltage_Value=800;
                          }
    }
//Doc gia tri chuyen doi ADC
unsigned int Read_ADC(void) 
            {
             while(_DONE == 0);//cho chuyen doi xong
             return ADC1BUF0;//tra gia tri
            } 
//ngat PWM   
void __attribute__((interrupt,auto_psv)) _MPWM1Interrupt(void)
    {
	 _PWM1IF=0;
     Read_ADC();
     ADC_Value=Read_ADC()*0.0488;
     if(F_req>ADC_Value)
                                  {
                                   F_req=F_req-down;
                                   if(F_req<=ADC_Value)
                                                       {
                                                        F_req=ADC_Value;
                                                       }
                                  } 
     else
         {
          F_req=F_req+up;
          if(F_req>=ADC_Value)
                              {
                               F_req=ADC_Value;
                              }
         } 
     Step_Calculate();
     Voltage_Calculate();
     Update_PDC();