用Arduino制作超声波避障机器人

功能说明：

自动机器人自动行走前进，当前方有障碍物时，能够自动判断一条可以安全前进的路线，使机器人不会碰到任何障碍物

#include <Servo.h>
Servo servo;
const int sig=2;
const int negR=7;
const int posR=8;
const int negL=12;
const int posL=13;
const int pwmR=5;
const int pwmL=6;
const int Rspeed=120;
const int Lspeed=130;
const int rotSpeed=150;
unsigned long Rdistance;
unsigned long Ldistance;
unsigned long Cdistance;
void setup()
{
   
  pinMode(posR,OUTPUT);
  pinMode(negR,OUTPUT);
  pinMode(posL,OUTPUT);
  pinMode(negL,OUTPUT); 
  servo.attach(3); 
  servo.write(90);