L298N直流步進電機驅動直流電機程序

1. #include
2. #defineucharunsignedchar
3. #defineuintunsignedint
5. sbit INPUT1=P1^0;//控制口
7. sbit INPUT2=P1^1;
8. sbit INPUT3=P1^2;
9. sbit INPUT4=P1^3;
11. sbit ENA=P1^4;//產生PWM波
13. sbit ENB=P1^5;
15. uint MA=0,MB=0;
16. uint SpeedA=20;//50%占空比
18. uint SpeedB=20;
20. voiddelay(uint z){
21. uint x,y;
22. for(x=z;x>0;x--)
23. for(y=125;y>0;y--);
24. }
26. voidmain(void)
27. {
28. L298N_init();
29. while(1){}
30. }
34. voidL298N_init(void)
35. {
36. delay(1000);
37. delay(1000);
39. INPUT1=1;INPUT2=0;
40. INPUT3=1;INPUT4=0;//電機停此
43. TH0=0xF4;
44. TL0=0x48;
45. TH1=0xF4;
46. TL1=0x48;
47. TMOD=0x11;
48. TR0=1;
49. TR1=1;
50. ET0=1;
51. ET1=1;
52. EA=1;
53. }
55. voidtime0_int()interrupt 1using1
56. {
57. TR0=0;
58. TH0=0xF4;
59. TL0=0x48;
60. MA++;
62. if(MA
64. ENA=1;
65. }
66. elseENA=0;
68. if(MA==40){
69. MA=0;
70. }
71. TR0=1;
72. }
74. voidtime1_int()interrupt 3using1
75. {
76. TR1=0;
77. TH1=0xF4;
78. TL1=0x48;
79. MB=MB+1;
80. if(MB
81. ENB=1;
82. }
83. elseENB=0;
84. if(MB==40){
85. MB=0;
86. }
87. TR1=1;
88. }