motor.c

来自「博创arm 3000开发板实验」· C语言 代码 · 共 28 行

#include "hardware.h"
#include "motor.h"

void init_MotorPort()
{
	//Dead Zone=0, PreScalero1=2;
	TCFG0|=(0<<24)|2;

	//divider timer0=1/2;
	TCFG1&=(~0xf);
	TCNTB0= MOTOR_CONT;
	TCMPB0= MOTOR_MID;
	TCON|=0x2;		//update mode for TCNTB0 and TCMPB0.
	TCON&=~0x2;
	TCON|=0x19;		//timer0 = auto reload, start. Dead Zone

}

void SetPWM(int value)
{
	TCMPB0= MOTOR_MID+value;
}

void exit_MotorPort(void)
{
	TCON&=~0x1f;
}