标题: 基于Arduino的碰撞传感器控制电机正反转的源码 [打印本页]
作者: XJY183863    时间: 2019-3-8 15:26
标题: 基于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. }

  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. }

复制代码


sketch_mar11a.zip

737 Bytes, 下载次数: 7, 下载积分: 黑币 -5





欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1