这是利用L298驱动运塌两个直流电机的(来源于智能车循迹)程序,/* =======直流电机的PWM速度控制程序======== */
/* 晶振采用11.0592M,产生的PWM的频率约为91Hz */
#include&ltreg51.h&gt
#include&ltmath.h&gt
#define uchar unsigned char
#define uint unsigned int
sbit en1=P1^0/* L298的Enable A */
sbit en2=P1^1/* L298的Enable B */
sbit s1=P1^2/* L298的Input 1 */
sbit s2=P1^3/* L298的Input 2 */
sbit s3=P1^4/* L298的Input 3 */
sbit s4=P1^5/* L298的Input 4 */
uchar t=0/* 中断计数器 */
uchar m1=0/* 电机1速度值 */
uchar m2=0/* 电机2速度值 */
uchar tmp1,tmp2/* 电机当前速度值 */
/* 电机控制函数 index-电机号(1,2)speed-电机速度(-100—100) */
void motor(uchar index, char speed)
{
if(speed&gt=-100 &amp&ampspeed&lt=100)
{
if(index==1) /* 电机1的处理 */
{
m1=abs(speed)/* 取速度的绝对值 */
if(speed&lt0) /* 速度值为负则反转 */
{
s1=0
s2=1
}
else /* 不为负数则正转 */
{
s1=1
s2=0
}
}
if(index==2) /* 电机2的处理 */
{
m2=abs(speed)/* 电机2的速度控制 */
if(speed&lt0) /* 电机2的方向控制 */
{
s3=0
s4=1
}
else
{
s3=1
s4=0
}
}
}
}
void delay(uint j) /* 简易延时函数 */
{
for(jj&gt0j--)
}
void main()
{
uchar i
TMOD=0x02/* 设定T0的工作模式为2 */
TH0=0x9B/* 装入定时器的初值颤悄笑 */
TL0=0x9B
EA=1/* 开中断 */
ET0=1/* 定时器0允许中断 */
TR0=1/* 启动定时器0 */
while(1) /* 电机实际控制演示 */
{
for(i=0i&lt=100i++) /* 正转加速 */
{
motor(1,i)
motor(2,i)
delay(5000)
}
for(i=100i&gt0i--) /* 正转减速 */
{
motor(1,i)
motor(2,i)
delay(5000)
}
for(i=0i&lt=100i++) /* 反转加速 */
{
motor(1,-i)
motor(2,-i)
delay(5000)
}
for(i=100i&gt0i--) /* 反转减速 */
{
motor(1,-i)
motor(2,-i)
delay(5000)
}
}
}
void timer0() interrupt 1 /* T0中断服务程茄含序 */
{
if(t==0) /* 1个PWM周期完成后才会接受新数值 */
{
tmp1=m1
tmp2=m2
}
if(t&lttmp1) en1=1else en1=0/* 产生电机1的PWM信号 */
if(t&lttmp2) en2=1else en2=0/* 产生电机2的PWM信号 */
t++
if(t&gt=100) t=0/* 1个PWM信号由100次中断产生 */
频率的选择主要看你的中断间隔了,
假设你的程序每50us进入一次中断,那么就是说每50us进行一次PWM调制。这样你的PWM频睁租率就是20KHz。
如果你的程序写的很多,那顷巧么你就可以设定更长的中断周期,而相应的PWM调制频率就会降低。
一般的PWM调节频率保持在10K-50K都是可以接受的。
不知到我悉乎兆的回答是否让您满意呢。
台湾力成行星减速机、力成电机,质量、价格、服务各方面都很不错,代理是龙璟机电设备有限公司
/*********T0中断服务程序*****************//*********PWM产生***********************/
void time0(void) interrupt 1 using 2
{
TR0=0//停止T0计数
TH0=0xff//当晶振频率是12M时,每隔0.01ms中断一次,200次中断为PWM信号输出的周期,
TL0=0xf6//PWM信号的频率=1000/(200*0.01ms)=500HZ
++t_0//产生一次中断t_0加1
ACC=t_0//将t_0的值赋值给ACC
CY=0//清零CY
ACC-=motor_r//用ACC减去右边电动机的参数(此参数决定了右边电机的转向和速度)
if(CY==1)//判断CY是否置1,如果为1,说明ACC-motor_r已经为物团负数,置位了CY
{
IN1=1//IN1由原来的0变成了1
IN2=0//IN2由原来的1变成了0
goto PWM_2
}
IN1=0//如果CY不等于1,IN1=0,IN2=1
IN2=1
PWM_2:
ACC=t_0//重新将t_0的值赋值给ACC
CY=0//清零CY
ACC-=motor_l//用ACC减去左边电动机的参数(此参数决定了左边电机的转向和速度)侍烂
if(CY==1)//判断CY是否置1,如果为1,说明ACC-motor_l已经为负数罩谈橘,置位了CY
{
IN3=1//IN3由原来的0变成了1
IN4=0//IN4由原来的1变成了0
goto HIGHT
}
IN3=0//如果CY不等于1,IN3=0,IN4=1
IN4=1
HIGHT:
//ACC=t_0//重新将t_0的值赋值给ACC
if(t_0!=0xc8)//判断t_0的值是否不等于200
goto EXIT//如果不等于200,程序指针指向EXIT执行程序
ACC=0//如果t_0的值等于200,清零ACC和t_0
t_0=ACC
EXIT:
TR0=1//打开TO计数
}
欢迎分享,转载请注明来源:内存溢出
评论列表(0条)