Skip to content

Instantly share code, notes, and snippets.

Show Gist options
  • Star 0 You must be signed in to star a gist
  • Fork 0 You must be signed in to fork a gist
  • Save EDISON-SCIENCE-CORNER/21b1bc0a91269f2182a248c14f9e35eb to your computer and use it in GitHub Desktop.
Save EDISON-SCIENCE-CORNER/21b1bc0a91269f2182a248c14f9e35eb to your computer and use it in GitHub Desktop.
//www.edisonsciencecorner.blogspot.com
//www.edisonsciencecorner.blogspot.com
//www.edisonsciencecorner.blogspot.com
//www.edisonsciencecorner.blogspot.com
const int trig = A4;
const int echo = A5;
const int leftForward = 2;
const int leftBackward = 3;
const int rightForward = 4;
const int rightBackward = 5;
int led=13;
int A=10;
int B= 11;
int duration = 0;
int distance = 0;
void setup()
{
pinMode(13, OUTPUT);
pinMode(10, OUTPUT);
pinMode(11, OUTPUT);
pinMode(trig , OUTPUT);
pinMode(echo , INPUT);
pinMode(leftForward , OUTPUT);
pinMode(leftBackward , OUTPUT);
pinMode(rightForward , OUTPUT);
pinMode(rightBackward , OUTPUT);
Serial.begin(9600);
}
void loop()
{
digitalWrite(10, HIGH);
digitalWrite(11, HIGH);
digitalWrite(trig , HIGH);
delayMicroseconds(1000);
digitalWrite(trig , LOW);
duration = pulseIn(echo , HIGH);
distance = (duration/2) / 28.5 ;
Serial.println(distance);
if ( distance < 10 )
{ digitalWrite(led ,HIGH);
digitalWrite(leftForward , LOW);
digitalWrite(leftBackward , HIGH);
digitalWrite(rightForward , HIGH);
digitalWrite(rightBackward , LOW);
delay(100);
}
else
{ digitalWrite(led ,LOW);
digitalWrite(leftForward , HIGH);
digitalWrite(leftBackward , LOW);
digitalWrite(rightForward , HIGH);
digitalWrite(rightBackward , LOW);
}
}
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment