Motor_Controller.c 1.56 KB
Newer Older
崔立宝's avatar
崔立宝 committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76
/*******************************************************************************
文 件 名:Motor_Controller.c
功能描述:电机控制器驱动库文件
作    者:张暄
版    本:V1.0
日    期:2017.4.13
******************************************************************************/
#include "Motor_Controller.h"
#pragma MESSAGE DISABLE C5703

/******************************************************************************
函数名:Motor_Controller_Init
功  能:初始化电机控制器
参  数:无
返回值:无
******************************************************************************/
void Motor_Controller_Init(void)
{
  MCCTL0  = 0x00;
  MCCTL1  = 0x80;
  MCPER   = MOTOR_CONTROLLER_PERIOD;
  
  #if MOTOR_0_ENABLE
  	MCCC0 = 0xD0;
    MCCC1 = 0xD0;
  #else
   	MCCC0 = 0x00;
    MCCC1 = 0x00;
  #endif

  #if MOTOR_1_ENABLE
  	MCCC2 = 0xD1;
	  MCCC3 = 0xD1;
  #else
    MCCC2 = 0x00;
	  MCCC3 = 0x00;
  #endif
  
  #if MOTOR_2_ENABLE
    MCCC4 = 0xD2;
    MCCC5 = 0xD2;
  #else
    MCCC4 = 0x00;
    MCCC5 = 0x00;
  #endif
  
  #if MOTOR_3_ENABLE
    MCCC6 = 0xD3;
    MCCC7 = 0xD3;
  #else
    MCCC6 = 0x00;
    MCCC7 = 0x00;
  #endif
}

/******************************************************************************
函数名:Motor_Controller_Shutdown
功  能:关闭电机控制器输出
参  数:无
返回值:无
******************************************************************************/
void Motor_Controller_Shutdown(void)
{
  MCCC0  = 0x00;
  MCCC1  = 0x00;
  MCCC2  = 0x00;
  MCCC3  = 0x00;
  MCCC4  = 0x00;
  MCCC5  = 0x00;
  MCCC6  = 0x00;
  MCCC7  = 0x00;
  
  MCPER  = 0x00;
  MCCTL0 = 0x00;
  MCCTL1 = 0x00;
}