标题: 我的arduino循迹小车源代码 [打印本页]
作者: xuxuhao145    时间: 2017-6-9 21:47
标题: 我的arduino循迹小车源代码
这是用arduino编写的循迹小车源代码
采用的是四路循迹模块
能根据黑线的路线循迹
还有抓球舵机的程序
就不写了，想要的可以练习我
QQ 807195506

  1. #define IN1 2
  2. #define IN2 3
  3. #define IN3 4
  4. #define IN4 5
  5. #define ENA 13
  6. #define ENB 12
  7. #define LED1 6
  8. #define LED2 7
  9. #define LED3 8
  10. #define LED4 9
  11. void setup()
  12. {
  13.   pinMode(IN1,OUTPUT);
  14.   pinMode(IN2,OUTPUT);
  15.   pinMode(IN3,OUTPUT);
  16.   pinMode(IN4,OUTPUT);
  17.   pinMode(ENA,OUTPUT);
  18.   pinMode(ENB,OUTPUT);
  19. pinMode(LED1,INPUT);
  20. pinMode(LED2,INPUT);
  21. pinMode(LED3,INPUT);
  22. pinMode(LED4,INPUT);

  24. }
  25. void loop()
  26. {
  27. if(digitalRead(LED1)==0&&digitalRead(LED2)==1&&digitalRead(LED3)==1&&digitalRead(LED4)==0)
  28. {  
  29.   digitalWrite(IN1,HIGH);
  30.   digitalWrite(IN2,LOW);
  31.   digitalWrite(IN3,HIGH);
  32.   digitalWrite(IN4,LOW);
  33.   delay(20);
  34. }
  35. if(digitalRead(LED1)==0&&digitalRead(LED2)==0&&digitalRead(LED3)==0&&digitalRead(LED4)==0)
  36. {  
  37.   digitalWrite(IN1,HIGH);
  38.   digitalWrite(IN2,LOW);
  39.   digitalWrite(IN3,HIGH);
  40.   digitalWrite(IN4,LOW);
  41.   delay(20);
  42. }

  44. if(digitalRead(LED1)==0&&digitalRead(LED2)==1&&digitalRead(LED3)==1&&digitalRead(LED4)==1)
  45. {
  46.   
  47.   digitalWrite(IN1,HIGH);
  48.   digitalWrite(IN2,LOW);
  49.   digitalWrite(IN3,LOW);
  50.   digitalWrite(IN4,LOW);
  51. delay(20);
  52.   
  53.   }
  54.   if(digitalRead(LED1)==0&&digitalRead(LED2)==0&&digitalRead(LED3)==1&&digitalRead(LED4)==0)
  55. {
  56.   
  57.   digitalWrite(IN1,HIGH);
  58.   digitalWrite(IN2,LOW);
  59.   digitalWrite(IN3,LOW);
  60.   digitalWrite(IN4,LOW);
  61. delay(20);
  62.   
  63.   }
  64.   if(digitalRead(LED1)==1&&digitalRead(LED2)==1&&digitalRead(LED3)==1&&digitalRead(LED4)==0)
  65. {
  66. digitalWrite(IN1,LOW);
  67.   digitalWrite(IN2,LOW);
  68.   digitalWrite(IN3,HIGH);
  69.   digitalWrite(IN4,LOW);
  70. delay(20);
  71.   
  72.   }
  73.   if(digitalRead(LED1)==0&&digitalRead(LED2)==1&&digitalRead(LED3)==0&&digitalRead(LED4)==0)
  74. {
  75. digitalWrite(IN1,LOW);
  76.   digitalWrite(IN2,LOW);
  77.   digitalWrite(IN3,HIGH);
  78.   digitalWrite(IN4,LOW);
  79. delay(20);
  80.   
  81.   }
  82.   if(digitalRead(LED1)==0&&digitalRead(LED2)==1&&digitalRead(LED3)==0&&digitalRead(LED4)==0)
  83. {
  84.   digitalWrite(IN1,LOW);
  85.   digitalWrite(IN2,LOW);
  86.   digitalWrite(IN3,HIGH);
  87.   digitalWrite(IN4,LOW);
  88. delay(20);
  89.   }
  90. if(digitalRead(LED1)==1&&digitalRead(LED2)==1&&digitalRead(LED3)==0&&digitalRead(LED4)==0)
  91. {
  92.   digitalWrite(IN1,LOW);
  93.   digitalWrite(IN2,LOW);
  94.   digitalWrite(IN3,HIGH);
  95.   digitalWrite(IN4,LOW);
  96. delay(20);
  97.   }
  98. }
复制代码


作者: zhanghongxiwdlc    时间: 2017-12-26 14:52
你好技术员高手请教你unor3 L293D四路履带电机，一路超声波和两路寻迹代码
作者: zhanghongxiwdlc    时间: 2017-12-26 14:56
我的QQ942492789请求高手指导
作者: wpf256    时间: 2017-12-28 17:43
我想问，速度应该调到多少比较好，因为感觉设置快了总是会出线，不出线又跑得太慢了，有什么办法解决么？
作者: barit    时间: 2019-8-9 23:53
代码只是理论上可行，实际中会因为小车速度不可调而冲出线的情况
作者: r55ye    时间: 2019-8-15 13:54
这个好玩啊。打算制作个玩玩。。



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