標題: 我的arduino循跡小車源代碼 [打印本頁]
作者: xuxuhao145    時間: 2017-6-9 21:47
標題: 我的arduino循跡小車源代碼
這是用arduino編寫的循跡小車源代碼
采用的是四路循跡模塊
能根據(jù)黑線的路線循跡
還有抓球舵機的程序
就不寫了，想要的可以練習我
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. }
復(fù)制代碼


作者: zhanghongxiwdlc    時間: 2017-12-26 14:52
你好技術(shù)員高手請教你unor3 L293D四路履帶電機，一路超聲波和兩路尋跡代碼
作者: zhanghongxiwdlc    時間: 2017-12-26 14:56
我的QQ942492789請求高手指導(dǎo)
作者: wpf256    時間: 2017-12-28 17:43
我想問，速度應(yīng)該調(diào)到多少比較好，因為感覺設(shè)置快了總是會出線，不出線又跑得太慢了，有什么辦法解決么？
作者: barit    時間: 2019-8-9 23:53
代碼只是理論上可行，實際中會因為小車速度不可調(diào)而沖出線的情況
作者: r55ye    時間: 2019-8-15 13:54
這個好玩啊。打算制作個玩玩。。



歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1