基于Arduino的碰撞传感器控制电机正反转的源码

1. int in1=5,in2=10,in3=6,in4=11;
   
2. int KeyPin=13;
   
3. int i=0;
   
4. void setup()
   
5. {
   
6.   pinMode(KeyPin,INPUT);
   
7.   pinMode(5,OUTPUT);pinMode(6,OUTPUT);pinMode(10,OUTPUT);pinMode(11,OUTPUT);
   
8. }
   
9. 
   
10.   void KeyPin_0()
    
11.    {
    
12.   analogWrite(in1,110);
    
13.   analogWrite(in3,110);
    
14.   digitalWrite(in2,HIGH);
    
15.   digitalWrite(in4,LOW);
    
16.    }
    
17.    
    
18.      void KeyPin_1()
    
19.    {
    
20.   analogWrite(in1,110);
    
21.   analogWrite(in3,110);
    
22.   digitalWrite(in2,LOW);
    
23.   digitalWrite(in4,HIGH);
    
24.    }
    
25.   
    
26. void loop()
    
27. {  
    
28.    if( LOW==digitalRead(KeyPin))
    
29.    {
    
30.      delay(110);
    
31.      if( LOW==digitalRead(KeyPin))
    
32.       {
    
33.       i++;
    
34.       }
    
35.    }
    
36.    
    
37.    if(i==10)
    
38.    {
    
39.     i=0;
    
40.    }
    
41.    
    
42.    if(i%2==1)
    
43.    {
    
44.      KeyPin_1();
    
45.    }
    
46.    else
    
47.    {
    
48.      KeyPin_0();
    
49.    }
    
50.     /* switch(a[j])                            //对各种返回值的响应速度和转弯角度
    
51.    {
    
52.     case 0:KeyPin_0();break;
    
53.     case 1:KeyPin_1();break;
    
54.         default:KeyPin_2();break;
    
55.    }
    
56.    */
    
57. }
    
58. 
    

复制代码