motorcontrol.c

来自「AVR单片机控制码盘程序」· C语言 代码 · 共 37 行

/*******************************************************************************/
#include "Motor.h"

//a: 电机PWM占空比的百分数值，
void R_M_Go(uchar Dir, uchar a )//右电机运动方向控制
{
	if (Dir == Forth)
		PORTB &= ~BIT(2);	//PB2 = 0
	else 
		PORTB |= BIT(2);	//PB2 = 1
		
	OCR1A = (a * ICR1)/100;	//利用占空比得到OCR1A,输出控制PWM
}

//a: 电机PWM占空比的百分数值，
void L_M_Go(uchar Dir, uchar a)	//左电机运动方向控制
{
	if (Dir == Forth)
		PORTB &= ~BIT(1);	//PB1= 0
	else 
		PORTB |= BIT(1);	//PB1 = 1
		
	OCR1B = (a * ICR1)/100;	//利用占空比得到OCR1B,输出控制PWM
}

//L_Dir: 左电机方向，L_a: 左电机PWM占空比的百分数值，
//R_Dir: 右。。。。。，R_a: 右。。。。。。。。。。。。
/*void Set_Motor(uchar L_Dir, uchar L_a, uchar R_Dir, uchar R_a)
{
	OCR1A = (L_a * ICR1)/100;	//利用占空比得到OCR1A,B的值，输出控制PWM
	L_M_Go(L_Dir);
	
	OCR1B = (R_a * ICR1)/100;
	R_M_Go(R_Dir);	
}*/