// 該程序用于簡單的SVPWM演示，產(chǎn)生3相互差120度電角度的正弦交流電壓，此程序實
// 時計算cmp1和cmp2的值
#include 		"register.h"
#include 		"float.h"
#include 		"math.h"
float		ualfa[200],ubeta[200]; // 存儲電壓矢量Uout的（α，β）軸分量ualfa、ubeta的數(shù)組
int			sector[200];		   // 定義存儲扇區(qū)數(shù)的數(shù)組
#define	 	PI2		2*3.1415926    // 定義2π的值
#define	 	DETA	PI2/200        // 定義相臨兩個Uout之間的電角度的差值
#define	 	INIA	3.1415926/180  // 定義Uout的初始電角度
#define	 	TP      1200   	       // t1的周期寄存器的值，其值等于SVPWM調制周期T的一半，
			            		   // 因為在該程序中2π電角度內Uout的點數(shù)一定，故改變此值
                         		   // 可以改變輸出的3相正弦交流電壓的頻率
#define	 	KP      0.7      	   // 定義Uout的標幺值，KP的值在0和1之間，改變此值可以
			             		   // 改變逆變橋輸出電壓的幅值
//  屏蔽中斷子程序
void inline disable()
{
	asm(" setc INTM");
}
// 系統(tǒng)初始化子程序
viod  initial()
{
	*IFR=0xFFFF;				// 清除所有的中斷標志
	*IMR=0X0;  			     	// 屏蔽所有中斷
	*SCSR1=0x81FE;  			// CLKIN=6M，CLKOUT=24M
    	*WDCR=0xE8;     		// 不使能看門狗
	*T3PER=TP;					// 通用定時器1的周期=PWM的周期/指令周期/2
	*T3CON=0X0802;				// 設置通用定時器1為連續(xù)增減模式，以產(chǎn)生對稱的PWM，
		           				// 且為了便于調試，使仿真一掛起時時鐘就停止運行
	*ACTRB=0X666;				// PWM7、9、11高有效，PWM8、10、12低有效
	*COMCONB=0X9200;			// 使能PWM輸出和比較動作
     *EVBIMRA=0X00;				// 禁止EVB和時鐘及比較有關的中斷
	*T3CNT=0X00;				// T1的計數(shù)器清0
	*EVBIFRA=0x0FFFF;			// 清除EVB相應的中斷標志
	*MCRC=*MCRC|0X7E;			// PWM7-PWM12輸出使能，使能IOPE1-IOPE6第二功能   	                                   // 0111 1110
 	WSGR=0x0000;				// 不使能所有的等待狀態(tài)
}
// 根據(jù)Uout的標幺值KP計算ualfa，ubeta子程序
void  calu()
{
	int	i;
	for(i=0;i<200;i++)
	{
		ualfa[i]=KP*cos(INIA+i*DETA);
		ubeta[i]=KP*sin(INIA+i*DETA);
	}
}
// 各點的扇區(qū)確定子程序
void  SECTOR()
{
	int	i,a,b,c;
	float	vref1,vref2,vref3;
	for(i=0;i<200;i++)
	{
		vref1=ubeta[i]；
		vref2=(-ubeta[i]+ualfa[i]*1.732051)/2;
		vref3=(-ubeta[i]-ualfa[i]*1.732051)/2;	// 計算確定扇區(qū)數(shù)需要的3個參考量
	// vref1、vref2、vref3
		if(vref1>0)		a=1;
		else	a=0;
		if(vref2>0)		b=1;
		else	b=0;
		if(vref3>0)		c=1;
		else	c=0;
		a=4*c+2*b+a;
		switch(a)
		{
			case 1:sector[i]=1;break;
			case 2:sector[i]=5;break;
			case 3:sector[i]=0;break;
			case 4:sector[i]=3;break;
			case 5:sector[i]=2;break;
			case 6:sector[i]=4;break;
			default:break;
		}						// 根據(jù)相應的關系確定各個Uout所在的扇區(qū)
	}
}
// 主程序
main()
{
	int	anticlk[6]={0x1666,0x3666,0x2666,0x6666,0x4666,0x5666};
	// 逆時針旋轉的6個基本矢量
	int	i,k=0,cmp1,cmp2;
	float 	x,y,z;
	disable();							// 屏蔽所有中斷
	initial();							// 系統(tǒng)初始化
	calu();							// 計算ualfa，ubeta的值
	SECTOR();						// 確定各點的扇區(qū)，在實際應用時應該由即時
	// 的ualfa和ubeta即時算出
	while(1)
	{
		for(i=0;i<200;i++)
		{
			*ACTRB=anticlk[sector[i]];		// 重新裝配ACTRB
			x=ubeta[i];
			y=(1.732051*ualfa[i]+ubeta[i])/2;
			z=(-1.732051*ualfa[i]+ubeta[i])/2;	// 以上3句計算3個相應的參考量
			switch(sector[i])
			{
				case 0 :cmp1=(int)(-z*TP),cmp2=(int)(x*TP) ;break;
				case 1 :cmp1=(int)(y*TP) ,cmp2=(int)(z*TP) ;break;
				case 2 :cmp1=(int)(x*TP) ,cmp2=(int)(-y*TP);break;
				case 3 :cmp1=(int)(z*TP) ,cmp2=(int)(-x*TP);break;
				case 4 :cmp1=(int)(-y*TP),cmp2=(int)(-z*TP);break;
				case 5 :cmp1=(int)(-x*TP),cmp2=(int)(y*TP) ;break;
				default : break;
			}	// 以上根據(jù)uout所處的扇區(qū)計算相應的cmp1和cmp2的值
			*CMPR4=cmp1;			// 比較寄存器4賦值
			*CMPR5=cmp1+cmp2;		// 比較寄存器5賦值
			if((i+k)==0)		*T3CON=*T3CON|0X040;	// 啟動定時器，只啟動一次
			while(1)
			{
				k=*EVBIFRA&0X0200;
				if(k==0x0200)	break;	// 如果T3的中斷標志建立，則停止等待
			}
		}
	}
}
// 如果由于干擾引起中斷，則執(zhí)行此直接返回程序
void interrupt nothing()
{
	return;
}