以下是步进电机的驱动原码,实现正转反转,根据按键控制圈数
#include <reg52.h>
sfr P4 = 0xE8;
void KeyDriver();
void KeyScan();
signed long beats = 0; //电机转动节拍总数
/* 步进电机启动函数, angle-需转过的角度 */
void StartMotor(signed long angle)
{
//在计算前关闭中断,完成后再打开,以避免中断打断计算过程而造成错误
EA = 0;
beats = (angle * 4076) / 360; //实测为 4076 拍转动一圈
EA = 1;
}
/* 步进电机停止函数 */
void StopMotor()
{
EA = 0;
beats = 0;
EA = 1;
}
/* 电机转动控制函数 */
void TurnMotor()
{
unsigned char tmp; //临时变量
static unsigned char index = 0; //节拍输出索引
unsigned char code BeatCode[8] = { //步进电机节拍对应的 IO 控制代码
0x6,0x7,0x3,0xb,0x9,0xd,0xc,0xe
};
if (beats != 0) //节拍数不为 0 则产生一个驱动节拍
{
if (beats > 0) //节拍数大于 0 时正转
{
index++; //正转时节拍输出索引递增
index = index & 0x07; //用&操作实现到 8 归零
beats--; //正转时节拍计数递减
}
else //节拍数小于 0 时反转
{
index--; //反转时节拍输出索引递减
index = index & 0x07; //用&操作同样可以实现到-1 时归 7
beats++; //反转时节拍计数递增
}
tmp = P4; //用 tmp 把 P4 口当前值暂存
tmp = tmp & 0xF0; //用&操作清零低 4 位
tmp = tmp | BeatCode[index]; //用|操作把节拍代码写到低 4 位
P4 = tmp; //把低 4 位的节拍代码和高 4 位的原值送回 P1
}
else //节拍数为 0 则关闭电机所有的相
{
P4 = P4 | 0xff;
}
}
|