四相五线步进电机一般减速比很大,也不需要像二相四线步进电机那样的细分控制,直接给高低电平就行
几年前写的,供参考
- #include <STC89C5xRC.H>
- #include <intrins.h>
- #define Step_A {A1=1;B1=0;C1=0;D1=0;}
- #define Step_B {A1=0;B1=1;C1=0;D1=0;}
- #define Step_C {A1=0;B1=0;C1=1;D1=0;}
- #define Step_D {A1=0;B1=0;C1=0;D1=1;}
- #define A1 P10
- #define B1 P11
- #define C1 P12
- #define D1 P13
-
- /*----------------------------延时10ms@STC-Y1@12MHz----------------------------*/
- void Delay_10ms(void)
- {
- unsigned char i,j;
- i=20;
- j=113;
- do
- {
- while(--j);
- }
- while(--i);
- }
-
- /*----------------------------延时x10ms----------------------------*/
- void Delay_x10ms(unsigned char x)
- {
- while(x--)
- Delay_10ms();
- }
-
- void main()
- {
- while(1)
- {
- Step_A
- Delay_x10ms(1);
- Step_B
- Delay_x10ms(1);
- Step_C
- Delay_x10ms(1);
- Step_D
- Delay_x10ms(1);
- }
- }
复制代码
|