两相步进电机驱动程序(3页).doc

《两相步进电机驱动程序(3页).doc》由会员分享，可在线阅读，更多相关《两相步进电机驱动程序(3页).doc（3页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、-两相步进电机驱动程序-第 3 页/*程序名：两相步进电机驱动程序器材：35两相步进电机驱动芯片：A4988驱动#include #define uchar unsigned char#define uint unsigned int /Motorsbit F1 = P10;sbit F2 = P11;sbit F3 = P12;sbit F4 = P13;/步进电机驱动uchar MotorStep=0;uint MotorTimer = 0;uint TIM,CT;void InitMotor() F1 = 1; F2 = 1; F3 = 1; F4 = 1;void SetMotor()

2、 / if(Speed = 0) return;switch(MotorStep) case 0: if(TIM) F1 = 0; F2 = 0;F3 = 1;F4 = 1; MotorStep = 1; TIM=0; break; case 1: if(TIM) F1 = 1; F2 = 0; F3 = 0; F4 = 1; MotorStep = 2;TIM=0; break;case 2: if(TIM)F1 = 1; F2 = 1; F3 = 0; F4 = 0; MotorStep = 3;TIM=0; break;case 3: if(TIM) F1 = 0; F2 = 1; F3 = 1; F4 = 0; MotorStep = 0;TIM=0; break;void system_Ini() TMOD|= 0x11; TL0=0x00;IE = 0x8A; TR0 = 1;void main() system_Ini(); InitMotor(); while(1) SetMotor(); t1 (0.5ms)中断 中断中做 PWM 输出 -1000/(0.02ms*250)=200Hz void Tzd(void) interrupt 1 TL0 = 0x33;if( CT+=20) TIM=1; CT=0;