main.c

keil下开发的永磁同步电机矢量控制程序

//****************************************************************************
// @Module        Project Settings
// @Filename      MAIN.C
// @Project       svm.dav
//----------------------------------------------------------------------------
// @Controller    Infineon XC167CI-16F40
//
// @Compiler      Keil
//
// @Codegenerator 2.1
//
// @Description   This file contains the project initialization function.
//
//----------------------------------------------------------------------------
// @Date          19.12.2003 11:31:17
//
//****************************************************************************

// USER CODE BEGIN (MAIN_General,1)

// USER CODE END



//****************************************************************************
// @Project Includes
//****************************************************************************

#include "MAIN.H"

// USER CODE BEGIN (MAIN_General,2)

// USER CODE END


//****************************************************************************
// @Macros
//****************************************************************************

// USER CODE BEGIN (MAIN_General,3)

// USER CODE END


//****************************************************************************
// @Defines
//****************************************************************************

// USER CODE BEGIN (MAIN_General,4)

// USER CODE END


//****************************************************************************
// @Typedefs
//****************************************************************************

// USER CODE BEGIN (MAIN_General,5)

// USER CODE END


//****************************************************************************
// @Imported Global Variables
//****************************************************************************

// USER CODE BEGIN (MAIN_General,6)

// USER CODE END


//****************************************************************************
// @Global Variables
//****************************************************************************

// USER CODE BEGIN (MAIN_General,7)
char menu[]=
"\r\n\n\n\n"
"a...Start PWM\r\n"
"b...Stop PWM\r\n"
"d...Change rotating Direction \r\n"
"e...Enable Driver\r\n"
"r...Rotate IM\r\n"
" \r\n";


bit on_flag=ON;
bit rot_flag=OFF;
bit dir_flag=ON;
char select=' ';

int speed=0;

volatile unsigned int idata adc_result[3];
volatile unsigned int idata adc_dclink_res[2];
// USER CODE END


//****************************************************************************
// @External Prototypes
//****************************************************************************

// USER CODE BEGIN (MAIN_General,8)

// USER CODE END


//****************************************************************************
// @Prototypes Of Local Functions
//****************************************************************************

// USER CODE BEGIN (MAIN_General,9)

// USER CODE END


//****************************************************************************
// @Function      void MAIN_vInit(void) 
//
//----------------------------------------------------------------------------
// @Description   This function initializes the microcontroller.
//
//----------------------------------------------------------------------------
// @Returnvalue   None
//
//----------------------------------------------------------------------------
// @Parameters    None
//
//----------------------------------------------------------------------------
// @Date          19.12.2003
//
//****************************************************************************

// USER CODE BEGIN (Init,1)

// USER CODE END

void MAIN_vInit(void)
{
  // USER CODE BEGIN (Init,2)

  // USER CODE END

  ///  -----------------------------------------------------------------------
  ///  Configuration of the System Clock:
  ///  -----------------------------------------------------------------------
  ///  - VCO clock used, input clock is connected
  ///  - input frequency is 8 MHz
  ///  - VCO output frequency 100 .. 150 MHz
  ///  - system clock is 40 MHz

  MAIN_vUnlockProtecReg();       // unlock write security
  PLLCON         =  0x7D12;      // load PLL control register


  //// -----------------------------------------------------------------------
  //// Begin of Important Settings for the Start-Up File
  //// -----------------------------------------------------------------------
  ///  All following settings must be set in the start-up file. You can use 
  ///  DAvE's project file (*.dpt) to include this register values into your 
  ///  compiler EDE.

    ///  ---------------------------------------------------------------------
    ///  Initialization of the CPUCON1 Register:
    ///  ---------------------------------------------------------------------
    ///  - space between two vectors is 2 words
    ///  - DISWDT executable until End of Init
    ///  - segmentation is enabled
    ///  - switch context is not interruptible
    ///  - branch prediction is enabled
    ///  - zero cycle jump function is enabled

    //// this register must be set in the start-up file
    //// CPUCON1  =  0x0003

    ///  ---------------------------------------------------------------------
    ///  Initialization of the VECSEG Register:
    ///  ---------------------------------------------------------------------
    ///  - start from internal program memory

    //// this register must be set in the start-up file
    //// VECSEG  =  0x00C0

    ///  ---------------------------------------------------------------------
    ///  Initialization of the SYSCON0 Register:
    ///  ---------------------------------------------------------------------

    //// this register must be set in the start-up file
    //// SYSCON0  =  0x0000

    ///  ---------------------------------------------------------------------
    ///  Initialization of the SYSCON1 Register:
    ///  ---------------------------------------------------------------------
    ///  clock prescaler for system is fpll / 1

    //// this register must be set in the start-up file
    //// SYSCON1  =  0x0000

    ///  ---------------------------------------------------------------------
    ///  Initialization of the SYSCON3 Register:
    ///  ---------------------------------------------------------------------

    //// this register must be set in the start-up file
    //// SYSCON3  =  0x0000

    ///  ---------------------------------------------------------------------
    ///  Initialization of EBC
    ///  ---------------------------------------------------------------------

    //// this register must be set in the start-up file
    //// EBCMOD1  =  0x005F

    ///  EBC is disabled
  //// -----------------------------------------------------------------------
  //// End of Important Settings for the Start-Up File
  //// -----------------------------------------------------------------------


  //   -----------------------------------------------------------------------
  //   Initialization of the Peripherals:
  //   -----------------------------------------------------------------------

  //   initializes the Parallel Ports
  IO_vInit();

  //   initializes the Asynchronous/Synchronous Serial Interface (ASC0)
  ASC0_vInit();

  //   initializes the General Purpose Timer Unit (GPT1)
  GPT1_vInit();

  //   initializes the Capture / Compare Unit 1 (CAPCOM1)
  CC1_vInit();

  //   initializes the Analog / Digital Converter (ADC)
  ADC_vInit();

  //   initializes the Capture / Compare Unit 6 (CCU6)
  CCU6_vInit();

  //   initializes the Interrupt Controller (INT)
  INT_vInit();

  // USER CODE BEGIN (Init,3)

  // USER CODE END

  //   globally enable interrupts
  PSW_IEN        =  1;          

} //  End of function MAIN_vInit


//****************************************************************************
// @Function      void MAIN_vUnlockProtecReg(void) 
//
//----------------------------------------------------------------------------
// @Description   This function makes it possible to write one protected 
//                register. After calling of this function and write on the 
//                protected register is the security level set to low 
//                protected mode.
//
//----------------------------------------------------------------------------
// @Returnvalue   None
//
//----------------------------------------------------------------------------
// @Parameters    None
//
//----------------------------------------------------------------------------
// @Date          19.12.2003
//
//****************************************************************************

// USER CODE BEGIN (UnlockProtecReg,1)

// USER CODE END

void MAIN_vUnlockProtecReg(void)
{
  ubyte ubPASSWORD;

  if((SCUSLS & 0x1800) == 0x0800)      // if low protected mode
  {

    ubPASSWORD = SCUSLS & 0x00FF;
    ubPASSWORD = ~ubPASSWORD;
    SCUSLC = 0x8E00 | ubPASSWORD;      // command 4

  }  // end if low protected mode

  if((SCUSLS & 0x1800) == 0x1800)      // if write protected mode
  {
    SCUSLC = 0xAAAA;                   // command 0
    SCUSLC = 0x5554;                   // command 1

    ubPASSWORD = SCUSLS & 0x00FF;
    ubPASSWORD = ~ubPASSWORD;

    SCUSLC = 0x9600 | ubPASSWORD;      // command 2
    SCUSLC = 0x0800;                   // command 3; new PASSWOR is 0x00

    ubPASSWORD = SCUSLS & 0x00FF;
    ubPASSWORD = ~ubPASSWORD;
    SCUSLC = 0x8E00 | ubPASSWORD;      // command 4

  }  // end if write protected mode

} //  End of function MAIN_vUnlockProtecReg


//****************************************************************************
// @Function      void main(void) 
//
//----------------------------------------------------------------------------
// @Description   This is the main function.
//
//----------------------------------------------------------------------------
// @Returnvalue   None
//
//----------------------------------------------------------------------------
// @Parameters    None
//
//----------------------------------------------------------------------------
// @Date          19.12.2003
//
//****************************************************************************

// USER CODE BEGIN (Main,1)
char input (void)
{
  char in = ' '; 
  do 
  {
    while (!ASC0_RIC_IR) _nop_();
    ASC0_RIC_IR=0;
    in= (char)ASC0_RBUF;
  }while (in != 'a' && in != 'b' && in != 'd'  && in != 'e' && in != '0' && in != '1' && in != '2' && in != '3'&& in != '4' && in != '5' && in != '6'&& in != '7' && in != '8' && in != '9');
  return in;

}

void ChangeDirection(void)
{
	dir_flag = !dir_flag;
}

void SetSpeed(int new_speed)
{
	speed = new_speed<<3;		// new_speed * 8 	
}

void StartPwm(void)
{
	CCU6_TCTR4			=	0x0002;			//starten von T12 der CAPCOM 6
}

void StopPwm(void)
{
	CCU6_TCTR4			=	0x0001;			//stoppen von T12 der CAPCOM 6
	CCU6_CMPMODIF		=	0x0700;			//reset output line
}

void EnableDriver(void)
{
	if (on_flag==OFF)
	{
    	P9=0x0010;                  // RESET PORT 9.4,5 OUTPUT LATCH
		on_flag=ON;
	}
	else
	{
   		P9=0x0020;                  // SET PORT 9.4,5 OUTPUT LATCH
		on_flag=OFF;
	}
}

// USER CODE END

void main(void)
{
  // USER CODE BEGIN (Main,2)
	Configure_PLL();
	Configure_SYSCON3();
  // USER CODE END

  MAIN_vInit();

  // USER CODE BEGIN (Main,4)


	CCU6_TCTR4			=	0x0002;			// Start Timer 12 of CAPCOM 6
	InitFOC();	

	while (1)  
  	{	
	P7_P6 = 1; 
		select=input();

	    switch (select)
		{
			case 'a':  StartPwm();  break;
			case 'b':  StopPwm(); break;
			case 'e':  EnableDriver(); break;
			case 'd':  ChangeDirection(); break;
			case '0':  SetSpeed(0); break;
			case '1':  SetSpeed(10); break;
			case '2':  SetSpeed(20); break;
			case '3':  SetSpeed(30); break;
			case '4':  SetSpeed(40); break;
			case '5':  SetSpeed(50); break;
			case '6':  SetSpeed(60); break;
	 		case '7':  SetSpeed(70); break;
			case '8':  SetSpeed(1); break;
			case '9':  SetSpeed(5); break;
		}
	P7_P6 = 0;
	}

  // USER CODE END

} //  End of function main



// USER CODE BEGIN (MAIN_General,10)

// USER CODE END