* =======直流电机的PWM速度控制程序======== */
/* 晶振采用11.0592M,产生的PWM的频率约为91Hz */
#include<reg51.h>
#include<math.h>
#define uchar unsigned char
#define uint unsigned int
sbit en1=P2^0 /* L298的Enable A */
sbit en2=P2^1 /* L298的Enable B */
sbit s1=P2^2 /* L298的Input 1 */
sbit s2=P2^3 /* L298的Input 2 */
sbit s3=P2^4 /* L298的Input 3 */
sbit s4=P2^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>=-100 && speed<=100)
{
if(index==1) /* 电机1的处理 */
{
m1=abs(speed) /* 取速度的绝对值 */
if(speed<0) /* 速度值为负则反转 */
{
s1=0
s2=1
}
else /* 不为负数则正转 */
{
s1=1
s2=0
}
}
if(index==2) /* 电机2的处理 */
{
m2=abs(speed) /* 电机2的速度控制 */
if(speed<0) /* 电机2的方向控制 */
{
s3=0
s4=1
}
else
{
s3=1
s4=0
}
}
}
}
void delay(uint j) /* 简易延时函数 */
{
for(jj>0j--)
}
void main()
{
char i
TMOD=0x02 /* 设定T0的工作模式为2 */
TH0=0x9B /* 装入定时器的初值 */
TL0=0x9B
EA=1 /* 开中断 */
ET0=1 /* 定时器0允许中断 */
TR0=1 /* 启动定时器0 */
while(1) /* 电机实际控制演示 */
{
for(i=0i<=100i++) /* 正转加速 */
{
motor(1,i)
motor(2,i)
delay(5000)
}
for(i=100i>0i--) /* 正转减速 */
{
motor(1,i)
motor(2,i)
delay(5000)
}
for(i=0i<=100i++) /* 反转加速 */
{
motor(1,-i)
motor(2,-i)
delay(5000)
}
for(i=100i>0i--) /* 反转减速 */
{
motor(1,-i)
motor(2,-i)
delay(5000)
}
}
}
void timer0() interrupt 1 /* T0中断服务程序 */
{
if(t==0) /* 1个PWM周期完成后才会接受新数值 */
{
tmp1=m1
tmp2=m2
}
if(t<tmp1) en1=1 else en1=0 /* 产生电机1的PWM信号 */
if(t<tmp2) en2=1 else en2=0 /* 产生电机2的PWM信号 */
t++
if(t>=100) t=0 /* 1个PWM信号由100次中断产生 */
}
本人画的,验证有效
程序还要自己整合,毕竟自己编的才有成就感,我给你提点思路,液晶显示程序和温度控制程序都看懂的情况下,你可以在定时中断中扫描温度,并判断是否达到阀值,设置一个Bit型的flag,然后在主程序中一直调用步进电子子程序,同样,步进电机中的正转反转由上面提到的flag进行判断。有什么问题继续追问就行步进电机正反转很容易控制,比如正转按如下逻辑时序控制:stepz[]={0x01,0x03,0x02,0x06,0x04,0x0c,0x8,0x09}
反转就是将数据掉个顺序就好。
stepf[]={0x01,0x09,0x08,0x0c,0x04,0x06,0x02,0x03}
欢迎分享,转载请注明来源:内存溢出
评论列表(0条)