久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 3103|回復(fù): 1
收起左側(cè)

arduino紅外避障程序

[復(fù)制鏈接]
ID:907658 發(fā)表于 2021-4-18 08:48 | 顯示全部樓層 |閱讀模式
這是一個(gè)關(guān)于arduino紅外避障的程序
  1. #define L_hw A0 //左紅外
  2. #define R_hw A1 //右紅外
  3. #define motor_A1 7
  4. #define motor_A2 8
  5. #define motor_A  9
  6. #define motor_B1 6
  7. #define motor_B2 5
  8. #define motor_B  3
  9. void setup() {
  10.   pinMode(L_hw,INPUT);
  11.   pinMode(R_hw,INPUT);
  12.   pinMode(motor_A1,OUTPUT);
  13.   pinMode(motor_A2,OUTPUT);
  14.   pinMode(motor_A,OUTPUT);
  15.   pinMode(motor_B1,OUTPUT);
  16.   pinMode(motor_B2,OUTPUT);
  17.   pinMode(motor_B,OUTPUT);
  18.   Serial.begin(9600);        // 初始化串口
  19. }

  21. void loop() {

  23.    bizhang();  //紅外避障子程序
  24.    }

  26. void qianjin(){
  27.   digitalWrite(motor_A1,1);
  28.   digitalWrite(motor_A2,0);
  29.   analogWrite(motor_A,100); //PWM
  30.   digitalWrite(motor_B1,1);
  31.   digitalWrite(motor_B2,0);
  32.   analogWrite(motor_B,100); //PWM
  33.    }
  34. void houtui(){
  35.   digitalWrite(motor_A1,0);
  36.   digitalWrite(motor_A2,1);
  37.   analogWrite(motor_A,100); //PWM
  38.   digitalWrite(motor_B1,0);
  39.   digitalWrite(motor_B2,1);
  40.   analogWrite(motor_B,100); //PWM
  41.     }
  42. void zuozhuan(){
  43.   digitalWrite(motor_A1,0);
  44.   digitalWrite(motor_A2,1);
  45.   analogWrite(motor_A,100); //PWM
  46.   digitalWrite(motor_B1,1);
  47.   digitalWrite(motor_B2,0);
  48.   analogWrite(motor_B,100); //PWM
  49.    }
  50. void youzhuan(){
  51.   digitalWrite(motor_A1,1);
  52.   digitalWrite(motor_A2,0);
  53.   analogWrite(motor_A,100); //PWM
  54.   digitalWrite(motor_B1,0);
  55.   digitalWrite(motor_B2,1);
  56.   analogWrite(motor_B,100); //PWM
  57.    }
  58. void bizhang(){ //避障
  59.    if(digitalRead(L_hw)==1&&digitalRead(R_hw)==1){
  60.     qianjin();
  61.         }
  62.     else if(digitalRead(L_hw)==1&&digitalRead(R_hw)==0){
  63.       zuozhuan();
  64.             }  
  65.      else if(digitalRead(L_hw)==0&&digitalRead(R_hw)==1){
  66.       youzhuan();
  67.             }  
  68.     else if(digitalRead(L_hw)==0&&digitalRead(R_hw)==0){
  69.       houtui();
  70.       delay(2000);
  71.       zuozhuan();
  72.       delay(500);
  73.             }
  74.     else{
  75.       houtui();
  76.         }
  77.   }
復(fù)制代碼


回復(fù)

使用道具 舉報(bào)

ID:844772 發(fā)表于 2021-4-19 23:46 | 顯示全部樓層
  else if(digitalRead(L_hw)==1&&digitalRead(R_hw)==0){       zuozhuan(); 寫反了吧？右邊檢測軌跡線，怎么還左轉(zhuǎn)了？就算沒反，類似的寫法，我在四個(gè)電機(jī)的小車試過了，基本沒法用。
回復(fù)

使用道具 舉報(bào)

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規(guī)則

小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板： 91精品国自产在线观看 | 色啪视频| 国产一区精品视频 | 亚洲黄色大片 | 成人一级视频 | 日本成人一区二区三区 | 天天色影院 | 最新超碰 | 亚洲黄色一级 | 日韩欧美综合 | 香蕉视频导航 | 黄色三级视频网站 | av资源站| 精品伊人久久 | 国产激情一区二区三区 | 午夜视频在线播放 | 午夜网站在线观看 | 成av人片在线观看www | 欧美在线中文字幕 | 久草资源| 久久青青操 | 成人黄色在线 | 婷婷六月色 | 一区二区三区中文字幕 | 97精品国产| 亚洲欧美在线一区 | 成人片在线播放 | www.youjizz.com日本| 51调教丨国产调教视频 | 精品国产aⅴ麻豆 | 91啪国产| 综合网久久| 久久青 | 蜜桃精品一区二区三区 | 日本一级片在线观看 | 日韩在线免费观看视频 | 亚洲国产成人精品女人久久久 | 欧美黄色一级大片 | 国产不卡视频在线观看 | 国产999视频 | 国产一级特黄 |