步进电机转动任意角度的示例-STC89C52

#include <reg52.h>

void TurnMotor(unsigned long angle);

void main()
{
    TurnMotor(360*25); //360度*25，即25圈
    while (1);
}
/* 软件延时函数，延时约2ms */
void delay()
{
    unsigned int i = 200;
    
    while (i--);
}
/* 步进电机转动函数，angle-需转过的角度 */
void TurnMotor(unsigned long angle)
{
    unsigned char tmp;  //临时变量
    unsigned char index = 0;  //节拍输出索引
    unsigned long beats = 0;  //所需节拍总数
    unsigned char code BeatCode[8] = {  //步进电机节拍对应的IO控制代码
        0xE, 0xC, 0xD, 0x9, 0xB, 0x3, 0x7, 0x6
    };
    
    beats = (angle*4096) / 360; //计算需要的节拍总数，4096拍对应一圈
    while (beats--)  //判断beats不为0时执行循环，然后自减1
    {
        tmp = P1;                    //用tmp把P1口当前值暂存
        tmp = tmp & 0xF0;            //用&操作清零低4位
        tmp = tmp | BeatCode[index]; //用|操作把节拍代码写到低4位
        P1  = tmp;                   //把低4位的节拍代码和高4位的原值送回P1
        index++;                     //节拍输出索引递增
        index = index & 0x07;        //用&操作实现到8归零
        delay();                     //延时2ms，即2ms执行一拍
    }
    P1 = P1 | 0x0F;  //关闭电机所有的相
}