svpwm源代码.c

SVPWM源代码，TI，28335

// TI File $Revision: /main/8 $
// Checkin $Date: April 21, 2008   15:41:53 $
//###########################################################################
//
// FILE:    Example_2833xEPwmUpDownAQ.c
//
// TITLE:   空间电压矢量产生程序SVPWM
//
// ASSUMPTIONS:
//
//    This program requires the DSP2833x header files.  
//
//    Monitor ePWM1-ePWM3 pins on an oscilloscope as described
//    below.
//
//       EPWM1A is on GPIO0-------5脚
//       EPWM1B is on GPIO1-------6脚
//
//       EPWM2A is on GPIO2-------7脚
//       EPWM2B is on GPIO3-------10脚
//
//       EPWM3A is on GPIO4-------11脚
//       EPWM3B is on GPIO5-------12脚
//

//
//###########################################################################
// $TI Release: DSP2833x/DSP2823x Header Files V1.20 $
// $Release Date: August 1, 2008 $
//###########################################################################


#include "DSP28x_Project.h"     // Device Headerfile and Examples Include File
// Prototype statements for functions found within this file.
void InitEPwm1Example(void);
void InitEPwm2Example(void);
void InitEPwm3Example(void);
void svpwmGen(void);
interrupt void svpwm_isr(void);
volatile float Ualpha,Ubeta;
volatile float A,B,C;
volatile float T0,T1,T2,T3,T4,T5,T6;
volatile float Taon,Tbon,Tcon;
float Ua,Ub,Uc;
float Ts;
int a,b,c;
int N= 0,sector= 0;
#define TPRD 800
#define Udc  800



void main(void)
{
// Step 1. Initialize System Control:
// PLL, WatchDog, enable Peripheral Clocks
// This example function is found in the DSP2833x_SysCtrl.c file.
   InitSysCtrl();

// Step 2. Initalize GPIO: 
// This example function is found in the DSP2833x_Gpio.c file and
// illustrates how to set the GPIO to it's default state.
// InitGpio();  // Skipped for this example  

// For this case just init GPIO pins for ePWM1, ePWM2, ePWM3
// These functions are in the DSP2833x_EPwm.c file
   InitEPwm1Gpio();
   InitEPwm2Gpio();
   InitEPwm3Gpio();   
   
// Step 3. Clear all interrupts and initialize PIE vector table:
// Disable CPU interrupts 
   DINT;

// Initialize the PIE control registers to their default state.
// The default state is all PIE interrupts disabled and flags
// are cleared.  
// This function is found in the DSP2833x_PieCtrl.c file.
   InitPieCtrl();
   
// Disable CPU interrupts and clear all CPU interrupt flags:
   IER = 0x0000;
   IFR = 0x0000;

// Initialize the PIE vector table with pointers to the shell Interrupt 
// Service Routines (ISR).  
// This will populate the entire table, even if the interrupt
// is not used in this example.  This is useful for debug purposes.
// The shell ISR routines are found in DSP2833x_DefaultIsr.c.
// This function is found in DSP2833x_PieVect.c.
   InitPieVectTable();
// Interrupts that are used in this example are re-mapped to
// ISR functions found within this file.  
   EALLOW;  // This is needed to write to EALLOW protected registers
   PieVectTable.EPWM1_INT = &svpwm_isr;
   //PieVectTable.EPWM2_INT = &epwm2_isr;
   //PieVectTable.EPWM3_INT = &epwm3_isr;      
   EDIS;    // This is needed to disable write to EALLOW protected registers

// Step 4. Initialize all the Device Peripherals:
// This function is found in DSP2833x_InitPeripherals.c
// InitPeripherals();  // Not required for this example

// For this example, only initialize the ePWM
   EALLOW;
   SysCtrlRegs.PCLKCR0.bit.TBCLKSYNC = 0;
   EDIS;

   InitEPwm1Example();    
   InitEPwm2Example();
   InitEPwm3Example();
   
   EALLOW;
   SysCtrlRegs.PCLKCR0.bit.TBCLKSYNC = 1;
   EDIS;

// Step 5. User specific code, enable interrupts:

// Enable CPU INT3 which is connected to EPWM1-3 INT:
   IER |= M_INT3;

// Enable EPWM INTn in the PIE: Group 3 interrupt 1-3
   PieCtrlRegs.PIEIER3.bit.INTx1 = 1;
   //PieCtrlRegs.PIEIER3.bit.INTx2 = 1;
   //PieCtrlRegs.PIEIER3.bit.INTx3 = 1;

// Enable global Interrupts and higher priority real-time debug events:
   EINT;   // Enable Global interrupt INTM
   ERTM;   // Enable Global realtime interrupt DBGM   

// Step 6. IDLE loop. Just sit and loop forever (optional):
   for(;;)
   {
       asm("          NOP");
   }

}//main结束 





//=======================================================================

interrupt void svpwm_isr(void)
{

svpwmGen();

// Set Compare values
EPwm1Regs.CMPA.half.CMPA = Taon; // adjust duty for output EPWM1A
EPwm2Regs.CMPA.half.CMPA = Tbon; // adjust duty for output EPWM2A
EPwm3Regs.CMPA.half.CMPA = Tcon; // adjust duty for output EPWM3A
   
// Clear INT flag for this timer
EPwm1Regs.ETCLR.bit.INT = 1;

// Acknowledge this interrupt to receive more interrupts from group 3
PieCtrlRegs.PIEACK.all = PIEACK_GROUP3;

}


void InitEPwm1Example()
{
// Setup TBCLK
EPwm1Regs.TBPRD = TPRD; // TPRD=800,Period = 1600 TBCLK counts
EPwm1Regs.TBPHS.half.TBPHS = 0; // Set Phase register to zero
EPwm1Regs.TBCTR = 0x0000;       // Clear counter
// Setup counter mode
EPwm1Regs.TBCTL.bit.CTRMODE = TB_COUNT_UPDOWN;// Symmetrical mode
EPwm1Regs.TBCTL.bit.PHSEN = TB_DISABLE; //////////////////////////Master module
EPwm1Regs.TBCTL.bit.PRDLD = TB_SHADOW;
EPwm1Regs.TBCTL.bit.SYNCOSEL = TB_CTR_ZERO; ///////////////////// Sync down-stream module
// Setup Tpwm
EPwm1Regs.TBCTL.bit.HSPCLKDIV = TB_DIV2;       // Clock ratio to SYSCLKOUT
EPwm1Regs.TBCTL.bit.CLKDIV = 5;          //原为TB_DIV1， 对于上下计数：Tpwm = 2 x TBPRD x TTBCLK  Fpwm = 1 / (Tpwm)
//Setup shadowing
EPwm1Regs.CMPCTL.bit.SHDWAMODE = CC_SHADOW;
EPwm1Regs.CMPCTL.bit.SHDWBMODE = CC_SHADOW;
EPwm1Regs.CMPCTL.bit.LOADAMODE = CC_CTR_ZERO; // load on CTR=Zero
EPwm1Regs.CMPCTL.bit.LOADBMODE = CC_CTR_ZERO; // load on CTR=Zero
// Set actions
EPwm1Regs.AQCTLA.bit.CAU = AQ_SET; // set actions for EPWM1A
EPwm1Regs.AQCTLA.bit.CAD = AQ_CLEAR;
// Set Dead-band
EPwm1Regs.DBCTL.bit.OUT_MODE = DB_FULL_ENABLE; // enable Dead-band module
EPwm1Regs.DBCTL.bit.POLSEL = DB_ACTV_HIC; // Active Hi complementary
EPwm1Regs.DBFED = 50; // FED = 50 TBCLKs
EPwm1Regs.DBRED = 50; // RED = 50 TBCLKs

// Interrupt where we will change the Compare Values
EPwm1Regs.ETSEL.bit.INTSEL = ET_CTR_ZERO;      // Select INT on Zero event
EPwm1Regs.ETSEL.bit.INTEN = 1;                 // Enable INT
EPwm1Regs.ETPS.bit.INTPRD = ET_3RD;            // Generate INT on 3rd event   
/*
// Set Compare values
//==============================================================
EPwm1Regs.CMPA.half.CMPA = 500; // adjust duty for output EPWM1A
EPwm2Regs.CMPA.half.CMPA = 600; // adjust duty for output EPWM2A
EPwm3Regs.CMPA.half.CMPA = 700; // adjust duty for output EPWM3A
*/

}


void InitEPwm2Example()
{
// Setup TBCLK
EPwm2Regs.TBPRD = TPRD; // TPRD=800,Period = 1600 TBCLK counts
EPwm2Regs.TBPHS.half.TBPHS = 0; // Set Phase register to zero
EPwm2Regs.TBCTR = 0x0000;       // Clear counter
// Setup counter mode
EPwm2Regs.TBCTL.bit.CTRMODE = TB_COUNT_UPDOWN;// Symmetrical mode
EPwm2Regs.TBCTL.bit.PHSEN = TB_ENABLE; ////////////////////////////// Slave module
EPwm2Regs.TBCTL.bit.PRDLD = TB_SHADOW;
EPwm2Regs.TBCTL.bit.SYNCOSEL = TB_SYNC_IN; /////////////////////////// sync flow-through
// Setup Tpwm
EPwm2Regs.TBCTL.bit.HSPCLKDIV = TB_DIV2;       // Clock ratio to SYSCLKOUT
EPwm2Regs.TBCTL.bit.CLKDIV = 5;          // For Up and Down Count--Tpwm = 2 x TBPRD x TTBCLK; Fpwm = 1 / (Tpwm)
// Setup shadowing
EPwm2Regs.CMPCTL.bit.SHDWAMODE = CC_SHADOW;
EPwm2Regs.CMPCTL.bit.SHDWBMODE = CC_SHADOW;
EPwm2Regs.CMPCTL.bit.LOADAMODE = CC_CTR_ZERO; // load on CTR=Zero
EPwm2Regs.CMPCTL.bit.LOADBMODE = CC_CTR_ZERO; // load on CTR=Zero
// Set actions
EPwm2Regs.AQCTLA.bit.CAU = AQ_SET; // set actions for EPWM2A
EPwm2Regs.AQCTLA.bit.CAD = AQ_CLEAR;
// Set Dead-band
EPwm2Regs.DBCTL.bit.OUT_MODE = DB_FULL_ENABLE; // enable Dead-band module
EPwm2Regs.DBCTL.bit.POLSEL = DB_ACTV_HIC; // Active Hi complementary
EPwm2Regs.DBFED = 50; // FED = 50 TBCLKs
EPwm2Regs.DBRED = 50; // RED = 50 TBCLKs
// Interrupt where we will change the Compare Values
EPwm2Regs.ETSEL.bit.INTSEL = ET_CTR_ZERO;      // Select INT on Zero event
EPwm2Regs.ETSEL.bit.INTEN = 1;                 // Enable INT
EPwm2Regs.ETPS.bit.INTPRD = ET_3RD;            // Generate INT on 3rd event   

// Set Compare values

}

void InitEPwm3Example()
{
// Setup TBCLK
EPwm3Regs.TBPRD = TPRD; // TPRD=800,Period = 1600 TBCLK counts
EPwm3Regs.TBPHS.half.TBPHS = 0; // Set Phase register to zero
EPwm1Regs.TBCTR = 0x0000;       // Clear counter
// Setup counter mode
EPwm3Regs.TBCTL.bit.CTRMODE = TB_COUNT_UPDOWN;// Symmetrical mode
EPwm3Regs.TBCTL.bit.PHSEN = TB_ENABLE; //////////////////////////////// Slave module
EPwm3Regs.TBCTL.bit.PRDLD = TB_SHADOW;
EPwm3Regs.TBCTL.bit.SYNCOSEL = TB_SYNC_IN; ////////////////////////////// sync flow-through
// Setup Tpwm
EPwm3Regs.TBCTL.bit.HSPCLKDIV = TB_DIV2;       // Clock ratio to SYSCLKOUT
EPwm3Regs.TBCTL.bit.CLKDIV = 5;          // For Up and Down Count:Tpwm = 2 x TBPRD x TTBCLK; Fpwm = 1 / (Tpwm)
// Setup shadowing
EPwm3Regs.CMPCTL.bit.SHDWAMODE = CC_SHADOW;
EPwm3Regs.CMPCTL.bit.SHDWBMODE = CC_SHADOW;
EPwm3Regs.CMPCTL.bit.LOADAMODE = CC_CTR_ZERO; // load on CTR=Zero
EPwm3Regs.CMPCTL.bit.LOADBMODE = CC_CTR_ZERO; // load on CTR=Zero
// Set actions
EPwm3Regs.AQCTLA.bit.CAU = AQ_SET; // set actions for EPWM3A
EPwm3Regs.AQCTLA.bit.CAD = AQ_CLEAR;
// Set Dead-band
EPwm3Regs.DBCTL.bit.OUT_MODE = DB_FULL_ENABLE; // enable Dead-band module
EPwm3Regs.DBCTL.bit.POLSEL = DB_ACTV_HIC; // Active Hi complementary
EPwm3Regs.DBFED = 50; // FED = 50 TBCLKs
EPwm3Regs.DBRED = 50; // RED = 50 TBCLKs
// Interrupt where we will change the Compare Values
EPwm3Regs.ETSEL.bit.INTSEL = ET_CTR_ZERO;      // Select INT on Zero event
EPwm3Regs.ETSEL.bit.INTEN = 1;                 // Enable INT
EPwm3Regs.ETPS.bit.INTPRD = ET_3RD;            // Generate INT on 3rd event   

// Set Compare values

}


void svpwmGen(void)
{ 

//clarke 
  Ualpha= 0.6666667*(Ua-0.5*Ub-0.5*Uc);// 0.8660254 = sqrt(3)/2
  Ubeta = 0.6666667*(0.8660254*Ub-0.8660254*Uc );//0.6666667=2/3

//sector
  A= Ubeta;
  B= 1.7320508*Ualpha-Ubeta;
  C= -1.7320508*Ualpha-Ubeta;
  if(A>= 0) {a= 1;} else a= 0;
  if(B>= 0) {b= 1;} else b= 0;
  if(C>= 0) {c= 1;} else c= 0;
  N=a+2*b+4*c; 
  switch(N)
   {
    case 1: sector = 2; break;
    case 2: sector = 6; break;
    case 3: sector = 1; break;
    case 4: sector = 4; break;
    case 5: sector = 3; break;
    case 6: sector = 5; break;
    default: break;
   }  
 
//Time
   Ts=2*TPRD;///////////////////Ts为开关周期与载波周期（计数周期）相等
   if(sector== 1)   
   {
	   T1= 1.5*Ts*(Ualpha-0.5773503*Ubeta)/Udc;//0.5773503=1/sqrt(3)
       T2= 1.7320508*Ts*Ubeta/Udc;
	   T0= Ts-T1-T2;
       if(T1+T2>Ts)
	   {
		   T1= T1*Ts/(T1+T2);
		   T2= T2*Ts/(T1+T2);
           T0= Ts-T1-T2;
	   }

   }

   else if(sector== 2)
   {
       T2= 1.5*Ts*(Ualpha+0.5773503*Ubeta)/Udc;
       T3= 1.5*Ts*(0.5773503*Ubeta-Ualpha)/Udc;
	   T0= Ts-T2-T3;
       if(T2+T3>Ts)
	   {
		   T2= T2*Ts/(T2+T3);
		   T3= T3*Ts/(T2+T3);
           T0= Ts-T2-T3;
	   }
   
   }
   
   else if(sector== 3)
   {
       T3= 1.7320508*Ts*Ubeta/Udc;
       T4= 1.5*Ts*(Ualpha+0.5773503*Ubeta)/Udc;
	   T0= Ts-T3-T4;
       if(T3+T4>Ts)
	   {
		   T3= T3*Ts/(T3+T4);
		   T4= T4*Ts/(T3+T4);
           T0= Ts-T3-T4;
	   }
   
   }  
 
   else if(sector== 4)   
   {
	   T4= 1.5*Ts*(0.5773503*Ubeta-Ualpha)/Udc;//0.5773503=1/sqrt(3)
       T5= 1.7320508*Ts*Ubeta/Udc;
	   T0= Ts-T4-T5;
       if(T4+T5>Ts)
	   {
		   T4= T4*Ts/(T4+T5);
		   T5= T5*Ts/(T4+T5);
           T0= Ts-T4-T5;
	   }

   }

   else if(sector== 5)
   {
       T5= -1.5*Ts*(Ualpha+0.5773503*Ubeta)/Udc;
       T6= -1.5*Ts*(0.5773503*Ubeta-Ualpha)/Udc;
	   T0= Ts-T5-T6;
       if(T5+T6>Ts)
	   {
		   T5= T5*Ts/(T5+T6);
		   T6= T6*Ts/(T5+T6);
           T0= Ts-T5-T6;
	   }
   
   }

   else if(sector== 6)
   {
       T6= -1.7320508*Ts*Ubeta/Udc;
       T1= 1.5*Ts*(Ualpha+0.5773503*Ubeta)/Udc;
	   T0= Ts-T6-T1;
       if(T6+T1>Ts)
	   {
		   T6= T6*Ts/(T6+T1);
		   T1= T1*Ts/(T6+T1);
           T0= Ts-T6-T1;
	   }
   
   }  

//Switch Time
   switch(sector)
   {
       case 1: 
	   {
		Taon= T0/4+T1/2+T2/2;
	    Tbon= T0/4+T2/2;
		Tcon= T0/4;
	   }break;	  
       case 2:
		{
		 Taon= T0/4+T3/2;
	     Tbon= T0/4+T2/2+T3/2;
		 Tcon= T0/4;		
		}break;
	   case 3:
		{
		 Taon= T0/4;
	     Tbon= T0/4+T3/2+T4/2;
		 Tcon= T0/4+T4/2;		
		}break;
       case 4:
		{
		 Taon= T0/4;
	     Tbon= T0/4+T5/2;
		 Tcon= T0/4+T4/2+T5/2;		
		}break;
       case 5:
		{
		 Taon= T0/4+T6/2;
	     Tbon= T0/4;
		 Tcon= T0/4+T5/2+T6/2;		
		}break;
	   case 6:
		{
		 Taon= T0/4+T6/2+T1/2;
	     Tbon= T0/4;
		 Tcon= T0/4+T1/2;		
		}break;
       default: break;
   }

}//svpwmGen(void)结束

//===========================================================================
// No more.
//===========================================================================