標(biāo)題: 基于arduino的超聲波避障和循跡 [打印本頁]
作者: 用戶21111410    時間: 2021-8-21 19:34
標(biāo)題: 基于arduino的超聲波避障和循跡
前幾天搞了個arduino板，就動手做了個arduino避障小車。。下面是源碼有需要的自行提取。
  1. #define leftA_PIN 16
  2. #define leftB_PIN 17
  3. #define righA_PIN 18
  4. #define righB_PIN 19
  5. int PIN_1 = 4; //從車頭方向的最右邊開始排序
  6. int PIN_2 = 5;
  7. int PIN_3 = 6;
  8. int PIN_4 = 7;
  9. void forward( );          //前進(jìn)
  10. void back( );             //后退
  11. void turnLeftOrigin( );   //原地左
  12. void turnRightOrigin( );  //原地右
  13. void turnRightforword( ); //右前
  14. void turnLeftforword( );  //左前
  15. void turnLeftback( );     //左后
  16. void turnRightback( );    //右后
  17. void _stop();             //停車
  18. void setup()
  19. {

  21.    Serial.begin(9600); //串口波特率9600（手機端使用）
  22.   pinMode (leftA_PIN, OUTPUT); //設(shè)置引腳為輸出引腳
  23.   pinMode (leftB_PIN, OUTPUT); //設(shè)置引腳為輸出引腳
  24.   pinMode (righA_PIN, OUTPUT); //設(shè)置引腳為輸出引腳
  25.   pinMode (righB_PIN, OUTPUT); //設(shè)置引腳為輸出引腳
  26.   pinMode (PIN_1, INPUT); //設(shè)置引腳為輸入引腳
  27.   pinMode (PIN_2, INPUT); //設(shè)置引腳為輸入引腳
  28.   pinMode (PIN_3, INPUT); //設(shè)置引腳為輸入引腳
  29. pinMode (PIN_4, INPUT); //設(shè)置引腳為輸入引腳
  30. }



  34. void loop(){
  35.   int data[4];
  36.   data[0] = digitalRead(4);
  37.   data[1] = digitalRead(5);
  38.   data[2] = digitalRead(6);
  39.   data[3] = digitalRead(7);
  40.   
  41.   if((data[0]==LOW) && (data[1]==LOW ) && (data[2]==LOW) && (data[2]==LOW) )
  42.   {
  43.         forward();
  44.   }
  45.   
  46.    if(((data[0]==HIGH) && (data[1]==LOW) && (data[2]==LOW) && (data[3]==LOW)) || ((data[0]==HIGH) && (data[1]==HIGH) && (data[2]==LOW)  && (data[3]==LOW)) )
  47.   {

  49.   turnLeftOrigin();
  50.    
  51.    }
  52.    if(((data[0]==LOW) && (data[1]==LOW) && (data[2]==HIGH)&& (data[3]==LOW)) || ((data[0]==LOW)&& (data[1]==LOW) && (data[2]==HIGH) && (data[3]==HIGH)) )
  53.   {
  54.   turnRightOrigin( );
  55.    }
  56.    
  57. }
  58.   
  59. /**************************************************
  60. forward子函數(shù)——前進(jìn)子函數(shù)
  61. 函數(shù)功能：控制車前進(jìn)
  62. **************************************************/
  63. void forward( )
  64. {
  65.   analogWrite(leftA_PIN,180);      
  66.   analogWrite(leftB_PIN,0);         //左輪前進(jìn)
  67.   analogWrite(righA_PIN,180);      
  68.   analogWrite(righB_PIN,0);         //右輪前進(jìn)
  69. }
  70. /**************************************************
  71. back子函數(shù)——后退子函數(shù)
  72. 函數(shù)功能：控制車后退
  73. **************************************************/
  74. void back( )
  75. {
  76.   analogWrite(leftA_PIN,0);      
  77.   analogWrite(leftB_PIN,180);        //左輪后退
  78.   analogWrite(righA_PIN,0);      
  79.   analogWrite(righB_PIN,180);        //右輪后退
  80. }
  81. /**************************************************
  82. turnLeftOrigin子函數(shù)——原地左轉(zhuǎn)子函數(shù)
  83. 函數(shù)功能：控制車原地左轉(zhuǎn)
  84. **************************************************/
  85. void turnLeftOrigin( )
  86. {
  87.   analogWrite(leftA_PIN,0);      
  88.   analogWrite(leftB_PIN,255);        //左輪后退
  89.   analogWrite(righA_PIN,255);      
  90.   analogWrite(righB_PIN,0);          //右輪前進(jìn)
  91. }
  92. /**************************************************
  93. turnRightOrigin子函數(shù)——原地右轉(zhuǎn)子函數(shù)
  94. 函數(shù)功能：控制車原地右轉(zhuǎn)
  95. **************************************************/
  96. void turnRightOrigin( )
  97. {
  98.   analogWrite(leftA_PIN,255);      
  99.   analogWrite(leftB_PIN,0);        //左輪前進(jìn)
  100.   analogWrite(righA_PIN,0);      
  101.   analogWrite(righB_PIN,255);      //右輪后退
  102. }
  103. /**************************************************
  104. turnRightforword子函數(shù)——右前運動子函數(shù)
  105. 函數(shù)功能：控制車右前
  106. **************************************************/
  107. void turnRightforword( )
  108. {
  109.   analogWrite(leftA_PIN,150);      
  110.   analogWrite(leftB_PIN,0);        //左輪快前進(jìn)
  111.   analogWrite(righA_PIN,128);      
  112.   analogWrite(righB_PIN,0);        //右輪慢前進(jìn)
  113. }
  114. /**************************************************
  115. turnLeftforword子函數(shù)——左前運動子函數(shù)
  116. 函數(shù)功能：控制車左前
  117. **************************************************/
  118. void turnLeftforword( )
  119. {
  120.   analogWrite(leftA_PIN,128);      
  121.   analogWrite(leftB_PIN,0);       //左輪慢前進(jìn)
  122.   analogWrite(righA_PIN,150);      
  123.   analogWrite(righB_PIN,0);       //右輪快前進(jìn)
  124. }
  125. /**************************************************
  126. turnRightforword子函數(shù)——右后運動子函數(shù)
  127. 函數(shù)功能：控制車右原地
  128. **************************************************/
  129. void turnRightback( )
  130. {
  131.   analogWrite(leftA_PIN,255);      
  132.   analogWrite(leftB_PIN,0);        //左輪慢前進(jìn)
  133.   analogWrite(righA_PIN,0);      
  134.   analogWrite(righB_PIN,0);        //右輪停止
  135. }
  136. /**************************************************
  137. turnLeftforword子函數(shù)——左后運動子函數(shù)
  138. 函數(shù)功能：控制車左原地
  139. **************************************************/
  140. void turnLeftback( )
  141. {
  142.   analogWrite(leftA_PIN,0);      
  143.   analogWrite(leftB_PIN,0);        //左輪停止
  144.   analogWrite(righA_PIN,255);      
  145.   analogWrite(righB_PIN,0);        //右輪慢前進(jìn)
  146. }
  147. /**************************************************
  148. stop子函數(shù)—停止子函數(shù)
  149. 函數(shù)功能：控制車停止
  150. **************************************************/
  151. void _stop( )
  152. {
  153.   analogWrite(leftA_PIN,0);      
  154.   analogWrite(leftB_PIN,0);         //左輪靜止不動
  155.   analogWrite(righA_PIN,0);      
  156.   analogWrite(righB_PIN,0);         //右輪靜止不動
  157. }
復(fù)制代碼

作者: 用戶21111410    時間: 2021-8-21 19:35
第一次寫稿沒有什么經(jīng)驗希望大家可以提出寶貴意見。
作者: glinfei    時間: 2021-8-23 10:15
是不是經(jīng)常出軌��？而且把四個紅外當(dāng)兩個用了，處理不了直角彎啊。
作者: 用戶21111410    時間: 2021-8-23 16:24
不會呀，我感覺四個更穩(wěn)定些。。



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