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;
}