2路电机控制Arduino代码示例

ycf

1. // By DOIT,http://www.doit.am
   
2. /*
   
3. For Channel A and Chanel B,
   
4. Motor rotates forward, then backward,.....
   
5. Pins:
   
6. 
   
7. PWMB --- 12
   
8. DIRB --- 13
   
9. PWMA --- 3
   
10. DIRA --- 1
    
11. 
    
12. */
    
13. 
    
14. int pwm1 = 3;
    
15. int dir1 = 1;
    
16. int pwm2 = 12;                        
    
17. int dir2 = 13;                           
    
18. 
    
19. void setup()
    
20. {
    
21.     pinMode(dir1, OUTPUT);   
    
22.     pinMode(dir2, OUTPUT);
    
23. }
    
24. 
    
25. void loop()
    
26. {
    
27.   int value;
    
28.     for(value = 0 ; value<=255; value+=5) // forward,speed up
    
29.   {
    
30.     digitalWrite(dir1,HIGH);   
    
31.     digitalWrite(dir2,HIGH);      
    
32.     analogWrite(pwm1, value);   //PWM Speed Control
    
33.     analogWrite(pwm2 , value);   //PWM Speed Control
    
34.     delay(30);
    
35.   }  
    
36.   for(value = 255 ; value >=0; value-=5) // forward,speed down
    
37.   {
    
38.     digitalWrite(dir1,HIGH);   
    
39.     digitalWrite(dir2,HIGH);      
    
40.     analogWrite(pwm1, value);   //PWM Speed Control
    
41.     analogWrite(pwm2 , value);   //PWM Speed Control
    
42.     delay(30);
    
43.   }  
    
44.   delay(2000);
    
45.     for(value = 0 ; value<=255; value+=5) // backward,speed up
    
46.   {
    
47.     digitalWrite(dir1,LOW);   
    
48.     digitalWrite(dir2,LOW);   
    
49.     analogWrite(pwm1, value);   //PWM Speed Control
    
50.     analogWrite(pwm2 , value);   //PWM Speed Control
    
51.     delay(30);
    
52.   }   
    
53. for(value = 255 ; value >=0; value-=5) // backward,speed down
    
54.   {
    
55.     digitalWrite(dir1,LOW);   
    
56.     digitalWrite(dir2,LOW);      
    
57.     analogWrite(pwm1, value);   //PWM Speed Control
    
58.     analogWrite(pwm2 , value);   //PWM Speed Control
    
59.     delay(30);
    
60.   }  
    
61.    delay(3000);
    
62.   
    
63. }
    
64. 
    
65. MotorControlSample.zip (773 Bytes, 下载次数: 8377)
    2015-12-10 10:56 上传

    点击文件名下载附件

复制代码