数字锁相环 逆变器 程序

//DSPIC30F2010 单相逆变带数字锁相环程序#include <p30f2010.h> //中断优先级还没设置，先t2，t1，spwm，其他#include <timer.h>#include <math.h>#include "lcd.h"#define _T1ON T1CONbits.TON#define _T2ON T2CONbits.TON_FOSC(CSW_FSCM_OFF & XT_PLL8);_FWDT(WDT_OFF);_FBORPOR( RST_PWMPIN& PWMxH_ACT_HI& PWMxL_ACT_HI&PBOR_OFF & MCLR_EN);_FGS(CODE_PROT_OFF);void IC2_INI(void);void T2_INI(void);void PWM_INI(void);void AD_INI(void);void T1_INI(void);void PWM_CAL(unsigned int ,unsigned int k,unsigned int a );void IOUT_PROTECT(void);void US_PROTECT(void);void PROTECT_RE(void);void PID_CAL(void);void smooth_test(unsigned int ,unsigned int );void smooth_3_test(unsigned int a,unsigned int b,unsigned int c);unsigned int IC2_0,IC2_1; //捕捉周期用，前后相减unsigned long CAP_T,CAP_T_0; //捕捉得到的周期，不过有分频，记得<<3 unsigned int CAP_N,PWM_N,AD_N,T1_N;unsigned int AD0,AD1; //ADCBUF的结果读到这里来，采样满64次后，转存并清空，记得清空unsigned int UD,US,AD_N_200,AD_N_50; //AD转存的数据，供外部计算用,64次计数到位unsigned int AD2,AD3,IOUT,UO; //正弦波采样采用均方根的方法要用32位变量来存，ad结果和转存数unsigned int Kp,Ki,Ud0,Ud1,Us0,Us1; //pid环节数，和2次处理的采样电压数据unsigned int UD_10,US_10,IOUT_10,UO_10; //采样结果，转换为10位的有效值，unsigned int RE_DELAY; //保护后延迟计数，计数1时，等于一个周波50个约1sunsigned char PROTECT_FLAG; //保护标志位unsigned int io_10_0,io_10_1,io_10_2,io_10_max_temp,io_10_max,smooth_fail_n; //电流采样的全局变量const unsigned int d1[100]= //0~90度份100份的正弦{515 ,1544 ,2573 ,3601 ,4629 ,5655 ,6680 ,7703 ,8724 ,9743 ,10760 ,11774 ,12785 ,13793 ,14798 ,15799 ,16796 ,17789 ,18778 ,19762 ,20741 ,21715 ,22683 ,23646 ,24603 ,25554 ,26499 ,27437 ,28369 ,29293 ,30210 ,31120 ,32022 ,32916 ,33803 ,34680 ,35549 ,36410 ,37261 ,38103 ,38936 ,39760 ,40573 ,41376 ,42170 ,42952 ,43724 ,44486 ,45236 ,45976 ,46703 ,47420 ,48125 ,48817 ,49498 ,50167 ,50823 ,51467 ,52097 ,52716 ,53321 ,53913 ,54491 ,55056 ,55608 ,56146 ,56670 ,57180 ,57676 ,58158 ,58625 ,59078 ,59516 ,59940 ,60349 ,60742 ,61121 ,61485 ,61834 ,62167 ,62486 ,62788 ,63075 ,63347 ,63603 ,63843 ,64068 ,64277 ,64470 ,64647 ,64808 ,64953 ,65082 ,65195 ,65292 ,65372 ,65437 ,65485 ,65518 ,65534 ,};unsigned int PWM_N,k,a; //n=当前在的段的位置,k映射到0~99的查表位置,a变比后期主要控制这个unsigned long temp;//*************************************************//主程序//**************************************************int main(void){LCD_Init();LCD_WRITE_8BIT(LINE1,CMD);DISP_10(78);PWM_INI();AD_INI();T1_INI();// T2_INI();// _T2ON=1;// IC2_INI();// _IC2IE=1;_T1ON=1;_T1IE=1;_ADON=1;_ADIF=0;_ADIE=1;a=32768;//while(_IC2IF==0) //过零点时启动pwm _PTEN=1;_PWMIE=1;_PWMIP=7;Ki=60;Kp=7;IOUT_10=1;while(1){LCD_WRITE_8BIT(LINE1,CMD);DISP_10(IOUT_10);DISP_10(UD_10);nop;delay1ms(200);}}//*************************************//捕捉初始化程序，IC1 IC2//**************************************void IC2_INI(void){ _TRISD1=1;//IC2CONIC2CONbits.ICSIDL=0; //空闲运行IC2CONbits.ICTMR=1; //1=采样tmr2，0=采样tmr3IC2CONbits.ICI=0B00; //每1次捕捉中断//IC2CONbits.ICOV //只读，溢出//IC2CONbits.ICBNE //只读，缓冲器非空IC2CONbits.ICM=0B011; //每一个上升沿捕捉一次//000=关闭捕捉_IC2IF=0;_IC2IE=0;}//*******************************************//T2初始化，为ic2提供时基//*******************************************void T2_INI(void){T2CONbits.TON=0; //设置前关闭T2CONbits.TSIDL=0; //空闲运行T2CONbits.TGATE=0; //门控计数禁止T2CONbits.TCKPS=0B01; //1:8T2CONbits.T32=0; //禁止32位计数T2CONbits.TCS=0; //内部时钟源TMR2=0; //初始化计数值PR2=49999; //周期满，就是不周期T2CONbits.TON=0; //定时器工作_T2IF=0;_T2IE=0;}//******************************************//IC2捕捉中断程序,锁频锁相用；入口参数IC2BUF,出口参数PTPER,PWM_N//*******************************************void __attribute__ ((interrupt)) _IC2Interrupt(void){_IC2IF=0;PWM_N=200; //实现锁相IC2_0=IC2_1;IC2_1=IC2BUF;CAP_T_0=CAP_T;if(IC2_0<IC2_1)CAP_T=(long)IC2_1+50000-IC2_0;else CAP_T=(long)IC2_1+100000-IC2_0;if(CAP_T<CAP_T_0+64 && CAP_T>CAP_T_0-64) return;PTPER=(CAP_T<<3)/400-1; //重新设置pwm周期，实现锁频// PWM_N=200; //实现锁相PR1=(CAP_T<<3)/200-1; //定时器1 ，1：1分频，一个周期分为64份，为ad提供出发时间//这里把PR1的结果多减去几个，这样一个周期完成，使得定时器的时间多点，//要是少了就麻烦，采样次数会少一个，这样对电流采样是要守相位的很不利，//于是把它减小几个，这样在pwm_n=0是，定时器会多点时间，把时间清掉，就可以保证相位了。

必须保证最大值在相位区间内//结果在pwm中断中开始相位补偿，这里就不补了，要不然这个数不好确定CAP_N++;if(CAP_N==64)CAP_N=0;return;}//**********************************************void __attribute__ ((interrupt)) _PWMInterrupt(void)//**********************************************{_PWMIF=0; //_PWMIF=0;/* if(PWM_N==0) //把t1 的ad时间清理，保住采样相位，对才交流有效，这里进行相位补偿，多减少加{ //无论这里pwm_N=多少，都没关系，只要一个周期进行一次时间补偿就行了。

if(TMR1<(PR1>>1)) TMR1=0;else TMR1=PR1-10;}*/if(PWM_N<100){k=PWM_N;PWM_CAL(PWM_N,k,a);}else if(PWM_N<200){k=200-PWM_N-1;PWM_CAL(PWM_N,k,a);}else if(PWM_N<300){k=PWM_N-200;//负数的PWM_CAL(PWM_N,k,a);}else if(PWM_N<400){k=400-PWM_N-1;PWM_CAL(PWM_N,k,a);}PWM_N++;if(PWM_N==400)PWM_N=0;_PWMIF=0;}//*****************************************************void PWM_CAL(unsigned int n,unsigned int k,unsigned int a ) //占空比计算，调用= PWM_CAL(n,k,a);//*****************************************************{unsigned int _sin,tempd; //a=变比，_sin=查表得正弦值，tempd=a*_sin>>17；unsigned long a_sin,temppdc; //a_sin=a*_sin,temppdc=PTPER*tempd;_sin=d1[k];//PDC1=PTPER*(1+-a*_sin）// ***<<32// a、_sin 小于1，都扩大2^16倍，a_sin=a;a_sin=a_sin*_sin; //计算结果为32位a_sin=a_sin>>17;//移动后是15位***>>17tempd=a_sin; //结果存起来if( n<200)tempd=32768+tempd; //加1，结果为16位;1被扩大了2^15倍，两个15位数相加为16位；else tempd=32768-tempd;temppdc=(PTPER+1); //_16*_16为_32temppdc=temppdc*tempd;temppdc=temppdc>>15; //结果>>16得到16位要的结果***>>15 （**扩大和缩小移位刚好全抵消**）。