回到首页 返回首页
回到顶部 回到顶部
返回上一页 返回上一页

ESP32-C6超声波跟随小车 简单

头像 江志灏 2024.04.22 340 0

这次拿到ESP32-C6新的开发板做的第二个项目,决定第二个项目用来做一台超声波的跟随小车。主要是对电机驱动的能力的测试。下面是制作的步骤:

步骤1 三维建模画好小车图纸

image.png

步骤2 激光切割加工好亚克力板材。

image.png

步骤3 组装小车车体。

image.png

步骤4 本次用的电机驱动板是L298N电机驱动板。

image.png

步骤5 用ESP32-C6连接好基本电路。

image.png

步骤6 编写好程序上传测试。

image.png

步骤7 测试程序。

代码
const int tr= 2; 
const int ec = 3; 
float cm; 
void setup() 
{ 
Serial.begin(9600); 
pinMode(tr, OUTPUT); 
pinMode(ec, INPUT); 
pinMode(4,OUTPUT);
pinMode(5,OUTPUT);
pinMode(6,OUTPUT);
pinMode(7,OUTPUT);
} 
void loop() 
{ 
digitalWrite(tr, 0); //低高低电平发一个短时间脉冲去TrigPin 
delayMicroseconds(2); 
digitalWrite(tr, 1); 
delayMicroseconds(10); 
digitalWrite(tr, 0); 

cm = pulseIn(ec, 1) / 58.0; //将回波时间换算成cm 
cm = (int(cm * 100.0)) / 100.0; //保留两位小数 
Serial.print(cm); 
Serial.print("cm"); 
Serial.println(); 

if(cm<20)
{
digitalWrite(4,0);
digitalWrite(5,0);
digitalWrite(6,0);
digitalWrite(7,0);
  
  }
  if(cm>=30&&cm<=70)

  {
   digitalWrite(4,0);
   digitalWrite(5,1);
   digitalWrite(6,0);
   digitalWrite(7,1);
    
    }
   if(cm>=80)
   { 
    digitalWrite(4,1);
   digitalWrite(5,0);
   digitalWrite(6,1);
   digitalWrite(7,0);
    }

} 

步骤8 最终展示效果如下视频。

步骤9 最终完成了超声波跟随小车的制作,还有不足的地方继续改进,希望各位多给意见。

评论

user-avatar