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