motorctrl.c

来自「基于博创ARM3000的平台上的几个开发程序。 包含程序math.c以及其他的」· C语言 代码 · 共 27 行

#include "..\startup\44b.h"
#include "MotorCtrl.h"

#define MOTOR_SEVER_FRE		1000		//20kHz

#define MOTOR_CONT				(MCLK/2/2/MOTOR_SEVER_FRE)
#define MOTOR_MID				(MOTOR_CONT/2)

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

	//divider timer0=1/2;
	rTCFG1=0;

	rTCNTB0= MOTOR_CONT;
	rTCMPB0= MOTOR_MID;
	rTCON=0x2;		//update mode for TCNTB0 and TCMPB0.
	rTCON=0x19;		//timer0 = auto reload, start. Dead Zone
}

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