Created
June 20, 2020 11:32
-
-
Save EDISON-SCIENCE-CORNER/21b1bc0a91269f2182a248c14f9e35eb to your computer and use it in GitHub Desktop.
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
//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